Changes in uspace/drv/bus/usb/uhci/hc.c [7de1988c:ad5f149] in mainline

File:

• uspace/drv/bus/usb/uhci/hc.c (modified) (7 diffs)

uspace/drv/bus/usb/uhci/hc.c

@@ -32 +32 @@
  * @brief UHCI Host controller driver routines
  */
+
+#include <adt/list.h>
+#include <assert.h>
+#include <async.h>
+#include <ddi.h>
+#include <device/hw_res_parsed.h>
+#include <fibril.h>
 #include <errno.h>
+#include <macros.h>
+#include <mem.h>
+#include <stdlib.h>
 #include <str_error.h>
-#include <adt/list.h>
-#include <ddi.h>
+#include <sys/types.h>
 
 #include <usb/debug.h>
 #include <usb/usb.h>
 
+#include "uhci_batch.h"
+#include "utils/malloc32.h"
 #include "hc.h"
-#include "uhci_batch.h"
 
 #define UHCI_INTR_ALLOW_INTERRUPTS \
@@ -85 +95 @@
 static int hc_init_mem_structures(hc_t *instance);
 static int hc_init_transfer_lists(hc_t *instance);
-static int hc_schedule(hcd_t *hcd, usb_transfer_batch_t *batch);
 
 static int hc_interrupt_emulator(void *arg);
 static int hc_debug_checker(void *arg);
 
-enum {
-        /** Number of PIO ranges used in IRQ code */
-        hc_irq_pio_range_count =
-            sizeof(uhci_irq_pio_ranges) / sizeof(irq_pio_range_t),
-
-        /* Number of commands used in IRQ code */
-        hc_irq_cmd_count =
-            sizeof(uhci_irq_commands) / sizeof(irq_cmd_t)
-};
 
 /** Generate IRQ code.
- * @param[out] ranges PIO ranges buffer.
- * @param[in] ranges_size Size of the ranges buffer (bytes).
- * @param[out] cmds Commands buffer.
- * @param[in] cmds_size Size of the commands buffer (bytes).
+ * @param[out] code IRQ code structure.
  * @param[in] regs Device's register range.
  *
  * @return Error code.
  */
-int
-hc_get_irq_code(irq_pio_range_t ranges[], size_t ranges_size, irq_cmd_t cmds[],
-    size_t cmds_size, addr_range_t *regs)
-{
-        if ((ranges_size < sizeof(uhci_irq_pio_ranges)) ||
-            (cmds_size < sizeof(uhci_irq_commands)) ||
-            (RNGSZ(*regs) < sizeof(uhci_regs_t)))
+int hc_gen_irq_code(irq_code_t *code, addr_range_t *regs)
+{
+        assert(code);
+
+        if (RNGSZ(*regs) < sizeof(uhci_regs_t))
                 return EOVERFLOW;
 
-        memcpy(ranges, uhci_irq_pio_ranges, sizeof(uhci_irq_pio_ranges));
-        ranges[0].base = RNGABS(*regs);
-
-        memcpy(cmds, uhci_irq_commands, sizeof(uhci_irq_commands));
+        code->ranges = malloc(sizeof(uhci_irq_pio_ranges));
+        if (code->ranges == NULL)
+                return ENOMEM;
+
+        code->cmds = malloc(sizeof(uhci_irq_commands));
+        if (code->cmds == NULL) {
+                free(code->ranges);
+                return ENOMEM;
+        }
+
+        code->rangecount = ARRAY_SIZE(uhci_irq_pio_ranges);
+        code->cmdcount = ARRAY_SIZE(uhci_irq_commands);
+
+        memcpy(code->ranges, uhci_irq_pio_ranges, sizeof(uhci_irq_pio_ranges));
+        code->ranges[0].base = RNGABS(*regs);
+
+        memcpy(code->cmds, uhci_irq_commands, sizeof(uhci_irq_commands));
         uhci_regs_t *registers = (uhci_regs_t *) RNGABSPTR(*regs);
-        cmds[0].addr = &registers->usbsts;
-        cmds[3].addr = &registers->usbsts;
-
-        return EOK;
-}
-
-/** Register interrupt handler.
- *
- * @param[in] device Host controller DDF device
- * @param[in] regs Register range
- * @param[in] irq Interrupt number
- * @paran[in] handler Interrupt handler
- *
- * @return EOK on success or negative error code
- */
-int hc_register_irq_handler(ddf_dev_t *device, addr_range_t *regs, int irq,
-    interrupt_handler_t handler)
-{
-        int rc;
-        irq_pio_range_t irq_ranges[hc_irq_pio_range_count];
-        irq_cmd_t irq_cmds[hc_irq_cmd_count];
-        rc = hc_get_irq_code(irq_ranges, sizeof(irq_ranges), irq_cmds,
-            sizeof(irq_cmds), regs);
-        if (rc != EOK) {
-                usb_log_error("Failed to generate IRQ commands: %s.\n",
-                    str_error(rc));
-                return rc;
-        }
-
-        irq_code_t irq_code = {
-                .rangecount = hc_irq_pio_range_count,
-                .ranges = irq_ranges,
-                .cmdcount = hc_irq_cmd_count,
-                .cmds = irq_cmds
-        };
-
-        /* Register handler to avoid interrupt lockup */
-        rc = register_interrupt_handler(device, irq, handler, &irq_code);
-        if (rc != EOK) {
-                usb_log_error("Failed to register interrupt handler: %s.\n",
-                    str_error(rc));
-                return rc;
-        }
+        code->cmds[0].addr = (void*)&registers->usbsts;
+        code->cmds[3].addr = (void*)&registers->usbsts;
 
         return EOK;
@@ -195 +162 @@
                     &instance->transfers_bulk_full, &done);
 
-                while (!list_empty(&done)) {
-                        link_t *item = list_first(&done);
-                        list_remove(item);
+                list_foreach_safe(done, current, next) {
+                        list_remove(current);
                         uhci_transfer_batch_t *batch =
-                            uhci_transfer_batch_from_link(item);
+                            uhci_transfer_batch_from_link(current);
                         uhci_transfer_batch_finish_dispose(batch);
                 }
@@ -240 +206 @@
 int hc_init(hc_t *instance, addr_range_t *regs, bool interrupts)
 {
+        assert(instance);
+        assert(regs);
         assert(regs->size >= sizeof(uhci_regs_t));
-        int rc;
 
         instance->hw_interrupts = interrupts;
@@ -248 +215 @@
         /* allow access to hc control registers */
         uhci_regs_t *io;
-        rc = pio_enable_range(regs, (void **) &io);
-        if (rc != EOK) {
+        int ret = pio_enable_range(regs, (void **) &io);
+        if (ret != EOK) {
                 usb_log_error("Failed to gain access to registers at %p: %s.\n",
-                    io, str_error(rc));
-                return rc;
-        }
-
+                    io, str_error(ret));
+                return ret;
+        }
         instance->registers = io;
+
         usb_log_debug(
             "Device registers at %p (%zuB) accessible.\n", io, regs->size);
 
-        rc = hc_init_mem_structures(instance);
-        if (rc != EOK) {
-                usb_log_error("Failed to initialize UHCI memory structures: %s.\n",
-                    str_error(rc));
-                return rc;
-        }
-
-        hcd_init(&instance->generic, USB_SPEED_FULL,
-            BANDWIDTH_AVAILABLE_USB11, bandwidth_count_usb11);
-
-        instance->generic.private_data = instance;
-        instance->generic.schedule = hc_schedule;
-        instance->generic.ep_add_hook = NULL;
+        ret = hc_init_mem_structures(instance);
+        if (ret != EOK) {
+                usb_log_error("Failed to init UHCI memory structures: %s.\n",
+                    str_error(ret));
+                // TODO: we should disable pio here
+                return ret;
+        }
 
         hc_init_hw(instance);
@@ -280 +241 @@
         }
         (void)hc_debug_checker;
+
+        uhci_rh_init(&instance->rh, instance->registers->ports, "uhci");
 
         return EOK;
@@ -440 +403 @@
 {
         assert(hcd);
-        hc_t *instance = hcd->private_data;
+        hc_t *instance = hcd->driver.data;
         assert(instance);
         assert(batch);
+
+        if (batch->ep->address == uhci_rh_get_address(&instance->rh))
+                return uhci_rh_schedule(&instance->rh, batch);
+
         uhci_transfer_batch_t *uhci_batch = uhci_transfer_batch_get(batch);
         if (!uhci_batch) {