Changes in / [0e2fdcf:ac8285d] in mainline
- Location:
- uspace
- Files:
-
- 1 added
- 3 deleted
- 8 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/pciintel/pci.c
r0e2fdcf rac8285d 59 59 #include <ddi.h> 60 60 #include <libarch/ddi.h> 61 #include <pci_dev_iface.h>62 61 63 62 #include "pci.h" … … 122 121 } 123 122 124 static int pci_config_space_write_16(ddf_fun_t *fun, uint32_t address, uint16_t data)125 {126 if (address > 254)127 return EINVAL;128 pci_conf_write_16(PCI_FUN(fun), address, data);129 return EOK;130 }131 132 133 123 static hw_res_ops_t pciintel_hw_res_ops = { 134 124 &pciintel_get_resources, … … 136 126 }; 137 127 138 static pci_dev_iface_t pci_dev_ops = { 139 .config_space_read_8 = NULL, 140 .config_space_read_16 = NULL, 141 .config_space_read_32 = NULL, 142 .config_space_write_8 = NULL, 143 .config_space_write_16 = &pci_config_space_write_16, 144 .config_space_write_32 = NULL 145 }; 146 147 static ddf_dev_ops_t pci_fun_ops = { 148 .interfaces[HW_RES_DEV_IFACE] = &pciintel_hw_res_ops, 149 .interfaces[PCI_DEV_IFACE] = &pci_dev_ops 150 }; 128 static ddf_dev_ops_t pci_fun_ops; 151 129 152 130 static int pci_add_device(ddf_dev_t *); … … 615 593 { 616 594 pci_fun_ops.interfaces[HW_RES_DEV_IFACE] = &pciintel_hw_res_ops; 617 pci_fun_ops.interfaces[PCI_DEV_IFACE] = &pci_dev_ops;618 595 } 619 596 -
uspace/drv/uhci-hcd/main.c
r0e2fdcf rac8285d 34 34 #include <ddf/driver.h> 35 35 #include <ddf/interrupt.h> 36 #include <device/hw_res.h>37 #include <errno.h>38 #include <str_error.h>39 40 36 #include <usb_iface.h> 41 37 #include <usb/ddfiface.h> 38 #include <device/hw_res.h> 39 40 #include <errno.h> 41 42 42 #include <usb/debug.h> 43 43 … … 50 50 51 51 static int uhci_add_device(ddf_dev_t *device); 52 52 53 /*----------------------------------------------------------------------------*/ 53 54 static driver_ops_t uhci_driver_ops = { … … 69 70 } 70 71 /*----------------------------------------------------------------------------*/ 72 #define CHECK_RET_RETURN(ret, message...) \ 73 if (ret != EOK) { \ 74 usb_log_error(message); \ 75 return ret; \ 76 } 77 71 78 static int uhci_add_device(ddf_dev_t *device) 72 79 { 73 80 assert(device); 74 uhci_t *hcd = NULL;75 #define CHECK_RET_FREE_HC_RETURN(ret, message...) \76 if (ret != EOK) { \77 usb_log_error(message); \78 if (hcd != NULL) \79 free(hcd); \80 return ret; \81 }82 81 83 82 usb_log_info("uhci_add_device() called\n"); … … 89 88 int ret = 90 89 pci_get_my_registers(device, &io_reg_base, &io_reg_size, &irq); 91 CHECK_RET_FREE_HC_RETURN(ret, 90 91 CHECK_RET_RETURN(ret, 92 92 "Failed(%d) to get I/O addresses:.\n", ret, device->handle); 93 93 usb_log_info("I/O regs at 0x%X (size %zu), IRQ %d.\n", 94 94 io_reg_base, io_reg_size, irq); 95 95 96 ret = pci_disable_legacy(device); 97 CHECK_RET_FREE_HC_RETURN(ret, 98 "Failed(%d) disable legacy USB: %s.\n", ret, str_error(ret)); 96 // ret = pci_enable_interrupts(device); 97 // CHECK_RET_RETURN(ret, "Failed(%d) to get enable interrupts:\n", ret); 99 98 100 #if 0 101 ret = pci_enable_interrupts(device); 99 uhci_t *uhci_hc = malloc(sizeof(uhci_t)); 100 ret = (uhci_hc != NULL) ? EOK : ENOMEM; 101 CHECK_RET_RETURN(ret, "Failed to allocate memory for uhci hcd driver.\n"); 102 103 ret = uhci_init(uhci_hc, device, (void*)io_reg_base, io_reg_size); 102 104 if (ret != EOK) { 103 usb_log_ warning(104 "Failed(%d) to enable interrupts, fall back to polling.\n",105 ret);105 usb_log_error("Failed to init uhci-hcd.\n"); 106 free(uhci_hc); 107 return ret; 106 108 } 107 #endif108 109 hcd = malloc(sizeof(uhci_t));110 ret = (hcd != NULL) ? EOK : ENOMEM;111 CHECK_RET_FREE_HC_RETURN(ret,112 "Failed(%d) to allocate memory for uhci hcd.\n", ret);113 114 ret = uhci_init(hcd, device, (void*)io_reg_base, io_reg_size);115 CHECK_RET_FREE_HC_RETURN(ret, "Failed(%d) to init uhci-hcd.\n",116 ret);117 #undef CHECK_RET_FREE_HC_RETURN118 109 119 110 /* 120 * We might free hcd, but that does not matter since no one111 * We might free uhci_hc, but that does not matter since no one 121 112 * else would access driver_data anyway. 122 113 */ 123 device->driver_data = hcd; 114 device->driver_data = uhci_hc; 115 ret = register_interrupt_handler(device, irq, irq_handler, 116 &uhci_hc->interrupt_code); 117 if (ret != EOK) { 118 usb_log_error("Failed to register interrupt handler.\n"); 119 uhci_fini(uhci_hc); 120 free(uhci_hc); 121 return ret; 122 } 124 123 125 ddf_fun_t *rh = NULL; 126 #define CHECK_RET_FINI_FREE_RETURN(ret, message...) \ 127 if (ret != EOK) { \ 128 usb_log_error(message); \ 129 if (hcd != NULL) {\ 130 uhci_fini(hcd); \ 131 free(hcd); \ 132 } \ 133 if (rh != NULL) \ 134 free(rh); \ 135 return ret; \ 136 } 137 138 /* It does no harm if we register this on polling */ 139 ret = register_interrupt_handler(device, irq, irq_handler, 140 &hcd->interrupt_code); 141 CHECK_RET_FINI_FREE_RETURN(ret, 142 "Failed(%d) to register interrupt handler.\n", ret); 143 124 ddf_fun_t *rh; 144 125 ret = setup_root_hub(&rh, device); 145 CHECK_RET_FINI_FREE_RETURN(ret, 146 "Failed(%d) to setup UHCI root hub.\n", ret); 147 rh->driver_data = hcd->ddf_instance; 126 if (ret != EOK) { 127 usb_log_error("Failed to setup uhci root hub.\n"); 128 uhci_fini(uhci_hc); 129 free(uhci_hc); 130 return ret; 131 } 132 rh->driver_data = uhci_hc->ddf_instance; 148 133 149 134 ret = ddf_fun_bind(rh); 150 CHECK_RET_FINI_FREE_RETURN(ret, 151 "Failed(%d) to register UHCI root hub.\n", ret); 135 if (ret != EOK) { 136 usb_log_error("Failed to register root hub.\n"); 137 uhci_fini(uhci_hc); 138 free(uhci_hc); 139 free(rh); 140 return ret; 141 } 152 142 153 143 return EOK; 154 #undef CHECK_RET_FINI_FREE_RETURN155 144 } 156 145 /*----------------------------------------------------------------------------*/ -
uspace/drv/uhci-hcd/pci.c
r0e2fdcf rac8285d 40 40 41 41 #include <usb/debug.h> 42 #include <pci_dev_iface.h>43 42 44 43 #include "pci.h" … … 129 128 return enabled ? EOK : EIO; 130 129 } 131 /*----------------------------------------------------------------------------*/132 int pci_disable_legacy(ddf_dev_t *device)133 {134 assert(device);135 int parent_phone = devman_parent_device_connect(device->handle,136 IPC_FLAG_BLOCKING);137 if (parent_phone < 0) {138 return parent_phone;139 }140 141 /* See UHCI design guide for these values,142 * write all WC bits in USB legacy register */143 sysarg_t address = 0xc0;144 sysarg_t value = 0x8f00;145 146 int rc = async_req_3_0(parent_phone, DEV_IFACE_ID(PCI_DEV_IFACE),147 IPC_M_CONFIG_SPACE_WRITE_16, address, value);148 async_hangup(parent_phone);149 150 return rc;151 }152 /*----------------------------------------------------------------------------*/153 130 /** 154 131 * @} -
uspace/drv/uhci-hcd/pci.h
r0e2fdcf rac8285d 40 40 int pci_get_my_registers(ddf_dev_t *, uintptr_t *, size_t *, int *); 41 41 int pci_enable_interrupts(ddf_dev_t *); 42 int pci_disable_legacy(ddf_dev_t *);43 42 44 43 #endif -
uspace/drv/uhci-hcd/uhci.c
r0e2fdcf rac8285d 90 90 .interfaces[USBHC_DEV_IFACE] = &uhci_iface, 91 91 }; 92 /*----------------------------------------------------------------------------*/ 92 93 93 static int uhci_init_transfer_lists(uhci_t *instance); 94 94 static int uhci_init_mem_structures(uhci_t *instance); … … 115 115 } else (void) 0 116 116 117 /* Create UHCI function. */ 117 /* 118 * Create UHCI function. 119 */ 118 120 instance->ddf_instance = ddf_fun_create(dev, fun_exposed, "uhci"); 119 121 ret = (instance->ddf_instance == NULL) ? ENOMEM : EOK; 120 CHECK_RET_DEST_FUN_RETURN(ret, 121 "Failed to create UHCI device function.\n"); 122 CHECK_RET_DEST_FUN_RETURN(ret, "Failed to create UHCI device function.\n"); 122 123 123 124 instance->ddf_instance->ops = &uhci_ops; … … 125 126 126 127 ret = ddf_fun_bind(instance->ddf_instance); 127 CHECK_RET_DEST_FUN_RETURN(ret, 128 "Failed(%d) to bind UHCI device function: %s.\n", 128 CHECK_RET_DEST_FUN_RETURN(ret, "Failed(%d) to bind UHCI device function: %s.\n", 129 129 ret, str_error(ret)); 130 130 … … 132 132 regs_t *io; 133 133 ret = pio_enable(regs, reg_size, (void**)&io); 134 CHECK_RET_DEST_FUN_RETURN(ret, 135 "Failed(%d) to gain access to registers at %p: %s.\n", 134 CHECK_RET_DEST_FUN_RETURN(ret, "Failed(%d) to gain access to registers at %p: %s.\n", 136 135 ret, str_error(ret), io); 137 136 instance->registers = io; 138 usb_log_debug("Device registers at %p(%u) accessible.\n", 139 io, reg_size); 137 usb_log_debug("Device registers at %p(%u) accessible.\n", io, reg_size); 140 138 141 139 ret = uhci_init_mem_structures(instance); 142 CHECK_RET_DEST_FUN_RETURN(ret, 143 "Failed to initialize UHCI memory structures.\n"); 140 CHECK_RET_DEST_FUN_RETURN(ret, "Failed to initialize UHCI memory structures.\n"); 144 141 145 142 uhci_init_hw(instance); 146 instance->cleaner = 147 143 144 instance->cleaner = fibril_create(uhci_interrupt_emulator, instance); 148 145 fibril_add_ready(instance->cleaner); 149 146 … … 158 155 void uhci_init_hw(uhci_t *instance) 159 156 { 160 assert(instance);161 162 157 /* reset everything, who knows what touched it before us */ 163 158 pio_write_16(&instance->registers->usbcmd, UHCI_CMD_GLOBAL_RESET); … … 176 171 /* enable all interrupts, but resume interrupt */ 177 172 pio_write_16(&instance->registers->usbintr, 178 173 UHCI_INTR_CRC | UHCI_INTR_COMPLETE | UHCI_INTR_SHORT_PACKET); 179 174 180 175 /* Start the hc with large(64B) packet FSBR */ … … 205 200 interrupt_commands[1].addr = (void*)&instance->registers->usbsts; 206 201 instance->interrupt_code.cmdcount = 207 202 sizeof(uhci_cmds) / sizeof(irq_cmd_t); 208 203 } 209 204 … … 254 249 ret = transfer_list_init(&instance->transfers_bulk_full, "BULK_FULL"); 255 250 CHECK_RET_CLEAR_RETURN(ret, "Failed to init BULK list."); 256 257 251 ret = transfer_list_init(&instance->transfers_control_full, "CONTROL_FULL"); 258 252 CHECK_RET_CLEAR_RETURN(ret, "Failed to init CONTROL FULL list."); 259 260 253 ret = transfer_list_init(&instance->transfers_control_slow, "CONTROL_SLOW"); 261 254 CHECK_RET_CLEAR_RETURN(ret, "Failed to init CONTROL SLOW list."); 262 263 255 ret = transfer_list_init(&instance->transfers_interrupt, "INTERRUPT"); 264 256 CHECK_RET_CLEAR_RETURN(ret, "Failed to init INTERRUPT list."); … … 300 292 low_speed, batch->transfer_type, batch->max_packet_size)) { 301 293 usb_log_warning("Invalid USB packet specified %s SPEED %d %zu.\n", 302 294 low_speed ? "LOW" : "FULL" , batch->transfer_type, 303 295 batch->max_packet_size); 304 296 return ENOTSUP; … … 317 309 { 318 310 assert(instance); 311 // if ((status & (UHCI_STATUS_INTERRUPT | UHCI_STATUS_ERROR_INTERRUPT)) == 0) 312 // return; 313 // usb_log_debug2("UHCI interrupt: %X.\n", status); 319 314 transfer_list_remove_finished(&instance->transfers_interrupt); 320 315 transfer_list_remove_finished(&instance->transfers_control_slow); … … 345 340 uhci_t *instance = (uhci_t*)arg; 346 341 assert(instance); 347 348 #define QH(queue) \349 instance->transfers_##queue.queue_head350 351 342 while (1) { 352 343 const uint16_t cmd = pio_read_16(&instance->registers->usbcmd); 353 344 const uint16_t sts = pio_read_16(&instance->registers->usbsts); 354 const uint16_t intr = 355 pio_read_16(&instance->registers->usbintr); 356 345 const uint16_t intr = pio_read_16(&instance->registers->usbintr); 357 346 if (((cmd & UHCI_CMD_RUN_STOP) != 1) || (sts != 0)) { 358 347 usb_log_debug2("Command: %X Status: %X Intr: %x\n", … … 364 353 if (frame_list != addr_to_phys(instance->frame_list)) { 365 354 usb_log_debug("Framelist address: %p vs. %p.\n", 366 frame_list, addr_to_phys(instance->frame_list)); 367 } 368 355 frame_list, addr_to_phys(instance->frame_list)); 356 } 369 357 int frnum = pio_read_16(&instance->registers->frnum) & 0x3ff; 370 358 usb_log_debug2("Framelist item: %d \n", frnum ); 371 359 372 uintptr_t expected_pa = instance->frame_list[frnum] & (~0xf);373 uintptr_t real_pa = addr_to_phys(QH(interrupt)); 374 if ( expected_pa != real_pa) {360 queue_head_t* qh = instance->transfers_interrupt.queue_head; 361 362 if ((instance->frame_list[frnum] & (~0xf)) != (uintptr_t)addr_to_phys(qh)) { 375 363 usb_log_debug("Interrupt QH: %p vs. %p.\n", 376 expected_pa, real_pa); 377 } 378 379 expected_pa = QH(interrupt)->next_queue & (~0xf); 380 real_pa = addr_to_phys(QH(control_slow)); 381 if (expected_pa != real_pa) { 382 usb_log_debug("Control Slow QH: %p vs. %p.\n", 383 expected_pa, real_pa); 384 } 385 386 expected_pa = QH(control_slow)->next_queue & (~0xf); 387 real_pa = addr_to_phys(QH(control_full)); 388 if (expected_pa != real_pa) { 389 usb_log_debug("Control Full QH: %p vs. %p.\n", 390 expected_pa, real_pa); 391 } 392 393 expected_pa = QH(control_full)->next_queue & (~0xf); 394 real_pa = addr_to_phys(QH(bulk_full)); 395 if (expected_pa != real_pa ) { 396 usb_log_debug("Bulk QH: %p vs. %p.\n", 397 expected_pa, real_pa); 398 } 364 instance->frame_list[frnum] & (~0xf), addr_to_phys(qh)); 365 } 366 367 if ((qh->next_queue & (~0xf)) 368 != (uintptr_t)addr_to_phys(instance->transfers_control_slow.queue_head)) { 369 usb_log_debug("Control Slow QH: %p vs. %p.\n", qh->next_queue & (~0xf), 370 addr_to_phys(instance->transfers_control_slow.queue_head)); 371 } 372 qh = instance->transfers_control_slow.queue_head; 373 374 if ((qh->next_queue & (~0xf)) 375 != (uintptr_t)addr_to_phys(instance->transfers_control_full.queue_head)) { 376 usb_log_debug("Control Full QH: %p vs. %p.\n", qh->next_queue & (~0xf), 377 addr_to_phys(instance->transfers_control_full.queue_head));\ 378 } 379 qh = instance->transfers_control_full.queue_head; 380 381 if ((qh->next_queue & (~0xf)) 382 != (uintptr_t)addr_to_phys(instance->transfers_bulk_full.queue_head)) { 383 usb_log_debug("Bulk QH: %p vs. %p.\n", qh->next_queue & (~0xf), 384 addr_to_phys(instance->transfers_bulk_full.queue_head)); 385 } 386 /* 387 uint16_t cmd = pio_read_16(&instance->registers->usbcmd); 388 cmd |= UHCI_CMD_RUN_STOP; 389 pio_write_16(&instance->registers->usbcmd, cmd); 390 */ 399 391 async_usleep(UHCI_DEBUGER_TIMEOUT); 400 392 } 401 393 return 0; 402 #undef QH403 394 } 404 395 /*----------------------------------------------------------------------------*/ 405 396 bool allowed_usb_packet( 406 397 bool low_speed, usb_transfer_type_t transfer, size_t size) 407 398 { 408 399 /* see USB specification chapter 5.5-5.8 for magic numbers used here */ 409 switch(transfer) 410 { 411 case USB_TRANSFER_ISOCHRONOUS: 412 return (!low_speed && size < 1024); 413 case USB_TRANSFER_INTERRUPT: 414 return size <= (low_speed ? 8 : 64); 415 case USB_TRANSFER_CONTROL: /* device specifies its own max size */ 416 return (size <= (low_speed ? 8 : 64)); 417 case USB_TRANSFER_BULK: /* device specifies its own max size */ 418 return (!low_speed && size <= 64); 400 switch(transfer) { 401 case USB_TRANSFER_ISOCHRONOUS: 402 return (!low_speed && size < 1024); 403 case USB_TRANSFER_INTERRUPT: 404 return size <= (low_speed ? 8 : 64); 405 case USB_TRANSFER_CONTROL: /* device specifies its own max size */ 406 return (size <= (low_speed ? 8 : 64)); 407 case USB_TRANSFER_BULK: /* device specifies its own max size */ 408 return (!low_speed && size <= 64); 419 409 } 420 410 return false; -
uspace/lib/c/include/ipc/dev_iface.h
r0e2fdcf rac8285d 38 38 CHAR_DEV_IFACE, 39 39 40 /** Interface provided by any PCI device. */41 PCI_DEV_IFACE,42 43 40 /** Interface provided by any USB device. */ 44 41 USB_DEV_IFACE, -
uspace/lib/drv/Makefile
r0e2fdcf rac8285d 38 38 generic/remote_hw_res.c \ 39 39 generic/remote_usb.c \ 40 generic/remote_pci.c \41 40 generic/remote_usbhc.c 42 41 -
uspace/lib/drv/generic/dev_iface.c
r0e2fdcf rac8285d 43 43 #include "remote_usb.h" 44 44 #include "remote_usbhc.h" 45 #include "remote_pci.h"46 45 47 46 static iface_dipatch_table_t remote_ifaces = { … … 49 48 &remote_hw_res_iface, 50 49 &remote_char_dev_iface, 51 &remote_pci_iface,52 50 &remote_usb_iface, 53 51 &remote_usbhc_iface
Note:
See TracChangeset
for help on using the changeset viewer.