Changes in / [c6cb76d:7dfc06fa] in mainline
- Files:
-
- 17 deleted
- 23 edited
Legend:
- Unmodified
- Added
- Removed
-
boot/arch/amd64/Makefile.inc
rc6cb76d r7dfc06fa 50 50 usbhub \ 51 51 usbkbd \ 52 usbhid \53 52 usbmid \ 54 53 usbmouse \ -
uspace/Makefile
rc6cb76d r7dfc06fa 123 123 drv/usbflbk \ 124 124 drv/usbkbd \ 125 drv/usbhid \126 125 drv/usbhub \ 127 126 drv/usbmid \ … … 144 143 drv/usbflbk \ 145 144 drv/usbkbd \ 146 drv/usbhid \147 145 drv/usbhub \ 148 146 drv/usbmid \ -
uspace/drv/ohci/root_hub.c
rc6cb76d r7dfc06fa 47 47 * standart device descriptor for ohci root hub 48 48 */ 49 static const usb_standard_device_descriptor_t ohci_rh_device_descriptor = { 50 .configuration_count = 1, 51 .descriptor_type = USB_DESCTYPE_DEVICE, 52 .device_class = USB_CLASS_HUB, 53 .device_protocol = 0, 54 .device_subclass = 0, 55 .device_version = 0, 56 .length = sizeof (usb_standard_device_descriptor_t), 57 /// \TODO this value is guessed 58 .max_packet_size = 8, 59 .vendor_id = 0x16db, 60 .product_id = 0x0001, 61 /// \TODO these values migt be different 62 .str_serial_number = 0, 63 .usb_spec_version = 0x110, 49 static const usb_standard_device_descriptor_t ohci_rh_device_descriptor = 50 { 51 .configuration_count = 1, 52 .descriptor_type = USB_DESCTYPE_DEVICE, 53 .device_class = USB_CLASS_HUB, 54 .device_protocol = 0, 55 .device_subclass = 0, 56 .device_version = 0, 57 .length = sizeof(usb_standard_device_descriptor_t), 58 /// \TODO this value is guessed 59 .max_packet_size = 8, 60 .vendor_id = 0x16db, 61 .product_id = 0x0001, 62 /// \TODO these values migt be different 63 .str_serial_number = 0, 64 .usb_spec_version = 0x110, 64 65 }; 65 66 … … 68 69 * for ohci root hubs 69 70 */ 70 static const usb_standard_configuration_descriptor_t ohci_rh_conf_descriptor = { 71 static const usb_standard_configuration_descriptor_t ohci_rh_conf_descriptor = 72 { 71 73 /// \TODO some values are default or guessed 72 .attributes = 1 <<7,74 .attributes = 1<<7, 73 75 .configuration_number = 1, 74 76 .descriptor_type = USB_DESCTYPE_CONFIGURATION, 75 77 .interface_count = 1, 76 .length = sizeof 78 .length = sizeof(usb_standard_configuration_descriptor_t), 77 79 .max_power = 100, 78 80 .str_configuration = 0, … … 82 84 * standart ohci root hub interface descriptor 83 85 */ 84 static const usb_standard_interface_descriptor_t ohci_rh_iface_descriptor = { 86 static const usb_standard_interface_descriptor_t ohci_rh_iface_descriptor = 87 { 85 88 .alternate_setting = 0, 86 89 .descriptor_type = USB_DESCTYPE_INTERFACE, … … 91 94 .interface_protocol = 0, 92 95 .interface_subclass = 0, 93 .length = sizeof 96 .length = sizeof(usb_standard_interface_descriptor_t), 94 97 .str_interface = 0, 95 98 }; … … 98 101 * standart ohci root hub endpoint descriptor 99 102 */ 100 static const usb_standard_endpoint_descriptor_t ohci_rh_ep_descriptor = { 103 static const usb_standard_endpoint_descriptor_t ohci_rh_ep_descriptor = 104 { 101 105 .attributes = USB_TRANSFER_INTERRUPT, 102 106 .descriptor_type = USB_DESCTYPE_ENDPOINT, 103 .endpoint_address = 1 + (1 <<7),104 .length = sizeof 107 .endpoint_address = 1 + (1<<7), 108 .length = sizeof(usb_standard_endpoint_descriptor_t), 105 109 .max_packet_size = 8, 106 110 .poll_interval = 255, … … 108 112 109 113 static const uint32_t hub_clear_feature_valid_mask = 110 (1 << USB_HUB_FEATURE_C_HUB_LOCAL_POWER) |111 (1 << USB_HUB_FEATURE_C_HUB_OVER_CURRENT);114 (1 << USB_HUB_FEATURE_C_HUB_LOCAL_POWER) + 115 (1 << USB_HUB_FEATURE_C_HUB_OVER_CURRENT); 112 116 113 117 static const uint32_t hub_clear_feature_by_writing_one_mask = … … 117 121 (1 << USB_HUB_FEATURE_C_HUB_OVER_CURRENT); 118 122 119 123 120 124 static const uint32_t hub_set_feature_direct_mask = 121 125 (1 << USB_HUB_FEATURE_C_HUB_OVER_CURRENT); 122 126 123 127 static const uint32_t port_set_feature_valid_mask = 124 (1 << USB_HUB_FEATURE_PORT_ENABLE) |125 (1 << USB_HUB_FEATURE_PORT_SUSPEND) | 126 (1 << USB_HUB_FEATURE_PORT_RESET) | 127 (1 << USB_HUB_FEATURE_PORT_POWER);128 (1 << USB_HUB_FEATURE_PORT_ENABLE) + 129 (1 << USB_HUB_FEATURE_PORT_SUSPEND) + 130 (1 << USB_HUB_FEATURE_PORT_RESET) + 131 (1 << USB_HUB_FEATURE_PORT_POWER); 128 132 129 133 static const uint32_t port_clear_feature_valid_mask = 130 (1 << USB_HUB_FEATURE_PORT_CONNECTION) | 131 (1 << USB_HUB_FEATURE_PORT_SUSPEND) | 132 (1 << USB_HUB_FEATURE_PORT_OVER_CURRENT) | 133 (1 << USB_HUB_FEATURE_PORT_POWER) | 134 (1 << USB_HUB_FEATURE_C_PORT_CONNECTION) | 135 (1 << USB_HUB_FEATURE_C_PORT_ENABLE) | 136 (1 << USB_HUB_FEATURE_C_PORT_SUSPEND) | 137 (1 << USB_HUB_FEATURE_C_PORT_OVER_CURRENT) | 138 (1 << USB_HUB_FEATURE_C_PORT_RESET); 139 //note that USB_HUB_FEATURE_PORT_POWER bit is translated into 140 //USB_HUB_FEATURE_PORT_LOW_SPEED 141 142 static const uint32_t port_status_change_mask = 143 (1<< USB_HUB_FEATURE_C_PORT_CONNECTION) | 144 (1<< USB_HUB_FEATURE_C_PORT_ENABLE) | 145 (1<< USB_HUB_FEATURE_C_PORT_OVER_CURRENT) | 146 (1<< USB_HUB_FEATURE_C_PORT_RESET) | 147 (1<< USB_HUB_FEATURE_C_PORT_SUSPEND); 148 149 150 static void usb_create_serialized_hub_descriptor(rh_t *instance, 151 uint8_t ** out_result, 152 size_t * out_size); 153 154 static void rh_init_descriptors(rh_t *instance); 155 156 static int process_get_port_status_request(rh_t *instance, uint16_t port, 157 usb_transfer_batch_t * request); 158 159 static int process_get_hub_status_request(rh_t *instance, 160 usb_transfer_batch_t * request); 161 162 static int process_get_status_request(rh_t *instance, 163 usb_transfer_batch_t * request); 164 165 static void create_interrupt_mask(rh_t *instance, void ** buffer, 166 size_t * buffer_size); 167 168 static int process_get_descriptor_request(rh_t *instance, 169 usb_transfer_batch_t *request); 170 171 static int process_get_configuration_request(rh_t *instance, 172 usb_transfer_batch_t *request); 173 174 static int process_hub_feature_set_request(rh_t *instance, uint16_t feature); 175 176 static int process_hub_feature_clear_request(rh_t *instance, 177 uint16_t feature); 178 179 static int process_port_feature_set_request(rh_t *instance, 180 uint16_t feature, uint16_t port); 181 182 static int process_port_feature_clear_request(rh_t *instance, 183 uint16_t feature, uint16_t port); 184 185 static int process_address_set_request(rh_t *instance, 186 uint16_t address); 187 188 static int process_request_with_output(rh_t *instance, 189 usb_transfer_batch_t *request); 190 191 static int process_request_with_input(rh_t *instance, 192 usb_transfer_batch_t *request); 193 194 static int process_request_without_data(rh_t *instance, 195 usb_transfer_batch_t *request); 196 197 static int process_ctrl_request(rh_t *instance, usb_transfer_batch_t *request); 198 199 200 201 202 203 /** Root hub initialization 204 * @return Error code. 205 */ 206 int rh_init(rh_t *instance, ddf_dev_t *dev, ohci_regs_t *regs) { 207 assert(instance); 208 //instance->address = -1; 209 instance->registers = regs; 210 instance->device = dev; 211 instance->port_count = instance->registers->rh_desc_a & 0xff; 212 rh_init_descriptors(instance); 213 // set port power mode to no-power-switching 214 instance->registers->rh_desc_a = 215 instance->registers->rh_desc_a | (1<<9); 216 217 usb_log_info("OHCI root hub with %d ports.\n", instance->port_count); 218 219 //start generic usb hub driver 220 221 /* TODO: implement */ 222 return EOK; 223 } 224 /*----------------------------------------------------------------------------*/ 225 226 /** 227 * process root hub request 228 * 229 * @param instance root hub instance 230 * @param request structure containing both request and response information 231 * @return error code 232 */ 233 int rh_request(rh_t *instance, usb_transfer_batch_t *request) { 234 assert(instance); 235 assert(request); 236 int opResult; 237 if (request->transfer_type == USB_TRANSFER_CONTROL) { 238 usb_log_info("Root hub got CONTROL packet\n"); 239 opResult = process_ctrl_request(instance, request); 240 } else if (request->transfer_type == USB_TRANSFER_INTERRUPT) { 241 usb_log_info("Root hub got INTERRUPT packet\n"); 242 void * buffer; 243 create_interrupt_mask(instance, &buffer, 244 &(request->transfered_size)); 245 memcpy(request->transport_buffer, buffer, 246 request->transfered_size); 247 opResult = EOK; 248 } else { 249 opResult = EINVAL; 250 } 251 usb_transfer_batch_finish_error(request, opResult); 252 return EOK; 253 } 254 255 /*----------------------------------------------------------------------------*/ 256 257 258 void rh_interrupt(rh_t *instance) { 259 usb_log_info("Whoa whoa wait, I`m not supposed to receive any " 260 "interrupts, am I?\n"); 261 /* TODO: implement? */ 262 } 263 /*----------------------------------------------------------------------------*/ 134 (1 << USB_HUB_FEATURE_PORT_CONNECTION) + 135 (1 << USB_HUB_FEATURE_PORT_SUSPEND) + 136 (1 << USB_HUB_FEATURE_PORT_OVER_CURRENT) + 137 (1 << USB_HUB_FEATURE_PORT_POWER) + 138 (1 << USB_HUB_FEATURE_C_PORT_CONNECTION) + 139 (1 << USB_HUB_FEATURE_C_PORT_ENABLE) + 140 (1 << USB_HUB_FEATURE_C_PORT_SUSPEND) + 141 (1 << USB_HUB_FEATURE_C_PORT_OVER_CURRENT) + 142 (1 << USB_HUB_FEATURE_C_PORT_RESET); 143 //note that USB_HUB_FEATURE_PORT_POWER bit is translated into USB_HUB_FEATURE_PORT_LOW_SPEED 144 145 146 264 147 265 148 /** … … 274 157 */ 275 158 static void usb_create_serialized_hub_descriptor(rh_t *instance, 276 uint8_t ** out_result,277 size_t * out_size) {159 uint8_t ** out_result, 160 size_t * out_size) { 278 161 //base size 279 162 size_t size = 7; 280 163 //variable size according to port count 281 164 size_t var_size = instance->port_count / 8 + 282 ((instance->port_count % 8 > 0) ? 1 : 0);165 ((instance->port_count % 8 > 0) ? 1 : 0); 283 166 size += 2 * var_size; 284 167 uint8_t * result = (uint8_t*) malloc(size); 285 bzero(result, 168 bzero(result,size); 286 169 //size 287 170 result[0] = size; … … 291 174 uint32_t hub_desc_reg = instance->registers->rh_desc_a; 292 175 result[3] = 293 ((hub_desc_reg >> 8) %2) +294 (((hub_desc_reg >> 9) %2) << 1) +295 (((hub_desc_reg >> 10) %2) << 2) +296 (((hub_desc_reg >> 11) %2) << 3) +297 (((hub_desc_reg >> 12) %2) << 4);176 ((hub_desc_reg >> 8) %2) + 177 (((hub_desc_reg >> 9) %2) << 1) + 178 (((hub_desc_reg >> 10) %2) << 2) + 179 (((hub_desc_reg >> 11) %2) << 3) + 180 (((hub_desc_reg >> 12) %2) << 4); 298 181 result[4] = 0; 299 182 result[5] = /*descriptor->pwr_on_2_good_time*/ 50; … … 302 185 int port; 303 186 for (port = 1; port <= instance->port_count; ++port) { 304 uint8_t is_non_removable = 305 instance->registers->rh_desc_b >> port % 2; 306 result[7 + port / 8] += 307 is_non_removable << (port % 8); 187 result[7 + port/8] += 188 ((instance->registers->rh_desc_b >> port)%2) << (port%8); 308 189 } 309 190 size_t i; … … 314 195 (*out_size) = size; 315 196 } 316 /*----------------------------------------------------------------------------*/ 197 317 198 318 199 /** initialize hub descriptors … … 322 203 * @instance root hub instance 323 204 */ 324 static void rh_init_descriptors(rh_t *instance) 205 static void rh_init_descriptors(rh_t *instance){ 325 206 memcpy(&instance->descriptors.device, &ohci_rh_device_descriptor, 326 sizeof 327 207 sizeof(ohci_rh_device_descriptor) 208 ); 328 209 usb_standard_configuration_descriptor_t descriptor; 329 memcpy(&descriptor, 330 sizeof(ohci_rh_conf_descriptor));210 memcpy(&descriptor,&ohci_rh_conf_descriptor, 211 sizeof(ohci_rh_conf_descriptor)); 331 212 uint8_t * hub_descriptor; 332 213 size_t hub_desc_size; 333 214 usb_create_serialized_hub_descriptor(instance, &hub_descriptor, 334 &hub_desc_size);215 &hub_desc_size); 335 216 336 217 descriptor.total_length = 337 sizeof (usb_standard_configuration_descriptor_t)+338 sizeof (usb_standard_endpoint_descriptor_t)+339 sizeof (usb_standard_interface_descriptor_t)+340 hub_desc_size;341 218 sizeof(usb_standard_configuration_descriptor_t)+ 219 sizeof(usb_standard_endpoint_descriptor_t)+ 220 sizeof(usb_standard_interface_descriptor_t)+ 221 hub_desc_size; 222 342 223 uint8_t * full_config_descriptor = 343 (uint8_t*) malloc(descriptor.total_length);344 memcpy(full_config_descriptor, &descriptor, sizeof 345 memcpy(full_config_descriptor + sizeof 346 &ohci_rh_iface_descriptor, sizeof(ohci_rh_iface_descriptor));347 memcpy(full_config_descriptor + sizeof 348 sizeof(ohci_rh_iface_descriptor),349 &ohci_rh_ep_descriptor, sizeof(ohci_rh_ep_descriptor));350 memcpy(full_config_descriptor + sizeof 351 sizeof(ohci_rh_iface_descriptor) +352 sizeof(ohci_rh_ep_descriptor),353 hub_descriptor, hub_desc_size);354 224 (uint8_t*) malloc(descriptor.total_length); 225 memcpy(full_config_descriptor, &descriptor, sizeof(descriptor)); 226 memcpy(full_config_descriptor + sizeof(descriptor), 227 &ohci_rh_iface_descriptor, sizeof(ohci_rh_iface_descriptor)); 228 memcpy(full_config_descriptor + sizeof(descriptor) + 229 sizeof(ohci_rh_iface_descriptor), 230 &ohci_rh_ep_descriptor, sizeof(ohci_rh_ep_descriptor)); 231 memcpy(full_config_descriptor + sizeof(descriptor) + 232 sizeof(ohci_rh_iface_descriptor) + 233 sizeof(ohci_rh_ep_descriptor), 234 hub_descriptor, hub_desc_size); 235 355 236 instance->descriptors.configuration = full_config_descriptor; 356 237 instance->descriptors.configuration_size = descriptor.total_length; 357 238 } 239 240 /** Root hub initialization 241 * @return Error code. 242 */ 243 int rh_init(rh_t *instance, ddf_dev_t *dev, ohci_regs_t *regs) 244 { 245 assert(instance); 246 instance->address = -1; 247 instance->registers = regs; 248 instance->device = dev; 249 instance->port_count = instance->registers->rh_desc_a & 0xff; 250 rh_init_descriptors(instance); 251 /// \TODO set port power mode 252 253 254 usb_log_info("OHCI root hub with %d ports.\n", instance->port_count); 255 256 //start generic usb hub driver 257 258 /* TODO: implement */ 259 return EOK; 260 } 358 261 /*----------------------------------------------------------------------------*/ 359 262 … … 369 272 */ 370 273 static int process_get_port_status_request(rh_t *instance, uint16_t port, 371 usb_transfer_batch_t * request){372 if (port < 1 || port >instance->port_count)373 return EINVAL; 374 uint32_t * uint32_buffer = (uint32_t*) 274 usb_transfer_batch_t * request){ 275 if(port<1 || port>instance->port_count) 276 return EINVAL; 277 uint32_t * uint32_buffer = (uint32_t*)request->transport_buffer; 375 278 request->transfered_size = 4; 376 uint32_buffer[0] = instance->registers->rh_port_status[port - 1]; 377 #if 0 378 int i; 379 for (i = 0; i < instance->port_count; ++i) { 380 usb_log_debug("port status %d,x%x\n", 381 instance->registers->rh_port_status[i], 382 instance->registers->rh_port_status[i]); 383 } 384 #endif 385 return EOK; 386 } 387 /*----------------------------------------------------------------------------*/ 279 uint32_buffer[0] = instance->registers->rh_port_status[port -1]; 280 return EOK; 281 } 388 282 389 283 /** … … 397 291 */ 398 292 static int process_get_hub_status_request(rh_t *instance, 399 usb_transfer_batch_t * request) { 400 uint32_t * uint32_buffer = (uint32_t*) request->transport_buffer; 293 usb_transfer_batch_t * request){ 294 uint32_t * uint32_buffer = (uint32_t*)request->transport_buffer; 295 //bits, 0,1,16,17 401 296 request->transfered_size = 4; 402 //bits, 0,1,16,17 403 uint32_t mask = 1 | (1 << 1) | (1 << 16) | (1 << 17); 297 uint32_t mask = 1 & (1<<1) & (1<<16) & (1<<17); 404 298 uint32_buffer[0] = mask & instance->registers->rh_status; 405 299 return EOK; 406 } 407 /*----------------------------------------------------------------------------*/ 300 301 } 302 303 408 304 409 305 /** … … 417 313 */ 418 314 static int process_get_status_request(rh_t *instance, 419 usb_transfer_batch_t * request) { 315 usb_transfer_batch_t * request) 316 { 420 317 size_t buffer_size = request->buffer_size; 421 318 usb_device_request_setup_packet_t * request_packet = 422 (usb_device_request_setup_packet_t*)423 request->setup_buffer;319 (usb_device_request_setup_packet_t*) 320 request->setup_buffer; 424 321 425 322 usb_hub_bm_request_type_t request_type = request_packet->request_type; 426 if (buffer_size < 4/*request_packet->length*/){///\TODO323 if(buffer_size<4/*request_packet->length*/){///\TODO 427 324 usb_log_warning("requested more data than buffer size\n"); 428 325 return EINVAL; 429 326 } 430 327 431 if 328 if(request_type == USB_HUB_REQ_TYPE_GET_HUB_STATUS) 432 329 return process_get_hub_status_request(instance, request); 433 if (request_type == USB_HUB_REQ_TYPE_GET_PORT_STATUS) 434 return process_get_port_status_request(instance, 435 request_packet->index, 436 request); 330 if(request_type == USB_HUB_REQ_TYPE_GET_PORT_STATUS) 331 return process_get_port_status_request(instance, request_packet->index, 332 request); 437 333 return ENOTSUP; 438 334 } 439 /*----------------------------------------------------------------------------*/440 335 441 336 /** … … 444 339 * Result contains bitmap where bit 0 indicates change on hub and 445 340 * bit i indicates change on i`th port (i>0). For more info see 446 * Hub and Port status bitmap specification in USB specification 447 * (chapter 11.13.4) 341 * Hub and Port status bitmap specification in USB specification. 448 342 * @param instance root hub instance 449 343 * @param@out buffer pointer to created interrupt mas … … 451 345 */ 452 346 static void create_interrupt_mask(rh_t *instance, void ** buffer, 453 size_t * buffer_size){347 size_t * buffer_size){ 454 348 int bit_count = instance->port_count + 1; 455 (*buffer_size) = (bit_count / 8) + ((bit_count % 8 == 0) ? 0 : 1); 456 349 (*buffer_size) = (bit_count / 8) + (bit_count%8==0)?0:1; 457 350 (*buffer) = malloc(*buffer_size); 458 uint8_t * bitmap = (uint8_t*) (*buffer); 459 uint32_t mask = (1 << (USB_HUB_FEATURE_C_HUB_LOCAL_POWER + 16)) 460 | (1 << (USB_HUB_FEATURE_C_HUB_OVER_CURRENT + 16)); 461 bzero(bitmap, (*buffer_size)); 462 if (instance->registers->rh_status & mask) { 351 uint8_t * bitmap = (uint8_t*)(*buffer); 352 uint32_t mask = (1<<16) + (1<<17); 353 bzero(bitmap,(*buffer_size)); 354 if(instance->registers->rh_status & mask){ 463 355 bitmap[0] = 1; 464 356 } 465 357 int port; 466 mask = port_status_change_mask; 467 for (port = 1; port <= instance->port_count; ++port) { 468 if (mask & instance->registers->rh_port_status[port - 1]) { 469 bitmap[(port) / 8] += 1 << (port % 8); 470 } 471 } 472 } 473 /*----------------------------------------------------------------------------*/ 474 358 mask = 0; 359 int i; 360 for(i=16;i<=20;++i) 361 mask += 1<<i; 362 for(port = 1; port<=instance->port_count;++port){ 363 if(mask & instance->registers->rh_port_status[port-1]){ 364 bitmap[(port+1)/8] += 1<<(port%8); 365 } 366 } 367 } 368 475 369 /** 476 370 * create answer to a descriptor request … … 483 377 */ 484 378 static int process_get_descriptor_request(rh_t *instance, 485 usb_transfer_batch_t *request){379 usb_transfer_batch_t *request){ 486 380 usb_device_request_setup_packet_t * setup_request = 487 (usb_device_request_setup_packet_t*)request->setup_buffer;381 (usb_device_request_setup_packet_t*)request->setup_buffer; 488 382 size_t size; 489 383 const void * result_descriptor = NULL; 490 384 const uint16_t setup_request_value = setup_request->value_high; 491 //(setup_request->value_low << 8);385 //(setup_request->value_low << 8); 492 386 bool del = false; 493 switch (setup_request_value) {494 case USB_DESCTYPE_HUB:495 {387 switch (setup_request_value) 388 { 389 case USB_DESCTYPE_HUB: { 496 390 uint8_t * descriptor; 497 391 usb_create_serialized_hub_descriptor( 498 392 instance, &descriptor, &size); 499 393 result_descriptor = descriptor; 500 if 394 if(result_descriptor) del = true; 501 395 break; 502 396 } 503 case USB_DESCTYPE_DEVICE: 504 { 397 case USB_DESCTYPE_DEVICE: { 505 398 usb_log_debug("USB_DESCTYPE_DEVICE\n"); 506 399 result_descriptor = &ohci_rh_device_descriptor; 507 size = sizeof 400 size = sizeof(ohci_rh_device_descriptor); 508 401 break; 509 402 } 510 case USB_DESCTYPE_CONFIGURATION: 511 { 403 case USB_DESCTYPE_CONFIGURATION: { 512 404 usb_log_debug("USB_DESCTYPE_CONFIGURATION\n"); 513 405 result_descriptor = instance->descriptors.configuration; … … 515 407 break; 516 408 } 517 case USB_DESCTYPE_INTERFACE: 518 { 409 case USB_DESCTYPE_INTERFACE: { 519 410 usb_log_debug("USB_DESCTYPE_INTERFACE\n"); 520 411 result_descriptor = &ohci_rh_iface_descriptor; 521 size = sizeof 412 size = sizeof(ohci_rh_iface_descriptor); 522 413 break; 523 414 } 524 case USB_DESCTYPE_ENDPOINT: 525 { 415 case USB_DESCTYPE_ENDPOINT: { 526 416 usb_log_debug("USB_DESCTYPE_ENDPOINT\n"); 527 417 result_descriptor = &ohci_rh_ep_descriptor; 528 size = sizeof 418 size = sizeof(ohci_rh_ep_descriptor); 529 419 break; 530 420 } 531 default: 532 { 533 usb_log_debug("USB_DESCTYPE_EINVAL %d \n", 534 setup_request->value); 535 usb_log_debug("\ttype %d\n\trequest %d\n\tvalue " 536 "%d\n\tindex %d\n\tlen %d\n ", 537 setup_request->request_type, 538 setup_request->request, 539 setup_request_value, 540 setup_request->index, 541 setup_request->length 542 ); 421 default: { 422 usb_log_debug("USB_DESCTYPE_EINVAL %d \n",setup_request->value); 423 usb_log_debug("\ttype %d\n\trequest %d\n\tvalue %d\n\tindex %d\n\tlen %d\n ", 424 setup_request->request_type, 425 setup_request->request, 426 setup_request_value, 427 setup_request->index, 428 setup_request->length 429 ); 543 430 return EINVAL; 544 431 } 545 432 } 546 if (request->buffer_size < size){433 if(request->buffer_size < size){ 547 434 size = request->buffer_size; 548 435 } 549 436 request->transfered_size = size; 550 memcpy(request->transport_buffer, result_descriptor, size); 437 memcpy(request->transport_buffer,result_descriptor,size); 438 usb_log_debug("sent desctiptor: %s\n", 439 usb_debug_str_buffer((uint8_t*)request->transport_buffer,size,size)); 551 440 if (del) 552 441 free(result_descriptor); 553 442 return EOK; 554 443 } 555 /*----------------------------------------------------------------------------*/556 444 557 445 /** … … 563 451 * @return error code 564 452 */ 565 static int process_get_configuration_request(rh_t *instance, 566 usb_transfer_batch_t *request){453 static int process_get_configuration_request(rh_t *instance, 454 usb_transfer_batch_t *request){ 567 455 //set and get configuration requests do not have any meaning, only dummy 568 456 //values are returned 569 if 457 if(request->buffer_size != 1) 570 458 return EINVAL; 571 459 request->transport_buffer[0] = 1; … … 573 461 return EOK; 574 462 } 575 /*----------------------------------------------------------------------------*/576 463 577 464 /** 578 465 * process feature-enabling request on hub 579 * 466 * 580 467 * @param instance root hub instance 581 468 * @param feature feature selector … … 583 470 */ 584 471 static int process_hub_feature_set_request(rh_t *instance, 585 uint16_t feature){586 if (!((1 <<feature) & hub_set_feature_valid_mask))472 uint16_t feature){ 473 if(! ((1<<feature) & hub_set_feature_valid_mask)) 587 474 return EINVAL; 588 475 instance->registers->rh_status = 589 (instance->registers->rh_status | (1 << feature)) 590 & (~hub_clear_feature_by_writing_one_mask); 591 return EOK; 592 } 593 /*----------------------------------------------------------------------------*/ 476 (instance->registers->rh_status | (1<<feature)) 477 & (~ hub_clear_feature_by_writing_one_mask); 478 return EOK; 479 } 594 480 595 481 /** … … 601 487 */ 602 488 static int process_hub_feature_clear_request(rh_t *instance, 603 uint16_t feature){604 if (!((1 <<feature) & hub_clear_feature_valid_mask))489 uint16_t feature){ 490 if(! ((1<<feature) & hub_clear_feature_valid_mask)) 605 491 return EINVAL; 606 492 //is the feature cleared directly? 607 if ((1 << feature) & hub_set_feature_direct_mask){493 if ((1<<feature) & hub_set_feature_direct_mask){ 608 494 instance->registers->rh_status = 609 (instance->registers->rh_status & (~(1 <<feature)))610 & (~ hub_clear_feature_by_writing_one_mask);611 } else{//the feature is cleared by writing '1'495 (instance->registers->rh_status & (~(1<<feature))) 496 & (~ hub_clear_feature_by_writing_one_mask); 497 }else{//the feature is cleared by writing '1' 612 498 instance->registers->rh_status = 613 (instance->registers->rh_status 614 & (~hub_clear_feature_by_writing_one_mask)) 615 | (1 << feature); 616 } 617 return EOK; 618 } 619 /*----------------------------------------------------------------------------*/ 499 (instance->registers->rh_status 500 & (~ hub_clear_feature_by_writing_one_mask)) 501 | (1<<feature); 502 } 503 return EOK; 504 } 505 506 620 507 621 508 /** 622 509 * process feature-enabling request on hub 623 * 510 * 624 511 * @param instance root hub instance 625 512 * @param feature feature selector … … 629 516 */ 630 517 static int process_port_feature_set_request(rh_t *instance, 631 uint16_t feature, uint16_t port){632 if (!((1 <<feature) & port_set_feature_valid_mask))633 return EINVAL; 634 if (port < 1 || port >instance->port_count)518 uint16_t feature, uint16_t port){ 519 if(!((1<<feature) & port_set_feature_valid_mask)) 520 return EINVAL; 521 if(port<1 || port>instance->port_count) 635 522 return EINVAL; 636 523 instance->registers->rh_port_status[port - 1] = 637 (instance->registers->rh_port_status[port - 1] | (1 <<feature))638 & (~port_clear_feature_valid_mask);524 (instance->registers->rh_port_status[port - 1] | (1<<feature)) 525 & (~port_clear_feature_valid_mask); 639 526 /// \TODO any error? 640 527 return EOK; 641 528 } 642 /*----------------------------------------------------------------------------*/643 529 644 530 /** … … 652 538 */ 653 539 static int process_port_feature_clear_request(rh_t *instance, 654 uint16_t feature, uint16_t port){655 if (!((1 <<feature) & port_clear_feature_valid_mask))656 return EINVAL; 657 if (port < 1 || port >instance->port_count)658 return EINVAL; 659 if 540 uint16_t feature, uint16_t port){ 541 if(!((1<<feature) & port_clear_feature_valid_mask)) 542 return EINVAL; 543 if(port<1 || port>instance->port_count) 544 return EINVAL; 545 if(feature == USB_HUB_FEATURE_PORT_POWER) 660 546 feature = USB_HUB_FEATURE_PORT_LOW_SPEED; 661 if 547 if(feature == USB_HUB_FEATURE_PORT_SUSPEND) 662 548 feature = USB_HUB_FEATURE_PORT_OVER_CURRENT; 663 549 instance->registers->rh_port_status[port - 1] = 664 (instance->registers->rh_port_status[port - 1]665 & (~port_clear_feature_valid_mask))666 | (1 <<feature);550 (instance->registers->rh_port_status[port - 1] 551 & (~port_clear_feature_valid_mask)) 552 | (1<<feature); 667 553 /// \TODO any error? 668 554 return EOK; 669 555 } 670 /*----------------------------------------------------------------------------*/ 556 671 557 672 558 /** 673 559 * register address to this device 674 * 560 * 675 561 * @param instance root hub instance 676 562 * @param address new address … … 678 564 */ 679 565 static int process_address_set_request(rh_t *instance, 680 uint16_t address){566 uint16_t address){ 681 567 instance->address = address; 682 568 return EOK; 683 569 } 684 /*----------------------------------------------------------------------------*/685 570 686 571 /** … … 694 579 */ 695 580 static int process_request_with_output(rh_t *instance, 696 usb_transfer_batch_t *request){581 usb_transfer_batch_t *request){ 697 582 usb_device_request_setup_packet_t * setup_request = 698 (usb_device_request_setup_packet_t*)request->setup_buffer;699 if (setup_request->request == USB_DEVREQ_GET_STATUS){583 (usb_device_request_setup_packet_t*)request->setup_buffer; 584 if(setup_request->request == USB_DEVREQ_GET_STATUS){ 700 585 usb_log_debug("USB_DEVREQ_GET_STATUS\n"); 701 586 return process_get_status_request(instance, request); 702 587 } 703 if (setup_request->request == USB_DEVREQ_GET_DESCRIPTOR){588 if(setup_request->request == USB_DEVREQ_GET_DESCRIPTOR){ 704 589 usb_log_debug("USB_DEVREQ_GET_DESCRIPTOR\n"); 705 590 return process_get_descriptor_request(instance, request); 706 591 } 707 if (setup_request->request == USB_DEVREQ_GET_CONFIGURATION){592 if(setup_request->request == USB_DEVREQ_GET_CONFIGURATION){ 708 593 usb_log_debug("USB_DEVREQ_GET_CONFIGURATION\n"); 709 594 return process_get_configuration_request(instance, request); … … 711 596 return ENOTSUP; 712 597 } 713 /*----------------------------------------------------------------------------*/714 598 715 599 /** … … 723 607 */ 724 608 static int process_request_with_input(rh_t *instance, 725 usb_transfer_batch_t *request){609 usb_transfer_batch_t *request){ 726 610 usb_device_request_setup_packet_t * setup_request = 727 (usb_device_request_setup_packet_t*)request->setup_buffer;611 (usb_device_request_setup_packet_t*)request->setup_buffer; 728 612 request->transfered_size = 0; 729 if (setup_request->request == USB_DEVREQ_SET_DESCRIPTOR){613 if(setup_request->request == USB_DEVREQ_SET_DESCRIPTOR){ 730 614 return ENOTSUP; 731 615 } 732 if (setup_request->request == USB_DEVREQ_SET_CONFIGURATION){616 if(setup_request->request == USB_DEVREQ_SET_CONFIGURATION){ 733 617 //set and get configuration requests do not have any meaning, 734 618 //only dummy values are returned … … 737 621 return ENOTSUP; 738 622 } 739 /*----------------------------------------------------------------------------*/740 623 741 624 /** … … 749 632 */ 750 633 static int process_request_without_data(rh_t *instance, 751 usb_transfer_batch_t *request){634 usb_transfer_batch_t *request){ 752 635 usb_device_request_setup_packet_t * setup_request = 753 (usb_device_request_setup_packet_t*)request->setup_buffer;636 (usb_device_request_setup_packet_t*)request->setup_buffer; 754 637 request->transfered_size = 0; 755 if (setup_request->request == USB_DEVREQ_CLEAR_FEATURE){756 if (setup_request->request_type == USB_HUB_REQ_TYPE_SET_HUB_FEATURE){638 if(setup_request->request == USB_DEVREQ_CLEAR_FEATURE){ 639 if(setup_request->request_type == USB_HUB_REQ_TYPE_SET_HUB_FEATURE){ 757 640 usb_log_debug("USB_HUB_REQ_TYPE_SET_HUB_FEATURE\n"); 758 641 return process_hub_feature_clear_request(instance, 759 setup_request->value);760 } 761 if (setup_request->request_type == USB_HUB_REQ_TYPE_SET_PORT_FEATURE){642 setup_request->value); 643 } 644 if(setup_request->request_type == USB_HUB_REQ_TYPE_SET_PORT_FEATURE){ 762 645 usb_log_debug("USB_HUB_REQ_TYPE_SET_PORT_FEATURE\n"); 763 646 return process_port_feature_clear_request(instance, 764 setup_request->value,765 setup_request->index);647 setup_request->value, 648 setup_request->index); 766 649 } 767 650 usb_log_debug("USB_HUB_REQ_TYPE_INVALID %d\n", 768 setup_request->request_type);769 return EINVAL; 770 } 771 if (setup_request->request == USB_DEVREQ_SET_FEATURE){772 if (setup_request->request_type == USB_HUB_REQ_TYPE_SET_HUB_FEATURE){651 setup_request->request_type); 652 return EINVAL; 653 } 654 if(setup_request->request == USB_DEVREQ_SET_FEATURE){ 655 if(setup_request->request_type == USB_HUB_REQ_TYPE_SET_HUB_FEATURE){ 773 656 usb_log_debug("USB_HUB_REQ_TYPE_SET_HUB_FEATURE\n"); 774 657 return process_hub_feature_set_request(instance, 775 setup_request->value);776 } 777 if (setup_request->request_type == USB_HUB_REQ_TYPE_SET_PORT_FEATURE){658 setup_request->value); 659 } 660 if(setup_request->request_type == USB_HUB_REQ_TYPE_SET_PORT_FEATURE){ 778 661 usb_log_debug("USB_HUB_REQ_TYPE_SET_PORT_FEATURE\n"); 779 662 return process_port_feature_set_request(instance, 780 setup_request->value, 781 setup_request->index); 782 } 783 usb_log_debug("USB_HUB_REQ_TYPE_INVALID %d\n", 784 setup_request->request_type); 785 return EINVAL; 786 } 787 if (setup_request->request == USB_DEVREQ_SET_ADDRESS) { 663 setup_request->value, 664 setup_request->index); 665 } 666 usb_log_debug("USB_HUB_REQ_TYPE_INVALID %d\n",setup_request->request_type); 667 return EINVAL; 668 } 669 if(setup_request->request == USB_DEVREQ_SET_ADDRESS){ 788 670 usb_log_debug("USB_DEVREQ_SET_ADDRESS\n"); 789 return process_address_set_request(instance, 790 setup_request->value); 791 } 792 usb_log_debug("USB_DEVREQ_SET_ENOTSUP %d\n", 793 setup_request->request_type); 671 return process_address_set_request(instance, setup_request->value); 672 } 673 usb_log_debug("USB_DEVREQ_SET_ENOTSUP %d\n",setup_request->request_type); 794 674 return ENOTSUP; 795 675 } 796 /*----------------------------------------------------------------------------*/797 676 798 677 /** … … 814 693 * @return error code 815 694 */ 816 static int process_ctrl_request(rh_t *instance, usb_transfer_batch_t *request) { 817 if (!request->setup_buffer) { 695 static int process_ctrl_request(rh_t *instance, usb_transfer_batch_t *request){ 696 int opResult; 697 if (request->setup_buffer) { 698 if(sizeof(usb_device_request_setup_packet_t)>request->setup_size){ 699 usb_log_error("setup packet too small\n"); 700 return EINVAL; 701 } 702 usb_log_info("CTRL packet: %s.\n", 703 usb_debug_str_buffer((const uint8_t *)request->setup_buffer, 8, 8)); 704 usb_device_request_setup_packet_t * setup_request = 705 (usb_device_request_setup_packet_t*)request->setup_buffer; 706 if( 707 setup_request->request == USB_DEVREQ_GET_STATUS 708 || setup_request->request == USB_DEVREQ_GET_DESCRIPTOR 709 || setup_request->request == USB_DEVREQ_GET_CONFIGURATION 710 ){ 711 usb_log_debug("processing request with output\n"); 712 opResult = process_request_with_output(instance,request); 713 }else if( 714 setup_request->request == USB_DEVREQ_CLEAR_FEATURE 715 || setup_request->request == USB_DEVREQ_SET_FEATURE 716 || setup_request->request == USB_DEVREQ_SET_ADDRESS 717 ){ 718 usb_log_debug("processing request without additional data\n"); 719 opResult = process_request_without_data(instance,request); 720 }else if(setup_request->request == USB_DEVREQ_SET_DESCRIPTOR 721 || setup_request->request == USB_DEVREQ_SET_CONFIGURATION 722 ){ 723 usb_log_debug("processing request with input\n"); 724 opResult = process_request_with_input(instance,request); 725 }else{ 726 usb_log_warning("received unsuported request: %d\n", 727 setup_request->request 728 ); 729 opResult = ENOTSUP; 730 } 731 }else{ 818 732 usb_log_error("root hub received empty transaction?"); 819 return EINVAL; 820 } 733 opResult = EINVAL; 734 } 735 return opResult; 736 } 737 738 /** 739 * process root hub request 740 * 741 * @param instance root hub instance 742 * @param request structure containing both request and response information 743 * @return error code 744 */ 745 int rh_request(rh_t *instance, usb_transfer_batch_t *request) 746 { 747 assert(instance); 748 assert(request); 821 749 int opResult; 822 if (sizeof (usb_device_request_setup_packet_t) > request->setup_size) { 823 usb_log_error("setup packet too small\n"); 824 return EINVAL; 825 } 826 usb_log_info("CTRL packet: %s.\n", 827 usb_debug_str_buffer( 828 (const uint8_t *) request->setup_buffer, 8, 8)); 829 usb_device_request_setup_packet_t * setup_request = 830 (usb_device_request_setup_packet_t*) 831 request->setup_buffer; 832 switch (setup_request->request) { 833 case USB_DEVREQ_GET_STATUS: 834 case USB_DEVREQ_GET_DESCRIPTOR: 835 case USB_DEVREQ_GET_CONFIGURATION: 836 usb_log_debug("processing request with output\n"); 837 opResult = process_request_with_output( 838 instance, request); 839 break; 840 case USB_DEVREQ_CLEAR_FEATURE: 841 case USB_DEVREQ_SET_FEATURE: 842 case USB_DEVREQ_SET_ADDRESS: 843 usb_log_debug("processing request without " 844 "additional data\n"); 845 opResult = process_request_without_data( 846 instance, request); 847 break; 848 case USB_DEVREQ_SET_DESCRIPTOR: 849 case USB_DEVREQ_SET_CONFIGURATION: 850 usb_log_debug("processing request with " 851 "input\n"); 852 opResult = process_request_with_input( 853 instance, request); 854 break; 855 default: 856 usb_log_warning("received unsuported request: " 857 "%d\n", 858 setup_request->request 859 ); 860 opResult = ENOTSUP; 861 } 862 return opResult; 863 } 864 750 if(request->transfer_type == USB_TRANSFER_CONTROL){ 751 usb_log_info("Root hub got CONTROL packet\n"); 752 opResult = process_ctrl_request(instance,request); 753 }else if(request->transfer_type == USB_TRANSFER_INTERRUPT){ 754 usb_log_info("Root hub got INTERRUPT packet\n"); 755 void * buffer; 756 create_interrupt_mask(instance, &buffer, 757 &(request->transfered_size)); 758 memcpy(request->transport_buffer,buffer, request->transfered_size); 759 opResult = EOK; 760 }else{ 761 opResult = EINVAL; 762 } 763 usb_transfer_batch_finish(request, opResult); 764 return EOK; 765 } 766 /*----------------------------------------------------------------------------*/ 767 768 769 void rh_interrupt(rh_t *instance) 770 { 771 usb_log_info("Whoa whoa wait, I`m not supposed to receive any interrupts, am I?\n"); 772 /* TODO: implement? */ 773 } 865 774 /** 866 775 * @} -
uspace/drv/uhci-hcd/batch.c
rc6cb76d r7dfc06fa 80 80 * transaction and callback. 81 81 */ 82 usb_transfer_batch_t * batch_get(ddf_fun_t *fun, endpoint_t *ep, 83 char *buffer, size_t buffer_size, char* setup_buffer, size_t setup_size, 82 usb_transfer_batch_t * batch_get(ddf_fun_t *fun, usb_target_t target, 83 usb_transfer_type_t transfer_type, size_t max_packet_size, 84 usb_speed_t speed, char *buffer, size_t buffer_size, 85 char* setup_buffer, size_t setup_size, 84 86 usbhc_iface_transfer_in_callback_t func_in, 85 usbhc_iface_transfer_out_callback_t func_out, void *arg )86 { 87 assert(ep); 87 usbhc_iface_transfer_out_callback_t func_out, void *arg, endpoint_t *ep 88 ) 89 { 88 90 assert(func_in == NULL || func_out == NULL); 89 91 assert(func_in != NULL || func_out != NULL); … … 101 103 CHECK_NULL_DISPOSE_RETURN(instance, 102 104 "Failed to allocate batch instance.\n"); 103 usb_target_t target =104 { .address = ep->address, .endpoint = ep->endpoint };105 105 usb_transfer_batch_init(instance, target, 106 ep->transfer_type, ep->speed, ep->max_packet_size,106 transfer_type, speed, max_packet_size, 107 107 buffer, NULL, buffer_size, NULL, setup_size, func_in, 108 108 func_out, arg, fun, ep, NULL); … … 115 115 instance->private_data = data; 116 116 117 data->transfers = 118 (buffer_size + ep->max_packet_size - 1) / ep->max_packet_size; 119 if (ep->transfer_type == USB_TRANSFER_CONTROL) { 117 data->transfers = (buffer_size + max_packet_size - 1) / max_packet_size; 118 if (transfer_type == USB_TRANSFER_CONTROL) { 120 119 data->transfers += 2; 121 120 } … … 179 178 instance, i, data->tds[i].status); 180 179 td_print_status(&data->tds[i]); 181 assert(instance->ep != NULL); 182 183 endpoint_toggle_set(instance->ep, 184 td_toggle(&data->tds[i])); 180 if (instance->ep != NULL) 181 endpoint_toggle_set(instance->ep, 182 td_toggle(&data->tds[i])); 185 183 if (i > 0) 186 184 goto substract_ret; -
uspace/drv/uhci-hcd/batch.h
rc6cb76d r7dfc06fa 44 44 45 45 usb_transfer_batch_t * batch_get( 46 ddf_fun_t *fun, endpoint_t *ep, char *buffer, size_t size, 47 char *setup_buffer, size_t setup_size, 46 ddf_fun_t *fun, 47 usb_target_t target, 48 usb_transfer_type_t transfer_type, 49 size_t max_packet_size, 50 usb_speed_t speed, 51 char *buffer, 52 size_t size, 53 char *setup_buffer, 54 size_t setup_size, 48 55 usbhc_iface_transfer_in_callback_t func_in, 49 56 usbhc_iface_transfer_out_callback_t func_out, 50 void *arg); 57 void *arg, 58 endpoint_t *ep 59 ); 51 60 52 61 void batch_dispose(usb_transfer_batch_t *instance); -
uspace/drv/uhci-hcd/hc.c
rc6cb76d r7dfc06fa 332 332 instance->transfers[batch->speed][batch->transfer_type]; 333 333 assert(list); 334 if (batch->transfer_type == USB_TRANSFER_CONTROL) { 335 usb_device_keeper_use_control( 336 &instance->manager, batch->target); 337 } 334 338 transfer_list_add_batch(list, batch); 335 339 … … 369 373 usb_transfer_batch_t *batch = 370 374 list_get_instance(item, usb_transfer_batch_t, link); 371 usb_transfer_batch_finish(batch); 375 switch (batch->transfer_type) 376 { 377 case USB_TRANSFER_CONTROL: 378 usb_device_keeper_release_control( 379 &instance->manager, batch->target); 380 break; 381 case USB_TRANSFER_INTERRUPT: 382 case USB_TRANSFER_ISOCHRONOUS: { 383 /* 384 int ret = bandwidth_free(&instance->bandwidth, 385 batch->target.address, 386 batch->target.endpoint, 387 batch->direction); 388 if (ret != EOK) 389 usb_log_warning("Failed(%d) to free " 390 "reserved bw: %s.\n", ret, 391 str_error(ret)); 392 */ 393 } 394 default: 395 break; 396 } 397 batch->next_step(batch); 372 398 } 373 399 } -
uspace/drv/uhci-hcd/iface.c
rc6cb76d r7dfc06fa 41 41 #include "hc.h" 42 42 43 static inline int setup_batch(44 ddf_fun_t *fun, usb_target_t target, usb_direction_t direction,45 void *data, size_t size, void * setup_data, size_t setup_size,46 usbhc_iface_transfer_in_callback_t in,47 usbhc_iface_transfer_out_callback_t out, void *arg, const char* name,48 hc_t **hc, usb_transfer_batch_t **batch)49 {50 assert(hc);51 assert(batch);52 assert(fun);53 *hc = fun_to_hc(fun);54 assert(*hc);55 56 size_t res_bw;57 endpoint_t *ep = usb_endpoint_manager_get_ep(&(*hc)->ep_manager,58 target.address, target.endpoint, direction, &res_bw);59 if (ep == NULL) {60 usb_log_error("Endpoint(%d:%d) not registered for %s.\n",61 target.address, target.endpoint, name);62 return ENOENT;63 }64 65 const size_t bw = bandwidth_count_usb11(66 ep->speed, ep->transfer_type, size, ep->max_packet_size);67 if (res_bw < bw) {68 usb_log_error("Endpoint(%d:%d) %s needs %zu bw "69 "but only %zu is reserved.\n",70 name, target.address, target.endpoint, bw, res_bw);71 return ENOSPC;72 }73 usb_log_debug("%s %d:%d %zu(%zu).\n",74 name, target.address, target.endpoint, size, ep->max_packet_size);75 76 assert(ep->speed ==77 usb_device_keeper_get_speed(&(*hc)->manager, target.address));78 // assert(ep->max_packet_size == max_packet_size);79 // assert(ep->transfer_type == USB_TRANSFER_CONTROL);80 81 *batch =82 batch_get(fun, ep, data, size, setup_data, setup_size,83 in, out, arg);84 if (!batch)85 return ENOMEM;86 return EOK;87 }88 89 90 43 /** Reserve default address interface function 91 44 * … … 261 214 size_t size, usbhc_iface_transfer_out_callback_t callback, void *arg) 262 215 { 263 usb_transfer_batch_t *batch = NULL; 264 hc_t *hc = NULL; 265 int ret = setup_batch(fun, target, USB_DIRECTION_OUT, data, size, 266 NULL, 0, NULL, callback, arg, "Interrupt OUT", &hc, &batch); 267 if (ret != EOK) 268 return ret; 216 assert(fun); 217 hc_t *hc = fun_to_hc(fun); 218 assert(hc); 219 220 usb_log_debug("Interrupt OUT %d:%d %zu.\n", 221 target.address, target.endpoint, size); 222 223 size_t res_bw; 224 endpoint_t *ep = usb_endpoint_manager_get_ep(&hc->ep_manager, 225 target.address, target.endpoint, USB_DIRECTION_OUT, &res_bw); 226 if (ep == NULL) { 227 usb_log_error("Endpoint(%d:%d) not registered for INT OUT.\n", 228 target.address, target.endpoint); 229 return ENOENT; 230 } 231 const size_t bw = bandwidth_count_usb11(ep->speed, ep->transfer_type, 232 size, ep->max_packet_size); 233 if (res_bw < bw) 234 { 235 usb_log_error("Endpoint(%d:%d) INT IN needs %zu bw " 236 "but only %zu is reserved.\n", 237 target.address, target.endpoint, bw, res_bw); 238 return ENOENT; 239 } 240 assert(ep->speed == 241 usb_device_keeper_get_speed(&hc->manager, target.address)); 242 assert(ep->transfer_type == USB_TRANSFER_INTERRUPT); 243 244 usb_transfer_batch_t *batch = 245 batch_get(fun, target, ep->transfer_type, ep->max_packet_size, 246 ep->speed, data, size, NULL, 0, NULL, callback, arg, ep); 247 if (!batch) 248 return ENOMEM; 269 249 batch_interrupt_out(batch); 270 ret = hc_schedule(hc, batch);250 const int ret = hc_schedule(hc, batch); 271 251 if (ret != EOK) { 272 252 batch_dispose(batch); … … 289 269 size_t size, usbhc_iface_transfer_in_callback_t callback, void *arg) 290 270 { 291 usb_transfer_batch_t *batch = NULL; 292 hc_t *hc = NULL; 293 int ret = setup_batch(fun, target, USB_DIRECTION_IN, data, size, 294 NULL, 0, callback, NULL, arg, "Interrupt IN", &hc, &batch); 295 if (ret != EOK) 296 return ret; 271 assert(fun); 272 hc_t *hc = fun_to_hc(fun); 273 assert(hc); 274 275 usb_log_debug("Interrupt IN %d:%d %zu.\n", 276 target.address, target.endpoint, size); 277 278 size_t res_bw; 279 endpoint_t *ep = usb_endpoint_manager_get_ep(&hc->ep_manager, 280 target.address, target.endpoint, USB_DIRECTION_IN, &res_bw); 281 if (ep == NULL) { 282 usb_log_error("Endpoint(%d:%d) not registered for INT IN.\n", 283 target.address, target.endpoint); 284 return ENOENT; 285 } 286 const size_t bw = bandwidth_count_usb11(ep->speed, ep->transfer_type, 287 size, ep->max_packet_size); 288 if (res_bw < bw) 289 { 290 usb_log_error("Endpoint(%d:%d) INT IN needs %zu bw " 291 "but only %zu bw is reserved.\n", 292 target.address, target.endpoint, bw, res_bw); 293 return ENOENT; 294 } 295 296 assert(ep->speed == 297 usb_device_keeper_get_speed(&hc->manager, target.address)); 298 assert(ep->transfer_type == USB_TRANSFER_INTERRUPT); 299 300 usb_transfer_batch_t *batch = 301 batch_get(fun, target, ep->transfer_type, ep->max_packet_size, 302 ep->speed, data, size, NULL, 0, callback, NULL, arg, ep); 303 if (!batch) 304 return ENOMEM; 297 305 batch_interrupt_in(batch); 298 ret = hc_schedule(hc, batch);306 const int ret = hc_schedule(hc, batch); 299 307 if (ret != EOK) { 300 308 batch_dispose(batch); … … 317 325 size_t size, usbhc_iface_transfer_out_callback_t callback, void *arg) 318 326 { 319 usb_transfer_batch_t *batch = NULL; 320 hc_t *hc = NULL; 321 int ret = setup_batch(fun, target, USB_DIRECTION_OUT, data, size, 322 NULL, 0, NULL, callback, arg, "Bulk OUT", &hc, &batch); 323 if (ret != EOK) 324 return ret; 327 assert(fun); 328 hc_t *hc = fun_to_hc(fun); 329 assert(hc); 330 331 usb_log_debug("Bulk OUT %d:%d %zu.\n", 332 target.address, target.endpoint, size); 333 334 endpoint_t *ep = usb_endpoint_manager_get_ep(&hc->ep_manager, 335 target.address, target.endpoint, USB_DIRECTION_OUT, NULL); 336 if (ep == NULL) { 337 usb_log_error("Endpoint(%d:%d) not registered for BULK OUT.\n", 338 target.address, target.endpoint); 339 return ENOENT; 340 } 341 assert(ep->speed == 342 usb_device_keeper_get_speed(&hc->manager, target.address)); 343 assert(ep->transfer_type == USB_TRANSFER_BULK); 344 345 usb_transfer_batch_t *batch = 346 batch_get(fun, target, ep->transfer_type, ep->max_packet_size, 347 ep->speed, data, size, NULL, 0, NULL, callback, arg, ep); 348 if (!batch) 349 return ENOMEM; 325 350 batch_bulk_out(batch); 326 ret = hc_schedule(hc, batch);351 const int ret = hc_schedule(hc, batch); 327 352 if (ret != EOK) { 328 353 batch_dispose(batch); … … 345 370 size_t size, usbhc_iface_transfer_in_callback_t callback, void *arg) 346 371 { 347 usb_transfer_batch_t *batch = NULL; 348 hc_t *hc = NULL; 349 int ret = setup_batch(fun, target, USB_DIRECTION_IN, data, size, 350 NULL, 0, callback, NULL, arg, "Bulk IN", &hc, &batch); 351 if (ret != EOK) 352 return ret; 372 assert(fun); 373 hc_t *hc = fun_to_hc(fun); 374 assert(hc); 375 usb_log_debug("Bulk IN %d:%d %zu.\n", 376 target.address, target.endpoint, size); 377 378 endpoint_t *ep = usb_endpoint_manager_get_ep(&hc->ep_manager, 379 target.address, target.endpoint, USB_DIRECTION_IN, NULL); 380 if (ep == NULL) { 381 usb_log_error("Endpoint(%d:%d) not registered for BULK IN.\n", 382 target.address, target.endpoint); 383 return ENOENT; 384 } 385 assert(ep->speed == 386 usb_device_keeper_get_speed(&hc->manager, target.address)); 387 assert(ep->transfer_type == USB_TRANSFER_BULK); 388 389 usb_transfer_batch_t *batch = 390 batch_get(fun, target, ep->transfer_type, ep->max_packet_size, 391 ep->speed, data, size, NULL, 0, callback, NULL, arg, ep); 392 if (!batch) 393 return ENOMEM; 353 394 batch_bulk_in(batch); 354 ret = hc_schedule(hc, batch);395 const int ret = hc_schedule(hc, batch); 355 396 if (ret != EOK) { 356 397 batch_dispose(batch); … … 376 417 usbhc_iface_transfer_out_callback_t callback, void *arg) 377 418 { 378 usb_transfer_batch_t *batch = NULL; 379 hc_t *hc = NULL; 380 int ret = setup_batch(fun, target, USB_DIRECTION_BOTH, data, size, 381 setup_data, setup_size, NULL, callback, arg, "Control WRITE", 382 &hc, &batch); 383 if (ret != EOK) 384 return ret; 419 assert(fun); 420 hc_t *hc = fun_to_hc(fun); 421 assert(hc); 422 usb_speed_t speed = 423 usb_device_keeper_get_speed(&hc->manager, target.address); 424 usb_log_debug("Control WRITE (%d) %d:%d %zu.\n", 425 speed, target.address, target.endpoint, size); 426 endpoint_t *ep = usb_endpoint_manager_get_ep(&hc->ep_manager, 427 target.address, target.endpoint, USB_DIRECTION_BOTH, NULL); 428 if (ep == NULL) { 429 usb_log_warning("Endpoint(%d:%d) not registered for CONTROL.\n", 430 target.address, target.endpoint); 431 } 432 433 if (setup_size != 8) 434 return EINVAL; 435 436 usb_transfer_batch_t *batch = 437 batch_get(fun, target, USB_TRANSFER_CONTROL, ep->max_packet_size, speed, 438 data, size, setup_data, setup_size, NULL, callback, arg, ep); 439 if (!batch) 440 return ENOMEM; 385 441 usb_device_keeper_reset_if_need(&hc->manager, target, setup_data); 386 442 batch_control_write(batch); 387 ret = hc_schedule(hc, batch);443 const int ret = hc_schedule(hc, batch); 388 444 if (ret != EOK) { 389 445 batch_dispose(batch); … … 409 465 usbhc_iface_transfer_in_callback_t callback, void *arg) 410 466 { 411 usb_transfer_batch_t *batch = NULL; 412 hc_t *hc = NULL; 413 int ret = setup_batch(fun, target, USB_DIRECTION_BOTH, data, size, 414 setup_data, setup_size, callback, NULL, arg, "Control READ", 415 &hc, &batch); 416 if (ret != EOK) 417 return ret; 467 assert(fun); 468 hc_t *hc = fun_to_hc(fun); 469 assert(hc); 470 usb_speed_t speed = 471 usb_device_keeper_get_speed(&hc->manager, target.address); 472 473 usb_log_debug("Control READ(%d) %d:%d %zu.\n", 474 speed, target.address, target.endpoint, size); 475 endpoint_t *ep = usb_endpoint_manager_get_ep(&hc->ep_manager, 476 target.address, target.endpoint, USB_DIRECTION_BOTH, NULL); 477 if (ep == NULL) { 478 usb_log_warning("Endpoint(%d:%d) not registered for CONTROL.\n", 479 target.address, target.endpoint); 480 } 481 usb_transfer_batch_t *batch = 482 batch_get(fun, target, USB_TRANSFER_CONTROL, ep->max_packet_size, speed, 483 data, size, setup_data, setup_size, callback, NULL, arg, ep); 484 if (!batch) 485 return ENOMEM; 418 486 batch_control_read(batch); 419 ret = hc_schedule(hc, batch);487 const int ret = hc_schedule(hc, batch); 420 488 if (ret != EOK) { 421 489 batch_dispose(batch); -
uspace/drv/uhci-hcd/transfer_list.c
rc6cb76d r7dfc06fa 132 132 } 133 133 /*----------------------------------------------------------------------------*/ 134 /** Create list for finished batches. 135 * 136 * @param[in] instance List to use. 137 * @param[in] done list to fill 134 /** Check list for finished batches. 135 * 136 * @param[in] instance List to use. 137 * @return Error code 138 * 139 * Creates a local list of finished batches and calls next_step on each and 140 * every one. This is safer because next_step may theoretically access 141 * this transfer list leading to the deadlock if its done inline. 138 142 */ 139 143 void transfer_list_remove_finished(transfer_list_t *instance, link_t *done) … … 157 161 } 158 162 fibril_mutex_unlock(&instance->guard); 163 159 164 } 160 165 /*----------------------------------------------------------------------------*/ … … 171 176 list_get_instance(current, usb_transfer_batch_t, link); 172 177 transfer_list_remove_batch(instance, batch); 173 usb_transfer_batch_finish _error(batch, EIO);178 usb_transfer_batch_finish(batch, EIO); 174 179 } 175 180 fibril_mutex_unlock(&instance->guard); -
uspace/drv/uhci-rhd/root_hub.h
rc6cb76d r7dfc06fa 40 40 41 41 #define UHCI_ROOT_HUB_PORT_COUNT 2 42 #define ROOT_HUB_WAIT_USEC 250000 /* 250 miliseconds */42 #define ROOT_HUB_WAIT_USEC 5000000 /* 5 seconds */ 43 43 44 44 typedef struct root_hub { -
uspace/drv/usbkbd/kbddev.c
rc6cb76d r7dfc06fa 265 265 static void usb_kbd_set_led(usb_kbd_t *kbd_dev) 266 266 { 267 if (kbd_dev->output_size == 0) {268 return;269 }270 271 267 unsigned i = 0; 272 268 … … 292 288 293 289 int rc = usb_hid_report_output_translate(kbd_dev->parser, 294 kbd_dev->led_path, 295 USB_HID_PATH_COMPARE_END | USB_HID_PATH_COMPARE_USAGE_PAGE_ONLY, 296 kbd_dev->output_buffer, 290 kbd_dev->led_path, USB_HID_PATH_COMPARE_END, kbd_dev->output_buffer, 297 291 kbd_dev->output_size, kbd_dev->led_data, kbd_dev->led_output_size); 298 292 … … 545 539 * according to HID Usage Tables. 546 540 * @param count Number of key codes in report (size of the report). 547 * @param report_id541 * @param modifiers Bitmap of modifiers (Ctrl, Alt, Shift, GUI). 548 542 * @param arg User-specified argument. Expects pointer to the keyboard device 549 543 * structure representing the keyboard. … … 552 546 */ 553 547 static void usb_kbd_process_keycodes(const uint8_t *key_codes, size_t count, 554 uint8_t report_id, void *arg)548 uint8_t modifiers, void *arg) 555 549 { 556 550 if (arg == NULL) { … … 563 557 assert(kbd_dev != NULL); 564 558 565 usb_log_debug("Got keys from parser (report id: %u): %s\n",566 report_id,usb_debug_str_buffer(key_codes, count, 0));559 usb_log_debug("Got keys from parser: %s\n", 560 usb_debug_str_buffer(key_codes, count, 0)); 567 561 568 562 if (count != kbd_dev->key_count) { … … 614 608 usb_hid_report_path_t *path = usb_hid_report_path(); 615 609 usb_hid_report_path_append_item(path, USB_HIDUT_PAGE_KEYBOARD, 0); 616 usb_hid_report_path_set_report_id(path, 0);617 610 618 611 int rc = usb_hid_parse_report(kbd_dev->parser, buffer, 619 actual_size, path, 620 USB_HID_PATH_COMPARE_END | USB_HID_PATH_COMPARE_USAGE_PAGE_ONLY, 621 callbacks, kbd_dev); 612 actual_size, path, USB_HID_PATH_COMPARE_STRICT, callbacks, kbd_dev); 622 613 623 614 usb_hid_report_path_free (path); … … 767 758 usb_hid_report_path_t *path = usb_hid_report_path(); 768 759 usb_hid_report_path_append_item(path, USB_HIDUT_PAGE_KEYBOARD, 0); 769 770 usb_hid_report_path_set_report_id(path, 0);771 772 760 kbd_dev->key_count = usb_hid_report_input_length( 773 kbd_dev->parser, path, 774 USB_HID_PATH_COMPARE_END | USB_HID_PATH_COMPARE_USAGE_PAGE_ONLY); 761 kbd_dev->parser, path, USB_HID_PATH_COMPARE_STRICT); 775 762 usb_hid_report_path_free (path); 776 763 … … 790 777 kbd_dev->output_buffer = usb_hid_report_output(kbd_dev->parser, 791 778 &kbd_dev->output_size); 792 if (kbd_dev->output_buffer == NULL && kbd_dev->output_size != 0) {779 if (kbd_dev->output_buffer == NULL) { 793 780 usb_log_warning("Error creating output report buffer.\n"); 794 781 free(kbd_dev->keys); … … 803 790 804 791 kbd_dev->led_output_size = usb_hid_report_output_size(kbd_dev->parser, 805 kbd_dev->led_path, 806 USB_HID_PATH_COMPARE_END | USB_HID_PATH_COMPARE_USAGE_PAGE_ONLY); 792 kbd_dev->led_path, USB_HID_PATH_COMPARE_END); 807 793 808 794 usb_log_debug("Output report size (in items): %zu\n", -
uspace/drv/usbkbd/main.c
rc6cb76d r7dfc06fa 33 33 /** 34 34 * @file 35 * Main routines of USB KBD driver.35 * Main routines of USB HID driver. 36 36 */ 37 37 … … 75 75 * @sa usb_kbd_fibril(), usb_kbd_repeat_fibril() 76 76 */ 77 static int usb _kbd_try_add_device(usb_device_t *dev)77 static int usbhid_try_add_device(usb_device_t *dev) 78 78 { 79 79 /* Create the function exposed under /dev/devices. */ … … 105 105 usb_kbd_free(&kbd_dev); 106 106 return rc; 107 } 107 } 108 108 109 109 usb_log_debug("USB/HID KBD device structure initialized.\n"); … … 195 195 * @retval EREFUSED if the device is not supported. 196 196 */ 197 static int usb _kbd_add_device(usb_device_t *dev)197 static int usbhid_add_device(usb_device_t *dev) 198 198 { 199 usb_log_debug("usb _kbd_add_device()\n");199 usb_log_debug("usbhid_add_device()\n"); 200 200 201 201 if (dev->interface_no < 0) { 202 202 usb_log_warning("Device is not a supported keyboard.\n"); 203 usb_log_error("Failed to add USB KBD device: endpoint not"204 " found.\n");203 usb_log_error("Failed to add HID device: endpoint not found." 204 "\n"); 205 205 return ENOTSUP; 206 206 } 207 207 208 int rc = usb _kbd_try_add_device(dev);208 int rc = usbhid_try_add_device(dev); 209 209 210 210 if (rc != EOK) { 211 211 usb_log_warning("Device is not a supported keyboard.\n"); 212 usb_log_error("Failed to add KBD device: %s.\n",212 usb_log_error("Failed to add HID device: %s.\n", 213 213 str_error(rc)); 214 214 return rc; … … 224 224 /* Currently, the framework supports only device adding. Once the framework 225 225 * supports unplug, more callbacks will be added. */ 226 static usb_driver_ops_t usb _kbd_driver_ops = {227 .add_device = usb _kbd_add_device,226 static usb_driver_ops_t usbhid_driver_ops = { 227 .add_device = usbhid_add_device, 228 228 }; 229 229 230 230 231 231 /* The driver itself. */ 232 static usb_driver_t usb _kbd_driver = {232 static usb_driver_t usbhid_driver = { 233 233 .name = NAME, 234 .ops = &usb _kbd_driver_ops,234 .ops = &usbhid_driver_ops, 235 235 .endpoints = usb_kbd_endpoints 236 236 }; … … 238 238 /*----------------------------------------------------------------------------*/ 239 239 240 //static driver_ops_t kbd_driver_ops = { 241 // .add_device = usbhid_add_device, 242 //}; 243 244 ///*----------------------------------------------------------------------------*/ 245 246 //static driver_t kbd_driver = { 247 // .name = NAME, 248 // .driver_ops = &kbd_driver_ops 249 //}; 250 251 /*----------------------------------------------------------------------------*/ 252 240 253 int main(int argc, char *argv[]) 241 254 { 242 printf(NAME ": HelenOS USB KBD driver.\n");255 printf(NAME ": HelenOS USB HID driver.\n"); 243 256 244 257 usb_log_enable(USB_LOG_LEVEL_DEBUG, NAME); 245 258 246 return usb_driver_main(&usb _kbd_driver);259 return usb_driver_main(&usbhid_driver); 247 260 } 248 261 -
uspace/drv/usbkbd/usbkbd.ma
rc6cb76d r7dfc06fa 1 10 usb&interface&class=HID&subclass=0x01&protocol=0x01 1 100 usb&interface&class=HID&subclass=0x01&protocol=0x01 2 10 usb&interface&class=HID -
uspace/lib/usb/include/usb/classes/hidparser.h
rc6cb76d r7dfc06fa 88 88 /** */ 89 89 int depth; 90 uint8_t report_id;91 90 92 91 /** */ 93 92 link_t link; 94 95 93 } usb_hid_report_path_t; 96 94 … … 157 155 /** */ 158 156 link_t feature; 159 160 int use_report_id;161 162 /** */163 link_t stack;164 157 } usb_hid_report_parser_t; 165 158 … … 173 166 * @param arg Custom argument. 174 167 */ 175 void (*keyboard)(const uint8_t *key_codes, size_t count, const uint8_t report_id, void *arg);168 void (*keyboard)(const uint8_t *key_codes, size_t count, const uint8_t modifiers, void *arg); 176 169 } usb_hid_report_in_callbacks_t; 177 170 … … 276 269 277 270 /** */ 278 int usb_hid_report_path_set_report_id(usb_hid_report_path_t *usage_path, uint8_t report_id);279 280 /** */281 271 int usb_hid_report_path_append_item(usb_hid_report_path_t *usage_path, int32_t usage_page, int32_t usage); 282 272 -
uspace/lib/usb/include/usb/host/batch.h
rc6cb76d r7dfc06fa 92 92 void usb_transfer_batch_call_in(usb_transfer_batch_t *instance); 93 93 void usb_transfer_batch_call_out(usb_transfer_batch_t *instance); 94 void usb_transfer_batch_finish(usb_transfer_batch_t *instance); 95 96 static inline void usb_transfer_batch_finish_error( 97 usb_transfer_batch_t *instance, int error) 98 { 99 assert(instance); 100 instance->error = error; 101 usb_transfer_batch_finish(instance); 102 } 94 void usb_transfer_batch_finish(usb_transfer_batch_t *instance, int error); 103 95 104 96 #endif -
uspace/lib/usb/include/usb/host/device_keeper.h
rc6cb76d r7dfc06fa 96 96 usb_speed_t usb_device_keeper_get_speed(usb_device_keeper_t *instance, 97 97 usb_address_t address); 98 99 void usb_device_keeper_use_control(usb_device_keeper_t *instance, 100 usb_target_t target); 101 102 void usb_device_keeper_release_control(usb_device_keeper_t *instance, 103 usb_target_t target); 104 98 105 #endif 99 106 /** -
uspace/lib/usb/include/usb/host/endpoint.h
rc6cb76d r7dfc06fa 39 39 #include <bool.h> 40 40 #include <adt/list.h> 41 #include <fibril_synch.h>42 43 41 #include <usb/usb.h> 44 42 … … 50 48 usb_speed_t speed; 51 49 size_t max_packet_size; 50 bool active; 52 51 unsigned toggle:1; 53 fibril_mutex_t guard;54 fibril_condvar_t avail;55 volatile bool active;56 52 link_t same_device_eps; 57 53 } endpoint_t; … … 62 58 63 59 void endpoint_destroy(endpoint_t *instance); 64 65 void endpoint_use(endpoint_t *instance);66 67 void endpoint_release(endpoint_t *instance);68 60 69 61 int endpoint_toggle_get(endpoint_t *instance); -
uspace/lib/usb/src/devpoll.c
rc6cb76d r7dfc06fa 66 66 usb_pipe_t *pipe 67 67 = polling_data->dev->pipes[polling_data->pipe_index].pipe; 68 69 usb_log_debug("Pipe interface number: %d, protocol: %d, subclass: %d, max packet size: %d\n",70 polling_data->dev->pipes[polling_data->pipe_index].interface_no,71 polling_data->dev->pipes[polling_data->pipe_index].description->interface_protocol,72 polling_data->dev->pipes[polling_data->pipe_index].description->interface_subclass,73 pipe->max_packet_size);74 68 75 69 size_t failed_attempts = 0; … … 89 83 /* Quit the session regardless of errors. */ 90 84 usb_pipe_end_session(pipe); 91 92 // if (rc == ESTALL) {93 // usb_log_debug("Seding clear feature...\n");94 // usb_request_clear_feature(pipe, USB_REQUEST_TYPE_STANDARD,95 // USB_REQUEST_RECIPIENT_ENDPOINT, 0, pipe->endpoint_no);96 // continue;97 // }98 85 99 86 if (rc != EOK) { -
uspace/lib/usb/src/hidparser.c
rc6cb76d r7dfc06fa 64 64 int usb_hid_report_reset_local_items(); 65 65 void usb_hid_free_report_list(link_t *head); 66 usb_hid_report_item_t *usb_hid_report_item_clone(const usb_hid_report_item_t *item); 66 67 67 /* 68 68 * Data translation private functions … … 106 106 list_initialize(&(parser->feature)); 107 107 108 list_initialize(&(parser->stack));109 110 parser->use_report_id = 0;111 108 return EOK; 112 109 } … … 189 186 tmp_usage_path = NULL; 190 187 191 usb_hid_report_path_set_report_id(report_item->usage_path, report_item->id);192 if(report_item->id != 0){193 parser->use_report_id = 1;194 }195 188 196 189 switch(tag) { … … 222 215 if(!(new_report_item = malloc(sizeof(usb_hid_report_item_t)))) { 223 216 return ENOMEM; 224 } 217 } 225 218 memcpy(new_report_item,report_item, sizeof(usb_hid_report_item_t)); 226 link_initialize(&(new_report_item->link));227 228 219 /* reset local items */ 229 220 new_report_item->usage_minimum = 0; 230 221 new_report_item->usage_maximum = 0; 231 new_report_item->designator_index = 0;232 new_report_item->designator_minimum = 0;233 new_report_item->designator_maximum = 0;234 new_report_item->string_index = 0;235 new_report_item->string_minimum = 0;236 new_report_item->string_maximum = 0;237 238 /* reset usage from current usage path */239 usb_hid_report_usage_path_t *path = list_get_instance(&usage_path->link, usb_hid_report_usage_path_t, link);240 path->usage = 0;241 222 223 link_initialize(&(new_report_item->link)); 242 224 report_item = new_report_item; 243 225 … … 245 227 case USB_HID_REPORT_TAG_PUSH: 246 228 // push current state to stack 247 new_report_item = usb_hid_report_item_clone(report_item); 248 list_prepend (&parser->stack, &new_report_item->link); 249 229 // not yet implemented 250 230 break; 251 231 case USB_HID_REPORT_TAG_POP: 252 232 // restore current state from stack 253 if(list_empty (&parser->stack)) { 254 return EINVAL; 255 } 256 257 report_item = list_get_instance(&parser->stack, usb_hid_report_item_t, link); 258 list_remove (parser->stack.next); 259 233 // not yet implemented 260 234 break; 261 235 … … 673 647 } 674 648 675 parser->use_report_id = 0;676 677 649 usb_hid_free_report_list(&parser->input); 678 650 usb_hid_free_report_list(&parser->output); … … 704 676 size_t i=0; 705 677 size_t j=0; 706 uint8_t report_id = 0;707 678 708 679 if(parser == NULL) { … … 715 686 if(!(keys = malloc(sizeof(uint8_t) * key_count))){ 716 687 return ENOMEM; 717 }718 719 if(parser->use_report_id != 0) {720 report_id = data[0];721 usb_hid_report_path_set_report_id(path, report_id);722 688 } 723 689 … … 727 693 728 694 item = list_get_instance(list_item, usb_hid_report_item_t, link); 729 730 695 if(!USB_HID_ITEM_FLAG_CONSTANT(item->item_flags) && 731 696 (usb_hid_report_compare_usage_path(item->usage_path, path, flags) == EOK)) { … … 750 715 } 751 716 752 callbacks->keyboard(keys, key_count, report_id, arg);717 callbacks->keyboard(keys, key_count, 0, arg); 753 718 754 719 free(keys); … … 774 739 int32_t mask; 775 740 const uint8_t *foo; 776 741 777 742 // now only common numbers llowed 778 743 if(item->size > 32) { … … 793 758 (usb_pow(10,(item->unit_exponent)))); 794 759 } 795 796 760 offset = item->offset + (j * item->size); 797 if(item->id != 0) {798 offset += 8;799 usb_log_debug("MOVED OFFSET BY 1Byte, REPORT_ID(%d)\n", item->id);800 }801 761 802 762 // FIXME … … 982 942 983 943 int only_page; 984 985 if(report_path->report_id != path->report_id) {986 return 1;987 }988 944 989 945 if(path->depth == 0){ … … 1082 1038 else { 1083 1039 path->depth = 0; 1084 path->report_id = 0;1085 1040 list_initialize(&path->link); 1086 1041 return path; … … 1200 1155 return 0; 1201 1156 } 1202 1157 1203 1158 item = parser->output.next; 1204 1159 while(&parser->output != item) { … … 1240 1195 int length; 1241 1196 int32_t tmp_value; 1242 size_t offset_prefix = 0;1243 1197 1244 1198 if(parser == NULL) { 1245 1199 return EINVAL; 1246 }1247 1248 if(parser->use_report_id != 0) {1249 buffer[0] = path->report_id;1250 offset_prefix = 8;1251 1200 } 1252 1201 … … 1269 1218 // // variable item 1270 1219 value = usb_hid_translate_data_reverse(report_item, data[idx++]); 1271 offset = report_item->offset + (i * report_item->size) + offset_prefix;1220 offset = report_item->offset + (i * report_item->size); 1272 1221 length = report_item->size; 1273 1222 } … … 1275 1224 //bitmap 1276 1225 value += usb_hid_translate_data_reverse(report_item, data[idx++]); 1277 offset = report_item->offset + offset_prefix;1226 offset = report_item->offset; 1278 1227 length = report_item->size * report_item->count; 1279 1228 } … … 1374 1323 1375 1324 1376 int usb_hid_report_path_set_report_id(usb_hid_report_path_t *path, uint8_t report_id)1377 {1378 if(path == NULL){1379 return EINVAL;1380 }1381 1382 path->report_id = report_id;1383 return EOK;1384 }1385 1386 1387 usb_hid_report_item_t *usb_hid_report_item_clone(const usb_hid_report_item_t *item)1388 {1389 usb_hid_report_item_t *new_report_item;1390 1391 if(!(new_report_item = malloc(sizeof(usb_hid_report_item_t)))) {1392 return NULL;1393 }1394 memcpy(new_report_item,item, sizeof(usb_hid_report_item_t));1395 link_initialize(&(new_report_item->link));1396 1397 return new_report_item;1398 }1399 1400 1325 /** 1401 1326 * @} -
uspace/lib/usb/src/hidreport.c
rc6cb76d r7dfc06fa 80 80 d = usb_dp_get_sibling_descriptor(&parser, &parser_data, 81 81 dev->descriptors.configuration, d); 82 ++i;83 82 } 84 83 -
uspace/lib/usb/src/host/batch.c
rc6cb76d r7dfc06fa 79 79 instance->error = EOK; 80 80 instance->ep = ep; 81 endpoint_use(instance->ep);82 81 } 83 82 /*----------------------------------------------------------------------------*/ … … 87 86 * 88 87 */ 89 void usb_transfer_batch_finish(usb_transfer_batch_t *instance )88 void usb_transfer_batch_finish(usb_transfer_batch_t *instance, int error) 90 89 { 91 90 assert(instance); 92 assert(instance->ep); 93 endpoint_release(instance->ep); 91 instance->error = error; 94 92 instance->next_step(instance); 95 93 } -
uspace/lib/usb/src/host/device_keeper.c
rc6cb76d r7dfc06fa 264 264 return instance->devices[address].speed; 265 265 } 266 /*----------------------------------------------------------------------------*/ 267 void usb_device_keeper_use_control( 268 usb_device_keeper_t *instance, usb_target_t target) 269 { 270 assert(instance); 271 const uint16_t ep = 1 << target.endpoint; 272 fibril_mutex_lock(&instance->guard); 273 while (instance->devices[target.address].control_used & ep) { 274 fibril_condvar_wait(&instance->change, &instance->guard); 275 } 276 instance->devices[target.address].control_used |= ep; 277 fibril_mutex_unlock(&instance->guard); 278 } 279 /*----------------------------------------------------------------------------*/ 280 void usb_device_keeper_release_control( 281 usb_device_keeper_t *instance, usb_target_t target) 282 { 283 assert(instance); 284 const uint16_t ep = 1 << target.endpoint; 285 fibril_mutex_lock(&instance->guard); 286 assert((instance->devices[target.address].control_used & ep) != 0); 287 instance->devices[target.address].control_used &= ~ep; 288 fibril_mutex_unlock(&instance->guard); 289 fibril_condvar_signal(&instance->change); 290 } 266 291 /** 267 292 * @} -
uspace/lib/usb/src/host/endpoint.c
rc6cb76d r7dfc06fa 34 34 */ 35 35 36 #include <assert.h>37 36 #include <errno.h> 38 37 #include <usb/host/endpoint.h> … … 50 49 instance->max_packet_size = max_packet_size; 51 50 instance->toggle = 0; 52 instance->active = false;53 fibril_mutex_initialize(&instance->guard);54 fibril_condvar_initialize(&instance->avail);55 51 link_initialize(&instance->same_device_eps); 56 52 return EOK; … … 60 56 { 61 57 assert(instance); 62 assert(!instance->active);63 58 list_remove(&instance->same_device_eps); 64 59 free(instance); 65 }66 /*----------------------------------------------------------------------------*/67 void endpoint_use(endpoint_t *instance)68 {69 assert(instance);70 fibril_mutex_lock(&instance->guard);71 while (instance->active)72 fibril_condvar_wait(&instance->avail, &instance->guard);73 instance->active = true;74 fibril_mutex_unlock(&instance->guard);75 }76 /*----------------------------------------------------------------------------*/77 void endpoint_release(endpoint_t *instance)78 {79 assert(instance);80 fibril_mutex_lock(&instance->guard);81 instance->active = false;82 fibril_mutex_unlock(&instance->guard);83 fibril_condvar_signal(&instance->avail);84 60 } 85 61 /*----------------------------------------------------------------------------*/ -
uspace/lib/usb/src/hub.c
rc6cb76d r7dfc06fa 178 178 * error codes than those listed as return codes by this function itself). 179 179 * 180 * The @p connection representing connection with host controller does not181 * need to be started.182 * This function duplicates the connection to allow simultaneous calls of183 * this function (i.e. from different fibrils).184 *185 180 * @param[in] parent Parent device (i.e. the hub device). 186 * @param[in] connection Connection to host controller.181 * @param[in] connection Opened connection to host controller. 187 182 * @param[in] dev_speed New device speed. 188 183 * @param[in] enable_port Function for enabling signaling through the port the … … 211 206 ddf_dev_ops_t *dev_ops, void *new_dev_data, ddf_fun_t **new_fun) 212 207 { 213 assert(connection != NULL); 214 // FIXME: this is awful, we are accessing directly the structure. 215 usb_hc_connection_t hc_conn = { 216 .hc_handle = connection->hc_handle, 217 .hc_phone = -1 218 }; 208 CHECK_CONNECTION(connection); 209 210 /* 211 * Request new address. 212 */ 213 usb_address_t dev_addr = usb_hc_request_address(connection, dev_speed); 214 if (dev_addr < 0) { 215 return EADDRNOTAVAIL; 216 } 219 217 220 218 int rc; 221 219 222 rc = usb_hc_connection_open(&hc_conn);223 if (rc != EOK) {224 return rc;225 }226 227 228 /*229 * Request new address.230 */231 usb_address_t dev_addr = usb_hc_request_address(&hc_conn, dev_speed);232 if (dev_addr < 0) {233 usb_hc_connection_close(&hc_conn);234 return EADDRNOTAVAIL;235 }236 237 238 220 /* 239 221 * Reserve the default address. 240 222 */ 241 rc = usb_hc_reserve_default_address( &hc_conn, dev_speed);223 rc = usb_hc_reserve_default_address(connection, dev_speed); 242 224 if (rc != EOK) { 243 225 rc = EBUSY; … … 259 241 usb_device_connection_t dev_conn; 260 242 rc = usb_device_connection_initialize_on_default_address(&dev_conn, 261 &hc_conn);243 connection); 262 244 if (rc != EOK) { 263 245 rc = ENOTCONN; … … 276 258 * endpoint. 277 259 */ 278 rc = usb_pipe_register(&ctrl_pipe, 0, &hc_conn);260 rc = usb_pipe_register(&ctrl_pipe, 0, connection); 279 261 if (rc != EOK) { 280 262 rc = EREFUSED; … … 304 286 * Register the control endpoint for the new device. 305 287 */ 306 rc = usb_pipe_register(&ctrl_pipe, 0, &hc_conn);288 rc = usb_pipe_register(&ctrl_pipe, 0, connection); 307 289 if (rc != EOK) { 308 290 rc = EREFUSED; … … 313 295 * Release the original endpoint. 314 296 */ 315 unregister_control_endpoint_on_default_address( &hc_conn);297 unregister_control_endpoint_on_default_address(connection); 316 298 317 299 /* 318 300 * Once the address is changed, we can return the default address. 319 301 */ 320 usb_hc_release_default_address( &hc_conn);302 usb_hc_release_default_address(connection); 321 303 322 304 … … 343 325 .handle = child_handle 344 326 }; 345 rc = usb_hc_register_device( &hc_conn, &new_device);327 rc = usb_hc_register_device(connection, &new_device); 346 328 if (rc != EOK) { 347 329 rc = EDESTADDRREQ; … … 372 354 373 355 leave_unregister_endpoint: 374 usb_pipe_unregister(&ctrl_pipe, &hc_conn);356 usb_pipe_unregister(&ctrl_pipe, connection); 375 357 376 358 leave_release_default_address: 377 usb_hc_release_default_address( &hc_conn);359 usb_hc_release_default_address(connection); 378 360 379 361 leave_release_free_address: 380 usb_hc_unregister_device(&hc_conn, dev_addr); 381 382 usb_hc_connection_close(&hc_conn); 362 usb_hc_unregister_device(connection, dev_addr); 383 363 384 364 return rc;
Note:
See TracChangeset
for help on using the changeset viewer.