added more networking routines

sys/interrupts.c

@@ -23,6 +23,7 @@
  */
 
 #include <stdint.h>
+#include <stdbool.h>
 #include "MCF5475.h"
 #include "bas_utils.h"
 #include "bas_printf.h"
@@ -79,3 +80,146 @@ int register_interrupt_handler(uint8_t source, uint8_t level, uint8_t priority,
 
 	return 0;
 }
+
+#ifndef UIF_MAX_ISR_ENTRY
+#define UIF_MAX_ISR_ENTRY   (20)
+#endif
+
+
+typedef struct
+{
+    int     vector;
+    int     type;
+    int     (*handler)(void *, void *);
+    void    *hdev;
+    void    *harg;
+} ISRENTRY;
+
+ISRENTRY isrtab[UIF_MAX_ISR_ENTRY];
+
+
+void isr_init(void)
+{
+    int index;
+    
+    for (index = 0; index < UIF_MAX_ISR_ENTRY; index++)
+    {
+        isrtab[index].vector = 0;
+        isrtab[index].type = 0;
+        isrtab[index].handler = 0;
+        isrtab[index].hdev = 0;
+        isrtab[index].harg = 0;
+    }
+}
+
+
+int isr_register_handler (
+    int type, int vector, 
+    int (*handler)(void *, void *), void *hdev, void *harg)
+{
+    /*
+     * This function places an interrupt handler in the ISR table,
+     * thereby registering it so that the low-level handler may call it.
+     *
+     * The two parameters are intended for the first arg to be a 
+     * pointer to the device itself, and the second a pointer to a data 
+     * structure used by the device driver for that particular device.
+     */
+    int index;
+
+    if ((vector == 0) || 
+        ((type != ISR_DBUG_ISR) && (type != ISR_USER_ISR)) ||
+        (handler == NULL))
+    {
+        return true;
+    }
+
+    for (index = 0; index < UIF_MAX_ISR_ENTRY; index++)
+    {
+        if ((isrtab[index].vector == vector) &&
+            (isrtab[index].type == type))
+        {
+            /* only one entry of each type per vector */
+            return 0;
+        }
+
+        if (isrtab[index].vector == 0)
+        {
+            isrtab[index].vector = vector;
+            isrtab[index].type = type;
+            isrtab[index].handler = handler;
+            isrtab[index].hdev = hdev;
+            isrtab[index].harg = harg;
+            return 1;
+        }
+    }
+    return false;   /* no available slots */
+}
+
+void isr_remove_handler(int type, int (*handler)(void *, void *))
+{
+    /*
+     * This routine removes from the ISR table all
+     * entries that matches 'type' and 'handler'.
+     */
+    int index;
+
+    for (index = 0; index < UIF_MAX_ISR_ENTRY; index++)
+    {
+        if ((isrtab[index].handler == handler) && 
+            (isrtab[index].type == type))
+        {
+            isrtab[index].vector = 0;
+            isrtab[index].type = 0;
+            isrtab[index].handler = 0;
+            isrtab[index].hdev = 0;
+            isrtab[index].harg = 0;
+        }
+    }
+}
+
+
+bool isr_execute_handler(int vector)
+{
+    /*
+     * This routine searches the ISR table for an entry that matches
+     * 'vector'.  If one is found, then 'handler' is executed.
+     */
+    int index;
+    bool retval = false;
+
+    /*
+     * First locate a dBUG Interrupt Service Routine handler.
+     */
+    for (index = 0; index < UIF_MAX_ISR_ENTRY; index++)
+    {
+        if ((isrtab[index].vector == vector) &&
+            (isrtab[index].type == ISR_DBUG_ISR))
+        {
+            if (isrtab[index].handler(isrtab[index].hdev,isrtab[index].harg))
+            {
+                retval = true;
+                break;
+            }
+        }
+    }
+
+    /*
+     * Try to locate a user-registered Interrupt Service Routine handler.
+     */
+    for (index = 0; index < UIF_MAX_ISR_ENTRY; index++)
+    {
+        if ((isrtab[index].vector == vector) &&
+            (isrtab[index].type == ISR_USER_ISR))
+        {
+            if (isrtab[index].handler(isrtab[index].hdev,isrtab[index].harg))
+            {
+                retval = true;
+                break;
+            }
+        }
+    }
+
+    return retval;
+}
+