Changes in uspace/lib/drv/generic/driver.c [dc9a3ba:77a69ea] in mainline

File:

• uspace/lib/drv/generic/driver.c (modified) (3 diffs)

uspace/lib/drv/generic/driver.c

@@ -70 +70 @@
 FIBRIL_MUTEX_INITIALIZE(functions_mutex);
 
+/** Interrupts */
+static interrupt_context_list_t interrupt_contexts;
+
+static irq_cmd_t default_cmds[] = {
+        {
+                .cmd = CMD_ACCEPT
+        }
+};
+
+static irq_code_t default_pseudocode = {
+        sizeof(default_cmds) / sizeof(irq_cmd_t),
+        default_cmds
+};
+
 static ddf_dev_t *create_device(void);
 static void delete_device(ddf_dev_t *);
@@ -78 +92 @@
 static remote_handler_t *function_get_default_handler(ddf_fun_t *);
 static void *function_get_ops(ddf_fun_t *, dev_inferface_idx_t);
+
+static void driver_irq_handler(ipc_callid_t iid, ipc_call_t *icall)
+{
+        int id = (int)IPC_GET_IMETHOD(*icall);
+        interrupt_context_t *ctx;
+        
+        ctx = find_interrupt_context_by_id(&interrupt_contexts, id);
+        if (ctx != NULL && ctx->handler != NULL)
+                (*ctx->handler)(ctx->dev, iid, icall);
+}
+
+interrupt_context_t *create_interrupt_context(void)
+{
+        interrupt_context_t *ctx;
+        
+        ctx = (interrupt_context_t *) malloc(sizeof(interrupt_context_t));
+        if (ctx != NULL)
+                memset(ctx, 0, sizeof(interrupt_context_t));
+        
+        return ctx;
+}
+
+void delete_interrupt_context(interrupt_context_t *ctx)
+{
+        if (ctx != NULL)
+                free(ctx);
+}
+
+void init_interrupt_context_list(interrupt_context_list_t *list)
+{
+        memset(list, 0, sizeof(interrupt_context_list_t));
+        fibril_mutex_initialize(&list->mutex);
+        list_initialize(&list->contexts);
+}
+
+void
+add_interrupt_context(interrupt_context_list_t *list, interrupt_context_t *ctx)
+{
+        fibril_mutex_lock(&list->mutex);
+        ctx->id = list->curr_id++;
+        list_append(&ctx->link, &list->contexts);
+        fibril_mutex_unlock(&list->mutex);
+}
+
+void remove_interrupt_context(interrupt_context_list_t *list,
+    interrupt_context_t *ctx)
+{
+        fibril_mutex_lock(&list->mutex);
+        list_remove(&ctx->link);
+        fibril_mutex_unlock(&list->mutex);
+}
+
+interrupt_context_t *
+find_interrupt_context_by_id(interrupt_context_list_t *list, int id)
+{
+        interrupt_context_t *ctx;
+        
+        fibril_mutex_lock(&list->mutex);
+        
+        list_foreach(list->contexts, link) {
+                ctx = list_get_instance(link, interrupt_context_t, link);
+                if (ctx->id == id) {
+                        fibril_mutex_unlock(&list->mutex);
+                        return ctx;
+                }
+        }
+        
+        fibril_mutex_unlock(&list->mutex);
+        return NULL;
+}
+
+interrupt_context_t *
+find_interrupt_context(interrupt_context_list_t *list, ddf_dev_t *dev, int irq)
+{
+        interrupt_context_t *ctx;
+        
+        fibril_mutex_lock(&list->mutex);
+        
+        list_foreach(list->contexts, link) {
+                ctx = list_get_instance(link, interrupt_context_t, link);
+                if (ctx->irq == irq && ctx->dev == dev) {
+                        fibril_mutex_unlock(&list->mutex);
+                        return ctx;
+                }
+        }
+        
+        fibril_mutex_unlock(&list->mutex);
+        return NULL;
+}
+
+
+int
+register_interrupt_handler(ddf_dev_t *dev, int irq, interrupt_handler_t *handler,
+    irq_code_t *pseudocode)
+{
+        interrupt_context_t *ctx = create_interrupt_context();
+        
+        ctx->dev = dev;
+        ctx->irq = irq;
+        ctx->handler = handler;
+        
+        add_interrupt_context(&interrupt_contexts, ctx);
+        
+        if (pseudocode == NULL)
+                pseudocode = &default_pseudocode;
+        
+        int res = irq_register(irq, dev->handle, ctx->id, pseudocode);
+        if (res != EOK) {
+                remove_interrupt_context(&interrupt_contexts, ctx);
+                delete_interrupt_context(ctx);
+        }
+
+        return res;
+}
+
+int unregister_interrupt_handler(ddf_dev_t *dev, int irq)
+{
+        interrupt_context_t *ctx = find_interrupt_context(&interrupt_contexts,
+            dev, irq);
+        int res = irq_unregister(irq, dev->handle);
+        
+        if (ctx != NULL) {
+                remove_interrupt_context(&interrupt_contexts, ctx);
+                delete_interrupt_context(ctx);
+        }
+        
+        return res;
+}
 
 static void add_to_functions_list(ddf_fun_t *fun)
@@ -850 +992 @@
         driver = drv;
         
-        /* Initialize interrupt module */
-        interrupt_init();
+        /* Initialize the list of interrupt contexts. */
+        init_interrupt_context_list(&interrupt_contexts);
+        
+        /* Set generic interrupt handler. */
+        async_set_interrupt_received(driver_irq_handler);
         
         /*