Changeset 7d6a676 in mainline for uspace/drv/ohci/hc.c

Timestamp:

2011-03-21T14:20:23Z (14 years ago)

Author:

Jan Vesely <jano.vesely@…>

Branches:

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

Children:

5d1db18

Parents:

925e099

Message:

Add interrupt emulator

File:

• uspace/drv/ohci/hc.c (modified) (3 diffs)

uspace/drv/ohci/hc.c

@@ -45 +45 @@
 #include "hc.h"
 
-static int dummy_reset(int foo, void *arg)
-{
-        hc_t *hc = (hc_t*)arg;
-        assert(hc);
-        hc->rh.address = 0;
-        return EOK;
-}
+static int dummy_reset(int foo, void *arg);
+static int interrupt_emulator(hc_t *instance);
 /*----------------------------------------------------------------------------*/
 int hc_init(hc_t *instance, ddf_fun_t *fun, ddf_dev_t *dev,
@@ -66 +61 @@
         instance->ddf_instance = fun;
         device_keeper_init(&instance->manager);
+
+        if (!interrupts) {
+                instance->interrupt_emulator =
+                    fibril_create((int(*)(void*))interrupt_emulator, instance);
+                fibril_add_ready(instance->interrupt_emulator);
+        }
 
 
@@ -117 +118 @@
 }
 /*----------------------------------------------------------------------------*/
-void hc_interrupt(hc_t *instance, uint16_t status)
+void hc_interrupt(hc_t *instance, uint32_t status)
 {
         assert(instance);
-        /* TODO: Check for interrupt cause */
-        rh_interrupt(&instance->rh);
+        if (status == 0)
+                return;
+        if (status & IS_RHSC)
+                rh_interrupt(&instance->rh);
+
+        /* TODO: Check for further interrupt causes */
         /* TODO: implement */
+}
+/*----------------------------------------------------------------------------*/
+static int dummy_reset(int foo, void *arg)
+{
+        hc_t *hc = (hc_t*)arg;
+        assert(hc);
+        hc->rh.address = 0;
+        return EOK;
+}
+/*----------------------------------------------------------------------------*/
+static int interrupt_emulator(hc_t *instance)
+{
+        assert(instance);
+        usb_log_info("Started interrupt emulator.\n");
+        while (1) {
+                uint32_t status = instance->registers->interrupt_status;
+                instance->registers->interrupt_status = status;
+                hc_interrupt(instance, status);
+                async_usleep(1000);
+        }
+        return EOK;
 }
 /**