Changes in / [94c0dcbd:28d7185] in mainline
- Location:
- uspace/drv
- Files:
-
- 7 edited
Legend:
- Unmodified
- Added
- Removed
-
uspace/drv/ohci/root_hub.c
r94c0dcbd r28d7185 217 217 instance->registers->rh_desc_a |= RHDA_NPS_FLAG; 218 218 instance->unfinished_interrupt_transfer = NULL; 219 instance->interrupt_buffer = malloc((instance->port_count + 8)/8);220 219 usb_log_info("OHCI root hub with %d ports.\n", instance->port_count); 221 220 return EOK; … … 472 471 size_t * buffer_size) { 473 472 int bit_count = instance->port_count + 1; 474 (*buffer_size) = (bit_count +7 / 8);475 476 (*buffer) = instance->interrupt_buffer;//malloc(*buffer_size);473 (*buffer_size) = (bit_count / 8) + ((bit_count % 8 == 0) ? 0 : 1); 474 475 (*buffer) = malloc(*buffer_size); 477 476 uint8_t * bitmap = (uint8_t*) (*buffer); 478 477 uint32_t mask = (1 << (USB_HUB_FEATURE_C_HUB_LOCAL_POWER + 16)) -
uspace/drv/ohci/root_hub.h
r94c0dcbd r28d7185 56 56 /** interrupt transfer waiting for an actual interrupt to occur */ 57 57 usb_transfer_batch_t * unfinished_interrupt_transfer; 58 /** pre-allocated interrupt mask59 *60 * This is allocated when initializing instance, so that memory61 * allocation is not needed when processing request.62 */63 uint8_t * interrupt_buffer;64 58 } rh_t; 65 59 -
uspace/drv/uhci-hcd/hc.c
r94c0dcbd r28d7185 44 44 #include "hc.h" 45 45 46 #define UHCI_INTR_ALLOW_INTERRUPTS \ 47 (UHCI_INTR_CRC | UHCI_INTR_COMPLETE | UHCI_INTR_SHORT_PACKET) 48 #define UHCI_STATUS_USED_INTERRUPTS \ 49 (UHCI_STATUS_INTERRUPT | UHCI_STATUS_ERROR_INTERRUPT) 50 51 46 static irq_cmd_t uhci_cmds[] = { 47 { 48 .cmd = CMD_PIO_READ_16, 49 .addr = NULL, /* patched for every instance */ 50 .dstarg = 1 51 }, 52 { 53 .cmd = CMD_PIO_WRITE_16, 54 .addr = NULL, /* pathed for every instance */ 55 .value = 0x1f 56 }, 57 { 58 .cmd = CMD_ACCEPT 59 } 60 }; 61 /*----------------------------------------------------------------------------*/ 52 62 static int hc_init_transfer_lists(hc_t *instance); 53 63 static int hc_init_mem_structures(hc_t *instance); … … 141 151 /* Enable all interrupts, but resume interrupt */ 142 152 pio_write_16(&instance->registers->usbintr, 143 UHCI_INTR_ ALLOW_INTERRUPTS);153 UHCI_INTR_CRC | UHCI_INTR_COMPLETE | UHCI_INTR_SHORT_PACKET); 144 154 } 145 155 … … 167 177 { 168 178 assert(instance); 169 #define CHECK_RET_ RETURN(ret, message...) \179 #define CHECK_RET_DEST_CMDS_RETURN(ret, message...) \ 170 180 if (ret != EOK) { \ 171 181 usb_log_error(message); \ 182 if (instance->interrupt_code.cmds != NULL) \ 183 free(instance->interrupt_code.cmds); \ 172 184 return ret; \ 173 185 } else (void) 0 174 186 175 187 /* Init interrupt code */ 176 instance->interrupt_code.cmds = instance->interrupt_commands; 188 instance->interrupt_code.cmds = malloc(sizeof(uhci_cmds)); 189 int ret = (instance->interrupt_code.cmds == NULL) ? ENOMEM : EOK; 190 CHECK_RET_DEST_CMDS_RETURN(ret, 191 "Failed to allocate interrupt cmds space.\n"); 192 177 193 { 178 /* Read status register */ 179 instance->interrupt_commands[0].cmd = CMD_PIO_READ_16; 180 instance->interrupt_commands[0].dstarg = 1; 181 instance->interrupt_commands[0].addr = 182 &instance->registers->usbsts; 183 184 /* Test whether we are the interrupt cause */ 185 instance->interrupt_commands[1].cmd = CMD_BTEST; 186 instance->interrupt_commands[1].value = 187 UHCI_STATUS_USED_INTERRUPTS | UHCI_STATUS_NM_INTERRUPTS; 188 instance->interrupt_commands[1].srcarg = 1; 189 instance->interrupt_commands[1].dstarg = 2; 190 191 /* Predicate cleaning and accepting */ 192 instance->interrupt_commands[2].cmd = CMD_PREDICATE; 193 instance->interrupt_commands[2].value = 2; 194 instance->interrupt_commands[2].srcarg = 2; 195 196 /* Write clean status register */ 197 instance->interrupt_commands[3].cmd = CMD_PIO_WRITE_A_16; 198 instance->interrupt_commands[3].srcarg = 1; 199 instance->interrupt_commands[3].addr = 200 &instance->registers->usbsts; 201 202 /* Accept interrupt */ 203 instance->interrupt_commands[4].cmd = CMD_ACCEPT; 204 205 instance->interrupt_code.cmdcount = UHCI_NEEDED_IRQ_COMMANDS; 194 irq_cmd_t *interrupt_commands = instance->interrupt_code.cmds; 195 memcpy(interrupt_commands, uhci_cmds, sizeof(uhci_cmds)); 196 interrupt_commands[0].addr = 197 (void*)&instance->registers->usbsts; 198 interrupt_commands[1].addr = 199 (void*)&instance->registers->usbsts; 200 instance->interrupt_code.cmdcount = 201 sizeof(uhci_cmds) / sizeof(irq_cmd_t); 206 202 } 207 203 208 204 /* Init transfer lists */ 209 intret = hc_init_transfer_lists(instance);210 CHECK_RET_ RETURN(ret, "Failed to init transfer lists.\n");205 ret = hc_init_transfer_lists(instance); 206 CHECK_RET_DEST_CMDS_RETURN(ret, "Failed to init transfer lists.\n"); 211 207 usb_log_debug("Initialized transfer lists.\n"); 212 208 … … 214 210 instance->frame_list = get_page(); 215 211 ret = instance ? EOK : ENOMEM; 216 CHECK_RET_ RETURN(ret, "Failed to get frame list page.\n");212 CHECK_RET_DEST_CMDS_RETURN(ret, "Failed to get frame list page.\n"); 217 213 usb_log_debug("Initialized frame list at %p.\n", instance->frame_list); 218 214 219 215 /* Set all frames to point to the first queue head */ 220 const uint32_t queue = LINK_POINTER_QH( 221 addr_to_phys(instance->transfers_interrupt.queue_head)); 216 const uint32_t queue = 217 LINK_POINTER_QH(addr_to_phys( 218 instance->transfers_interrupt.queue_head)); 222 219 223 220 unsigned i = 0; … … 232 229 ret = usb_endpoint_manager_init(&instance->ep_manager, 233 230 BANDWIDTH_AVAILABLE_USB11); 234 CHECK_RET_RETURN(ret, "Failed to initialize endpoint manager: %s.\n", 235 str_error(ret)); 236 237 return EOK; 238 #undef CHECK_RET_RETURN 231 assert(ret == EOK); 232 233 return EOK; 234 #undef CHECK_RET_DEST_CMDS_RETURN 239 235 } 240 236 /*----------------------------------------------------------------------------*/ … … 281 277 #ifdef FSBR 282 278 transfer_list_set_next(&instance->transfers_bulk_full, 283 279 &instance->transfers_control_full); 284 280 #endif 285 281 … … 334 330 { 335 331 assert(instance); 332 status |= 1; //Uncomment to work around qemu hang 336 333 /* Lower 2 bits are transaction error and transaction complete */ 337 334 if (status & (UHCI_STATUS_INTERRUPT | UHCI_STATUS_ERROR_INTERRUPT)) { … … 355 352 } 356 353 /* Resume interrupts are not supported */ 357 if (status & UHCI_STATUS_RESUME) {358 usb_log_error("Resume interrupt!\n");359 }360 354 361 355 /* Bits 4 and 5 indicate hc error */ … … 386 380 { 387 381 usb_log_debug("Started interrupt emulator.\n"); 388 hc_t *instance = arg;382 hc_t *instance = (hc_t*)arg; 389 383 assert(instance); 390 384 391 385 while (1) { 392 /* Read and clear status register */386 /* Readd and clear status register */ 393 387 uint16_t status = pio_read_16(&instance->registers->usbsts); 394 388 pio_write_16(&instance->registers->usbsts, status); 395 389 if (status != 0) 396 390 usb_log_debug2("UHCI status: %x.\n", status); 397 // Qemu fails to report stalled communication398 // see https://bugs.launchpad.net/qemu/+bug/757654399 // This is a simple workaround to force queue processing every time400 // status |= 1;401 391 hc_interrupt(instance, status); 402 392 async_usleep(UHCI_INT_EMULATOR_TIMEOUT); … … 412 402 int hc_debug_checker(void *arg) 413 403 { 414 hc_t *instance = arg;404 hc_t *instance = (hc_t*)arg; 415 405 assert(instance); 416 406 -
uspace/drv/uhci-hcd/hc.h
r94c0dcbd r28d7185 69 69 #define UHCI_STATUS_ERROR_INTERRUPT (1 << 1) 70 70 #define UHCI_STATUS_INTERRUPT (1 << 0) 71 #define UHCI_STATUS_NM_INTERRUPTS \72 (UHCI_STATUS_PROCESS_ERROR | UHCI_STATUS_SYSTEM_ERROR)73 71 74 72 /** Interrupt enabled registers */ … … 93 91 #define UHCI_DEBUGER_TIMEOUT 5000000 94 92 #define UHCI_ALLOWED_HW_FAIL 5 95 #define UHCI_NEEDED_IRQ_COMMANDS 596 93 97 94 /* Main HC driver structure */ … … 122 119 /** Code to be executed in kernel interrupt handler */ 123 120 irq_code_t interrupt_code; 124 125 /** Commands that form interrupt code */126 irq_cmd_t interrupt_commands[UHCI_NEEDED_IRQ_COMMANDS];127 121 128 122 /** Fibril periodically checking status register*/ -
uspace/drv/uhci-hcd/pci.c
r94c0dcbd r28d7185 146 146 * write all WC bits in USB legacy register */ 147 147 sysarg_t address = 0xc0; 148 sysarg_t value = 0x af00;148 sysarg_t value = 0x8f00; 149 149 150 150 int rc = async_req_3_0(parent_phone, DEV_IFACE_ID(PCI_DEV_IFACE), -
uspace/drv/uhci-hcd/uhci-hcd.ma
r94c0dcbd r28d7185 20 20 10 pci/ven=8086&dev=2938 21 21 10 pci/ven=8086&dev=2939 22 23 10 pci/ven=8086&dev=24c224 10 pci/ven=8086&dev=24c425 10 pci/ven=8086&dev=24c7 -
uspace/drv/usbhub/usbhub.c
r94c0dcbd r28d7185 105 105 } 106 106 107 //usb_pipe_start_session(hub_info->control_pipe); 107 108 //set hub configuration 108 109 opResult = usb_hub_set_configuration(hub_info); … … 121 122 return opResult; 122 123 } 124 //usb_pipe_end_session(hub_info->control_pipe); 125 123 126 124 127 usb_log_debug("Creating 'hub' function in DDF.\n"); … … 173 176 leave: 174 177 /* FIXME: proper interval. */ 175 async_usleep(1000 * 250);178 async_usleep(1000 * 1000 * 10); 176 179 177 180 return true; … … 215 218 // get hub descriptor 216 219 usb_log_debug("creating serialized descriptor\n"); 220 //void * serialized_descriptor = malloc(USB_HUB_MAX_DESCRIPTOR_SIZE); 217 221 uint8_t serialized_descriptor[USB_HUB_MAX_DESCRIPTOR_SIZE]; 218 222 usb_hub_descriptor_t * descriptor; … … 249 253 sizeof (usb_hub_port_t) * (hub_info->port_count + 1)); 250 254 size_t port; 251 for (port = 0; port < hub_info->port_count + 1; ++port) {255 for (port = 0; port < hub_info->port_count + 1; port++) { 252 256 usb_hub_port_init(&hub_info->ports[port]); 253 257 } 254 258 if(is_power_switched){ 255 259 usb_log_debug("is_power_switched\n"); 256 257 for (port = 1; port <= hub_info->port_count; ++port) { 258 usb_log_debug("powering port %d\n",port); 259 opResult = usb_hub_set_port_feature(hub_info->control_pipe, 260 port, USB_HUB_FEATURE_PORT_POWER); 261 if (opResult != EOK) { 262 usb_log_error("cannot power on port %zu: %s.\n", 263 port, str_error(opResult)); 260 if(has_individual_port_powering){ 261 usb_log_debug("has_individual_port_powering\n"); 262 for (port = 0; port < hub_info->port_count; port++) { 263 opResult = usb_hub_set_port_feature(hub_info->control_pipe, 264 port+1, USB_HUB_FEATURE_PORT_POWER); 265 if (opResult != EOK) { 266 usb_log_error("cannot power on port %zu: %s.\n", 267 port+1, str_error(opResult)); 268 } 264 269 } 265 } 266 if(!has_individual_port_powering){ 270 }else{ 267 271 usb_log_debug("!has_individual_port_powering\n"); 268 272 opResult = usb_hub_set_feature(hub_info->control_pipe, … … 277 281 } 278 282 usb_log_debug2("freeing data\n"); 283 //free(serialized_descriptor); 284 //free(descriptor->devices_removable); 279 285 free(descriptor); 280 286 return EOK; … … 409 415 usb_hub_status_t status) { 410 416 int opResult; 411 if ( !usb_hub_is_status(status,USB_HUB_FEATURE_HUB_LOCAL_POWER)) {417 if (usb_hub_is_status(status,USB_HUB_FEATURE_HUB_LOCAL_POWER)) { 412 418 //restart power on hub 413 419 opResult = usb_hub_set_feature(hub_info->control_pipe, … … 419 425 } else {//power reestablished on hub- restart ports 420 426 size_t port; 421 for (port = 1; port <=hub_info->port_count; ++port) {427 for (port = 0; port < hub_info->port_count; ++port) { 422 428 opResult = usb_hub_set_port_feature( 423 429 hub_info->control_pipe, … … 428 434 } 429 435 } 430 opResult = usb_hub_clear_feature(hub_info->control_pipe,431 USB_HUB_FEATURE_C_HUB_LOCAL_POWER);432 if (opResult != EOK) {433 usb_log_error("cannnot clear hub power change flag: "434 "%d\n",435 opResult);436 }437 436 } 438 437 return opResult;
Note:
See TracChangeset
for help on using the changeset viewer.