1 files changed, 29 insertions, 0 deletions

diff --git a/firmware/target/arm/imx233/icoll-imx233.c b/firmware/target/arm/imx233/icoll-imx233.c
index b753af8d54..cd96b6fae6 100644
--- a/firmware/target/arm/imx233/icoll-imx233.c
+++ b/firmware/target/arm/imx233/icoll-imx233.c
@@ -127,6 +127,11 @@ struct imx233_icoll_irq_info_t imx233_icoll_get_irq_info(int src)
 #else
     info.enabled = BF_RDn(ICOLL_INTERRUPTn, src, ENABLE);
 #endif
+#if IMX233_SUBTARGET < 3780
+    info.priority = BF_RDn(ICOLL_PRIORITYn, src / 4, PRIORITYx(src % 4));
+#else
+    info.priority = BF_RDn(ICOLL_INTERRUPTn, src, PRIORITY);
+#endif
     info.freq = irq_count_old[src];
     return info;
 }
@@ -165,6 +170,21 @@ void fiq_handler(void)
 {
 }
 
+void imx233_icoll_force_irq(unsigned src, bool enable)
+{
+#if IMX233_SUBTARGET < 3780
+    if(enable)
+        BF_SETn(ICOLL_PRIORITYn, src / 4, SOFTIRQx(src % 4));
+    else
+        BF_CLRn(ICOLL_PRIORITYn, src / 4, SOFTIRQx(src % 4));
+#else
+    if(enable)
+        BF_SETn(ICOLL_INTERRUPTn, src, SOFTIRQ);
+    else
+        BF_CLRn(ICOLL_INTERRUPTn, src, SOFTIRQ);
+#endif
+}
+
 void imx233_icoll_enable_interrupt(int src, bool enable)
 {
 #if IMX233_SUBTARGET < 3780
@@ -180,6 +200,15 @@ void imx233_icoll_enable_interrupt(int src, bool enable)
 #endif
 }
 
+void imx233_icoll_set_priority(int src, unsigned prio)
+{
+#if IMX233_SUBTARGET < 3780
+    BF_WRn(ICOLL_PRIORITYn, src / 4, PRIORITYx(src % 4), prio);
+#else
+    BF_WRn(ICOLL_INTERRUPTn, src, PRIORITY, prio);
+#endif
+}
+
 void imx233_icoll_init(void)
 {
     imx233_reset_block(&HW_ICOLL_CTRL);