Changeset d51838f in mainline for uspace/drv/platform/icp/icp.c

Timestamp:

2017-10-14T22:49:18Z (7 years ago)

Author:

Jiri Svoboda <jiri@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

75911d24

Parents:

ce732e74

Message:

Let leaf drivers enable/disable/clear interrupts via hw_res instead of directly using irc.

File:

• uspace/drv/platform/icp/icp.c (modified) (3 diffs)

uspace/drv/platform/icp/icp.c

@@ -39 +39 @@
 #include <stdio.h>
 #include <errno.h>
+#include <irc.h>
 #include <stdbool.h>
 #include <stdlib.h>
@@ -142 +143 @@
 }
 
-static int icp_enable_interrupt(ddf_fun_t *fun, int irq)
-{
-        /* TODO */
+static bool icp_fun_owns_interrupt(icp_fun_t *fun, int irq)
+{
+        const hw_resource_list_t *res = &fun->hw_resources;
+
+        /* Check that specified irq really belongs to the function */
+        for (size_t i = 0; i < res->count; ++i) {
+                if (res->resources[i].type == INTERRUPT &&
+                    res->resources[i].res.interrupt.irq == irq) {
+                        return true;
+                }
+        }
+
         return false;
+}
+
+static int icp_fun_enable_interrupt(ddf_fun_t *fnode, int irq)
+{
+        icp_fun_t *fun = icp_fun(fnode);
+
+        if (!icp_fun_owns_interrupt(fun, irq))
+                return EINVAL;
+
+        return irc_enable_interrupt(irq);
 }
 
@@ -155 +175 @@
 static hw_res_ops_t icp_hw_res_ops = {
         .get_resource_list = &icp_get_resources,
-        .enable_interrupt = &icp_enable_interrupt,
+        .enable_interrupt = &icp_fun_enable_interrupt,
 };