Ignore:
File:
1 edited

Legend:

Unmodified
Added
Removed
  • uspace/drv/bus/usb/uhci/hc.c

    re0d8b740 r7de1988c  
    8585static int hc_init_mem_structures(hc_t *instance);
    8686static int hc_init_transfer_lists(hc_t *instance);
     87static int hc_schedule(hcd_t *hcd, usb_transfer_batch_t *batch);
    8788
    8889static int hc_interrupt_emulator(void *arg);
    8990static int hc_debug_checker(void *arg);
    9091
    91 
    92 /** Get number of PIO ranges used in IRQ code.
    93  * @return Number of ranges.
    94  */
    95 size_t hc_irq_pio_range_count(void)
    96 {
    97         return sizeof(uhci_irq_pio_ranges) / sizeof(irq_pio_range_t);
    98 }
    99 
    100 /** Get number of commands used in IRQ code.
    101  * @return Number of commands.
    102  */
    103 size_t hc_irq_cmd_count(void)
    104 {
    105         return sizeof(uhci_irq_commands) / sizeof(irq_cmd_t);
    106 }
     92enum {
     93        /** Number of PIO ranges used in IRQ code */
     94        hc_irq_pio_range_count =
     95            sizeof(uhci_irq_pio_ranges) / sizeof(irq_pio_range_t),
     96
     97        /* Number of commands used in IRQ code */
     98        hc_irq_cmd_count =
     99            sizeof(uhci_irq_commands) / sizeof(irq_cmd_t)
     100};
    107101
    108102/** Generate IRQ code.
     
    111105 * @param[out] cmds Commands buffer.
    112106 * @param[in] cmds_size Size of the commands buffer (bytes).
    113  * @param[in] regs Physical address of device's registers.
    114  * @param[in] reg_size Size of the register area (bytes).
     107 * @param[in] regs Device's register range.
    115108 *
    116109 * @return Error code.
     
    118111int
    119112hc_get_irq_code(irq_pio_range_t ranges[], size_t ranges_size, irq_cmd_t cmds[],
    120     size_t cmds_size, uintptr_t regs, size_t reg_size)
     113    size_t cmds_size, addr_range_t *regs)
    121114{
    122115        if ((ranges_size < sizeof(uhci_irq_pio_ranges)) ||
    123116            (cmds_size < sizeof(uhci_irq_commands)) ||
    124             (reg_size < sizeof(uhci_regs_t)))
     117            (RNGSZ(*regs) < sizeof(uhci_regs_t)))
    125118                return EOVERFLOW;
    126119
    127120        memcpy(ranges, uhci_irq_pio_ranges, sizeof(uhci_irq_pio_ranges));
    128         ranges[0].base = regs;
     121        ranges[0].base = RNGABS(*regs);
    129122
    130123        memcpy(cmds, uhci_irq_commands, sizeof(uhci_irq_commands));
    131         uhci_regs_t *registers = (uhci_regs_t *) regs;
    132         cmds[0].addr = (void*)&registers->usbsts;
    133         cmds[3].addr = (void*)&registers->usbsts;
     124        uhci_regs_t *registers = (uhci_regs_t *) RNGABSPTR(*regs);
     125        cmds[0].addr = &registers->usbsts;
     126        cmds[3].addr = &registers->usbsts;
     127
     128        return EOK;
     129}
     130
     131/** Register interrupt handler.
     132 *
     133 * @param[in] device Host controller DDF device
     134 * @param[in] regs Register range
     135 * @param[in] irq Interrupt number
     136 * @paran[in] handler Interrupt handler
     137 *
     138 * @return EOK on success or negative error code
     139 */
     140int hc_register_irq_handler(ddf_dev_t *device, addr_range_t *regs, int irq,
     141    interrupt_handler_t handler)
     142{
     143        int rc;
     144        irq_pio_range_t irq_ranges[hc_irq_pio_range_count];
     145        irq_cmd_t irq_cmds[hc_irq_cmd_count];
     146        rc = hc_get_irq_code(irq_ranges, sizeof(irq_ranges), irq_cmds,
     147            sizeof(irq_cmds), regs);
     148        if (rc != EOK) {
     149                usb_log_error("Failed to generate IRQ commands: %s.\n",
     150                    str_error(rc));
     151                return rc;
     152        }
     153
     154        irq_code_t irq_code = {
     155                .rangecount = hc_irq_pio_range_count,
     156                .ranges = irq_ranges,
     157                .cmdcount = hc_irq_cmd_count,
     158                .cmds = irq_cmds
     159        };
     160
     161        /* Register handler to avoid interrupt lockup */
     162        rc = register_interrupt_handler(device, irq, handler, &irq_code);
     163        if (rc != EOK) {
     164                usb_log_error("Failed to register interrupt handler: %s.\n",
     165                    str_error(rc));
     166                return rc;
     167        }
    134168
    135169        return EOK;
     
    196230 *
    197231 * @param[in] instance Memory place to initialize.
    198  * @param[in] regs Address of I/O control registers.
    199  * @param[in] reg_size Size of I/O control registers.
     232 * @param[in] regs Range of device's I/O control registers.
    200233 * @param[in] interrupts True if hw interrupts should be used.
    201234 * @return Error code.
     
    205238 * interrupt fibrils.
    206239 */
    207 int hc_init(hc_t *instance, void *regs, size_t reg_size, bool interrupts)
    208 {
    209         assert(reg_size >= sizeof(uhci_regs_t));
     240int hc_init(hc_t *instance, addr_range_t *regs, bool interrupts)
     241{
     242        assert(regs->size >= sizeof(uhci_regs_t));
     243        int rc;
    210244
    211245        instance->hw_interrupts = interrupts;
     
    214248        /* allow access to hc control registers */
    215249        uhci_regs_t *io;
    216         int ret = pio_enable(regs, reg_size, (void **)&io);
    217         if (ret != EOK) {
     250        rc = pio_enable_range(regs, (void **) &io);
     251        if (rc != EOK) {
    218252                usb_log_error("Failed to gain access to registers at %p: %s.\n",
    219                     io, str_error(ret));
    220                 return ret;
    221         }
     253                    io, str_error(rc));
     254                return rc;
     255        }
     256
    222257        instance->registers = io;
    223 
    224258        usb_log_debug(
    225             "Device registers at %p (%zuB) accessible.\n", io, reg_size);
    226 
    227         ret = hc_init_mem_structures(instance);
    228         if (ret != EOK) {
    229                 usb_log_error("Failed to init UHCI memory structures: %s.\n",
    230                     str_error(ret));
    231                 // TODO: we should disable pio here
    232                 return ret;
    233         }
     259            "Device registers at %p (%zuB) accessible.\n", io, regs->size);
     260
     261        rc = hc_init_mem_structures(instance);
     262        if (rc != EOK) {
     263                usb_log_error("Failed to initialize UHCI memory structures: %s.\n",
     264                    str_error(rc));
     265                return rc;
     266        }
     267
     268        hcd_init(&instance->generic, USB_SPEED_FULL,
     269            BANDWIDTH_AVAILABLE_USB11, bandwidth_count_usb11);
     270
     271        instance->generic.private_data = instance;
     272        instance->generic.schedule = hc_schedule;
     273        instance->generic.ep_add_hook = NULL;
    234274
    235275        hc_init_hw(instance);
     
    240280        }
    241281        (void)hc_debug_checker;
    242 
    243         uhci_rh_init(&instance->rh, instance->registers->ports, "uhci");
    244282
    245283        return EOK;
     
    405443        assert(instance);
    406444        assert(batch);
    407 
    408         if (batch->ep->address == uhci_rh_get_address(&instance->rh))
    409                 return uhci_rh_schedule(&instance->rh, batch);
    410 
    411445        uhci_transfer_batch_t *uhci_batch = uhci_transfer_batch_get(batch);
    412446        if (!uhci_batch) {
Note: See TracChangeset for help on using the changeset viewer.