Changeset 6210a333 in mainline for uspace/drv/bus/usb/uhci/hc.c

Timestamp:

2013-09-21T05:09:46Z (11 years ago)

Author:

Jan Vesely <jano.vesely@…>

Branches:

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

Children:

19d21728

Parents:

30e8ab4

Message:

uhci, ohci: Cleanup irq code generation.

File:

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

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

@@ -90 +90 @@
 
 
-/** Get number of PIO ranges used in IRQ code.
- * @return Number of ranges.
- */
-size_t hc_irq_pio_range_count(void)
-{
-        return sizeof(uhci_irq_pio_ranges) / sizeof(irq_pio_range_t);
-}
-
-/** Get number of commands used in IRQ code.
- * @return Number of commands.
- */
-size_t hc_irq_cmd_count(void)
-{
-        return 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 = (void*)&registers->usbsts;
-        cmds[3].addr = (void*)&registers->usbsts;
+        code->cmds[0].addr = (void*)&registers->usbsts;
+        code->cmds[3].addr = (void*)&registers->usbsts;
 
         return EOK;
@@ -148 +140 @@
 {
         assert(device);
-        irq_pio_range_t irq_ranges[hc_irq_pio_range_count()];
-        irq_cmd_t irq_cmds[hc_irq_cmd_count()];
-
-        int ret = hc_get_irq_code(irq_ranges, sizeof(irq_ranges), irq_cmds,
-            sizeof(irq_cmds), regs);
+
+        irq_code_t irq_code = { 0 };
+
+        int ret = hc_gen_irq_code(&irq_code, regs);
         if (ret != EOK) {
                 usb_log_error("Failed to generate IRQ commands: %s.\n",
@@ -158 +149 @@
                 return ret;
         }
-
-        irq_code_t irq_code = {
-                .rangecount = hc_irq_pio_range_count(),
-                .ranges = irq_ranges,
-                .cmdcount = hc_irq_cmd_count(),
-                .cmds = irq_cmds
-        };
+        //TODO we leak memory here
 
         /* Register handler to avoid interrupt lockup */