FIX PRSDK-1020

1 files changed, 58 insertions, 0 deletions

diff --git a/src/pruicss_intc.c b/src/pruicss_intc.c
index e0933ff..52feae8 100644
--- a/src/pruicss_intc.c
+++ b/src/pruicss_intc.c
@@ -375,6 +375,64 @@ static void PRUICSS_intcSetHmr( uint8_t channel,
     HWREG(temp_addr1) = HWREG(temp_addr2) | ((((uint32_t)host) & ((uint32_t)0xFU)) << ((((uint32_t)channel) & ((uint32_t)0x3U)) << 3U));
 }
 
+/**
+ * @brief  This function clears all Interrupt-Channel-host mapping.
+ *
+ * @param   handle                Pruss's driver handle
+ *
+ * @return  0 in case of successful transition, -1 otherwise. \n
+ */
+int32_t PRUICSS_pruIntcClear(PRUICSS_Handle handle)
+{
+    uint32_t baseaddr;
+    PRUICSS_HwAttrs      const    *hwAttrs;
+    PRUICSS_V1_Object    *object;
+
+    uint32_t i = 0;
+
+    uint32_t temp_addr = 0U;
+
+    int32_t ret_val = PRUICSS_RETURN_SUCCESS;
+
+    hwAttrs = handle->hwAttrs;
+    baseaddr = hwAttrs->baseAddr;
+    object = handle->object;
+
+    if(object->instance == PRUICCSS_INSTANCE_ONE) 
+    {
+        baseaddr = hwAttrs->prussIntcRegBase;
+    }
+    else if(object->instance == PRUICCSS_INSTANCE_TWO ) 
+    {
+        baseaddr = hwAttrs->prussIntcRegBase;
+    }
+    else
+    {
+        ret_val = PRUICSS_RETURN_FAILURE;
+    }
+    for (i = 0; i < (PRUICSS_NUM_PRU_SYS_EVTS + 3U) >> 2; i++)
+   {
+        temp_addr = ((baseaddr +  CSL_ICSSINTC_CMR0 ) + (i << 2));
+        HWREG(temp_addr) = 0;
+    }
+
+    for (i = 0; i < (PRUICSS_NUM_PRU_HOSTS + 3U) >> 2; i++)
+    {
+        temp_addr = (baseaddr  +  CSL_ICSSINTC_HMR0 + (i << 2));
+        HWREG(temp_addr) = 0;
+    }
+
+    HWREG(baseaddr + CSL_ICSSINTC_ESR0) = 0;
 
+    HWREG(baseaddr + CSL_ICSSINTC_SECR0) = 0;
 
+    HWREG(baseaddr + CSL_ICSSINTC_ERS1) = 0;
 
+    HWREG(baseaddr + CSL_ICSSINTC_SECR1) = 0;
+
+    HWREG(baseaddr + CSL_ICSSINTC_HIER) = 0;
+
+    HWREG(baseaddr + CSL_ICSSINTC_GER) = 0;
+
+    return ret_val;
+}