Changes in uspace/drv/bus/usb/uhci/hc.c [da904f7:58563585] in mainline
- File:
-
- 1 edited
-
uspace/drv/bus/usb/uhci/hc.c (modified) (11 diffs)
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/bus/usb/uhci/hc.c
rda904f7 r58563585 26 26 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 27 27 */ 28 28 29 /** @addtogroup drvusbuhcihc 29 30 * @{ … … 32 33 * @brief UHCI Host controller driver routines 33 34 */ 35 36 #include <adt/list.h> 37 #include <assert.h> 38 #include <async.h> 39 #include <ddi.h> 40 #include <device/hw_res_parsed.h> 41 #include <fibril.h> 34 42 #include <errno.h> 43 #include <macros.h> 44 #include <mem.h> 45 #include <stdlib.h> 35 46 #include <str_error.h> 36 #include <adt/list.h> 37 #include <ddi.h> 47 #include <sys/types.h> 38 48 39 49 #include <usb/debug.h> 40 50 #include <usb/usb.h> 41 51 #include <usb/host/utils/malloc32.h> 52 53 #include "uhci_batch.h" 42 54 #include "hc.h" 43 #include "uhci_batch.h"44 55 45 56 #define UHCI_INTR_ALLOW_INTERRUPTS \ … … 85 96 static int hc_init_mem_structures(hc_t *instance); 86 97 static int hc_init_transfer_lists(hc_t *instance); 87 static int hc_schedule(hcd_t *hcd, usb_transfer_batch_t *batch); 88 89 static int hc_interrupt_emulator(void *arg); 98 90 99 static int hc_debug_checker(void *arg); 91 100 92 enum {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 };101 101 102 102 /** Generate IRQ code. 103 * @param[out] ranges PIO ranges buffer. 104 * @param[in] ranges_size Size of the ranges buffer (bytes). 105 * @param[out] cmds Commands buffer. 106 * @param[in] cmds_size Size of the commands buffer (bytes). 107 * @param[in] regs Device's register range. 103 * @param[out] code IRQ code structure. 104 * @param[in] hw_res Device's resources. 108 105 * 109 106 * @return Error code. 110 107 */ 111 int 112 hc_get_irq_code(irq_pio_range_t ranges[], size_t ranges_size, irq_cmd_t cmds[], 113 size_t cmds_size, addr_range_t *regs) 114 { 115 if ((ranges_size < sizeof(uhci_irq_pio_ranges)) || 116 (cmds_size < sizeof(uhci_irq_commands)) || 117 (RNGSZ(*regs) < sizeof(uhci_regs_t))) 108 int uhci_hc_gen_irq_code(irq_code_t *code, const hw_res_list_parsed_t *hw_res) 109 { 110 assert(code); 111 assert(hw_res); 112 113 if (hw_res->irqs.count != 1 || hw_res->io_ranges.count != 1) 114 return EINVAL; 115 const addr_range_t regs = hw_res->io_ranges.ranges[0]; 116 117 if (RNGSZ(regs) < sizeof(uhci_regs_t)) 118 118 return EOVERFLOW; 119 119 120 memcpy(ranges, uhci_irq_pio_ranges, sizeof(uhci_irq_pio_ranges)); 121 ranges[0].base = RNGABS(*regs); 122 123 memcpy(cmds, uhci_irq_commands, sizeof(uhci_irq_commands)); 124 uhci_regs_t *registers = (uhci_regs_t *) RNGABSPTR(*regs); 125 cmds[0].addr = (void *) ®isters->usbsts; 126 cmds[3].addr = (void *) ®isters->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 */ 140 int 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 } 168 169 return EOK; 120 code->ranges = malloc(sizeof(uhci_irq_pio_ranges)); 121 if (code->ranges == NULL) 122 return ENOMEM; 123 124 code->cmds = malloc(sizeof(uhci_irq_commands)); 125 if (code->cmds == NULL) { 126 free(code->ranges); 127 return ENOMEM; 128 } 129 130 code->rangecount = ARRAY_SIZE(uhci_irq_pio_ranges); 131 code->cmdcount = ARRAY_SIZE(uhci_irq_commands); 132 133 memcpy(code->ranges, uhci_irq_pio_ranges, sizeof(uhci_irq_pio_ranges)); 134 code->ranges[0].base = RNGABS(regs); 135 136 memcpy(code->cmds, uhci_irq_commands, sizeof(uhci_irq_commands)); 137 uhci_regs_t *registers = (uhci_regs_t *) RNGABSPTR(regs); 138 code->cmds[0].addr = (void*)®isters->usbsts; 139 code->cmds[3].addr = (void*)®isters->usbsts; 140 141 usb_log_debug("I/O regs at %p (size %zu), IRQ %d.\n", 142 RNGABSPTR(regs), RNGSZ(regs), hw_res->irqs.irqs[0]); 143 144 return hw_res->irqs.irqs[0]; 170 145 } 171 146 172 147 /** Take action based on the interrupt cause. 173 148 * 174 * @param[in] instance UHCIstructure to use.149 * @param[in] hcd HCD structure to use. 175 150 * @param[in] status Value of the status register at the time of interrupt. 176 151 * … … 180 155 * - resume from suspend state (not implemented) 181 156 */ 182 void hc_interrupt(hc_t *instance, uint16_t status) 183 { 157 void uhci_hc_interrupt(hcd_t *hcd, uint32_t status) 158 { 159 assert(hcd); 160 hc_t *instance = hcd_get_driver_data(hcd); 184 161 assert(instance); 185 162 /* Lower 2 bits are transaction error and transaction complete */ … … 195 172 &instance->transfers_bulk_full, &done); 196 173 197 while (!list_empty(&done)) { 198 link_t *item = list_first(&done); 199 list_remove(item); 174 list_foreach_safe(done, current, next) { 175 list_remove(current); 200 176 uhci_transfer_batch_t *batch = 201 uhci_transfer_batch_from_link( item);177 uhci_transfer_batch_from_link(current); 202 178 uhci_transfer_batch_finish_dispose(batch); 203 179 } … … 230 206 * 231 207 * @param[in] instance Memory place to initialize. 232 * @param[in] HC function node233 208 * @param[in] regs Range of device's I/O control registers. 234 209 * @param[in] interrupts True if hw interrupts should be used. … … 239 214 * interrupt fibrils. 240 215 */ 241 int hc_init(hc_t *instance, ddf_fun_t *fun, addr_range_t *regs, bool interrupts) 242 { 243 assert(regs->size >= sizeof(uhci_regs_t)); 244 int rc; 216 int hc_init(hc_t *instance, const hw_res_list_parsed_t *hw_res, bool interrupts) 217 { 218 assert(instance); 219 assert(hw_res); 220 if (hw_res->io_ranges.count != 1 || 221 hw_res->io_ranges.ranges[0].size < sizeof(uhci_regs_t)) 222 return EINVAL; 245 223 246 224 instance->hw_interrupts = interrupts; … … 248 226 249 227 /* allow access to hc control registers */ 250 uhci_regs_t *io; 251 rc = pio_enable_range(regs, (void **) &io); 252 if (rc != EOK) { 253 usb_log_error("Failed to gain access to registers at %p: %s.\n", 254 io, str_error(rc)); 255 return rc; 256 } 257 258 instance->registers = io; 259 usb_log_debug( 260 "Device registers at %p (%zuB) accessible.\n", io, regs->size); 261 262 rc = hc_init_mem_structures(instance); 263 if (rc != EOK) { 264 usb_log_error("Failed to initialize UHCI memory structures: %s.\n", 265 str_error(rc)); 266 return rc; 267 } 268 269 instance->generic = ddf_fun_data_alloc(fun, sizeof(hcd_t)); 270 if (instance->generic == NULL) { 271 usb_log_error("Out of memory.\n"); 272 return ENOMEM; 273 } 274 275 hcd_init(instance->generic, USB_SPEED_FULL, 276 BANDWIDTH_AVAILABLE_USB11, bandwidth_count_usb11); 277 278 instance->generic->private_data = instance; 279 instance->generic->schedule = hc_schedule; 280 instance->generic->ep_add_hook = NULL; 228 int ret = pio_enable_range(&hw_res->io_ranges.ranges[0], 229 (void **) &instance->registers); 230 if (ret != EOK) { 231 usb_log_error("Failed to gain access to registers: %s.\n", 232 str_error(ret)); 233 return ret; 234 } 235 236 usb_log_debug("Device registers at %" PRIx64 " (%zuB) accessible.\n", 237 hw_res->io_ranges.ranges[0].address.absolute, 238 hw_res->io_ranges.ranges[0].size); 239 240 ret = hc_init_mem_structures(instance); 241 if (ret != EOK) { 242 usb_log_error("Failed to init UHCI memory structures: %s.\n", 243 str_error(ret)); 244 // TODO: we should disable pio here 245 return ret; 246 } 281 247 282 248 hc_init_hw(instance); 283 if (!interrupts) {284 instance->interrupt_emulator =285 fibril_create(hc_interrupt_emulator, instance);286 fibril_add_ready(instance->interrupt_emulator);287 }288 249 (void)hc_debug_checker; 289 250 251 uhci_rh_init(&instance->rh, instance->registers->ports, "uhci"); 252 290 253 return EOK; 254 } 255 256 /** Safely dispose host controller internal structures 257 * 258 * @param[in] instance Host controller structure to use. 259 */ 260 void hc_fini(hc_t *instance) 261 { 262 assert(instance); 263 //TODO Implement 291 264 } 292 265 … … 432 405 instance->transfers[USB_SPEED_FULL][USB_TRANSFER_BULK] = 433 406 &instance->transfers_bulk_full; 434 instance->transfers[USB_SPEED_LOW][USB_TRANSFER_BULK] = 435 &instance->transfers_bulk_full; 436 407 408 return EOK; 409 } 410 411 int uhci_hc_status(hcd_t *hcd, uint32_t *status) 412 { 413 assert(hcd); 414 assert(status); 415 hc_t *instance = hcd_get_driver_data(hcd); 416 assert(instance); 417 418 *status = 0; 419 if (instance->registers) { 420 uint16_t s = pio_read_16(&instance->registers->usbsts); 421 pio_write_16(&instance->registers->usbsts, s); 422 *status = s; 423 } 437 424 return EOK; 438 425 } … … 446 433 * Checks for bandwidth availability and appends the batch to the proper queue. 447 434 */ 448 int hc_schedule(hcd_t *hcd, usb_transfer_batch_t *batch)435 int uhci_hc_schedule(hcd_t *hcd, usb_transfer_batch_t *batch) 449 436 { 450 437 assert(hcd); 451 hc_t *instance = hcd ->private_data;438 hc_t *instance = hcd_get_driver_data(hcd); 452 439 assert(instance); 453 440 assert(batch); 441 442 if (batch->ep->address == uhci_rh_get_address(&instance->rh)) 443 return uhci_rh_schedule(&instance->rh, batch); 444 454 445 uhci_transfer_batch_t *uhci_batch = uhci_transfer_batch_get(batch); 455 446 if (!uhci_batch) { … … 463 454 transfer_list_add_batch(list, uhci_batch); 464 455 465 return EOK;466 }467 468 /** Polling function, emulates interrupts.469 *470 * @param[in] arg UHCI hc structure to use.471 * @return EOK (should never return)472 */473 int hc_interrupt_emulator(void* arg)474 {475 usb_log_debug("Started interrupt emulator.\n");476 hc_t *instance = arg;477 assert(instance);478 479 while (1) {480 /* Read and clear status register */481 uint16_t status = pio_read_16(&instance->registers->usbsts);482 pio_write_16(&instance->registers->usbsts, status);483 if (status != 0)484 usb_log_debug2("UHCI status: %x.\n", status);485 hc_interrupt(instance, status);486 async_usleep(UHCI_INT_EMULATOR_TIMEOUT);487 }488 456 return EOK; 489 457 }
Note:
See TracChangeset
for help on using the changeset viewer.
