Changes in / [b9e3aa3:2002595] in mainline
- Files:
-
- 1 deleted
- 32 edited
Legend:
- Unmodified
- Added
- Removed
-
HelenOS.config
rb9e3aa3 r2002595 570 570 571 571 % USB release build (less logging) 572 ! CONFIG_USB_RELEASE_BUILD ( y/n)572 ! CONFIG_USB_RELEASE_BUILD (n/y) 573 573 574 574 % Start virtual USB host controller … … 576 576 577 577 % Polling UHCI & OHCI (no interrupts) 578 ! [PLATFORM=ia32|PLATFORM=amd64] CONFIG_USBHC_NO_INTERRUPTS ( n/y)578 ! [PLATFORM=ia32|PLATFORM=amd64] CONFIG_USBHC_NO_INTERRUPTS (y/n) 579 579 580 580 % Run devman in kconsole (not recommended) -
uspace/drv/ehci-hcd/hc_iface.c
rb9e3aa3 r2002595 48 48 methodname, __FILE__, __LINE__) 49 49 50 /** Reserve default address. 51 * 52 * This function may block the caller. 53 * 54 * @param[in] fun Device function the action was invoked on. 55 * @param[in] speed Speed of the device for which the default address is 56 * reserved. 57 * @return Error code. 58 */ 59 static int reserve_default_address(ddf_fun_t *fun, usb_speed_t speed) 60 { 61 UNSUPPORTED("reserve_default_address"); 62 63 return ENOTSUP; 64 } 65 66 /** Release default address. 67 * 68 * @param[in] fun Device function the action was invoked on. 69 * @return Error code. 70 */ 71 static int release_default_address(ddf_fun_t *fun) 72 { 73 UNSUPPORTED("release_default_address"); 74 75 return ENOTSUP; 76 } 77 50 78 /** Found free USB address. 51 79 * … … 304 332 /** Host controller interface implementation for EHCI. */ 305 333 usbhc_iface_t ehci_hc_iface = { 334 .reserve_default_address = reserve_default_address, 335 .release_default_address = release_default_address, 306 336 .request_address = request_address, 307 337 .bind_address = bind_address, -
uspace/drv/ohci/hc.c
rb9e3aa3 r2002595 343 343 { 344 344 assert(instance); 345 usb_log_debug("OHCI(%p) interrupt: %x.\n", instance, status); 345 346 if ((status & ~I_SF) == 0) /* ignore sof status */ 346 347 return; 347 usb_log_debug2("OHCI(%p) interrupt: %x.\n", instance, status);348 348 if (status & I_RHSC) 349 349 rh_interrupt(&instance->rh); -
uspace/drv/ohci/root_hub.c
rb9e3aa3 r2002595 57 57 .device_version = 0, 58 58 .length = sizeof (usb_standard_device_descriptor_t), 59 /// \TODO this value is guessed 59 60 .max_packet_size = 8, 60 61 .vendor_id = 0x16db, 61 62 .product_id = 0x0001, 63 /// \TODO these values migt be different 62 64 .str_serial_number = 0, 63 65 .usb_spec_version = 0x110, … … 116 118 */ 117 119 static const uint32_t hub_clear_feature_by_writing_one_mask = 118 RHS_CLEAR_PORT_POWER; 120 RHS_CLEAR_PORT_POWER; 121 // 1 << USB_HUB_FEATURE_C_HUB_LOCAL_POWER; 119 122 120 123 /** … … 124 127 RHS_LPSC_FLAG | 125 128 RHS_OCIC_FLAG; 129 //(1 << USB_HUB_FEATURE_C_HUB_OVER_CURRENT) | 130 //(1 << USB_HUB_FEATURE_C_HUB_LOCAL_POWER); 126 131 127 132 /** … … 130 135 static const uint32_t hub_set_feature_direct_mask = 131 136 RHS_SET_PORT_POWER; 137 //(1 << USB_HUB_FEATURE_C_HUB_OVER_CURRENT); 132 138 133 139 /** … … 154 160 RHPS_PRSC_FLAG; 155 161 162 /* 163 164 (1 << USB_HUB_FEATURE_PORT_CONNECTION) | 165 (1 << USB_HUB_FEATURE_PORT_SUSPEND) | 166 (1 << USB_HUB_FEATURE_PORT_OVER_CURRENT) | 167 (1 << USB_HUB_FEATURE_PORT_POWER) | 168 (1 << USB_HUB_FEATURE_C_PORT_CONNECTION) | 169 (1 << USB_HUB_FEATURE_C_PORT_ENABLE) | 170 (1 << USB_HUB_FEATURE_C_PORT_SUSPEND) | 171 (1 << USB_HUB_FEATURE_C_PORT_OVER_CURRENT) | 172 (1 << USB_HUB_FEATURE_C_PORT_RESET); 173 */ 156 174 //note that USB_HUB_FEATURE_PORT_POWER bit is translated into 157 175 //USB_HUB_FEATURE_PORT_LOW_SPEED for port set feature request … … 161 179 */ 162 180 static const uint32_t port_status_change_mask = RHPS_CHANGE_WC_MASK; 181 /* (1 << USB_HUB_FEATURE_C_PORT_CONNECTION) | 182 (1 << USB_HUB_FEATURE_C_PORT_ENABLE) | 183 (1 << USB_HUB_FEATURE_C_PORT_OVER_CURRENT) | 184 (1 << USB_HUB_FEATURE_C_PORT_RESET) | 185 (1 << USB_HUB_FEATURE_C_PORT_SUSPEND); 186 */ 163 187 164 188 static int create_serialized_hub_descriptor(rh_t *instance); … … 396 420 * create answer to port status_request 397 421 * 398 * Copy content of corresponding port status register to answer buffer. The 399 * format of the port status register and port status data is the same ( 400 * see OHCI root hub and USB hub documentation). 422 * Copy content of corresponding port status register to answer buffer. 401 423 * 402 424 * @param instance root hub instance … … 409 431 if (port < 1 || port > instance->port_count) 410 432 return EINVAL; 433 uint32_t * uint32_buffer = (uint32_t*) request->data_buffer; 411 434 request->transfered_size = 4; 412 uint32_t data = instance->registers->rh_port_status[port - 1]; 413 memcpy(request->data_buffer, &data, 4); 435 uint32_buffer[0] = instance->registers->rh_port_status[port - 1]; 414 436 #if 0 415 437 int i; … … 428 450 * create answer to port status_request 429 451 * 430 * This copies flags in hub status register into the buffer. The format of the 431 * status register and status message is the same, according to USB hub 432 * specification and OHCI root hub specification. 452 * Copy content of hub status register to answer buffer. 433 453 * 434 454 * @param instance root hub instance … … 438 458 static int process_get_hub_status_request(rh_t *instance, 439 459 usb_transfer_batch_t * request) { 440 //uint32_t * uint32_buffer = (uint32_t*) request->data_buffer;460 uint32_t * uint32_buffer = (uint32_t*) request->data_buffer; 441 461 request->transfered_size = 4; 442 462 //bits, 0,1,16,17 443 463 uint32_t mask = 1 | (1 << 1) | (1 << 16) | (1 << 17); 444 uint32_t data = mask & instance->registers->rh_status; 445 //uint32_buffer[0] = mask & instance->registers->rh_status; 446 memcpy(request->data_buffer, &data, 4); 464 uint32_buffer[0] = mask & instance->registers->rh_status; 447 465 448 466 return EOK; … … 467 485 468 486 usb_hub_bm_request_type_t request_type = request_packet->request_type; 469 if (buffer_size < 4 ) {487 if (buffer_size < 4/*request_packet->length*/) {///\TODO 470 488 usb_log_warning("requested more data than buffer size\n"); 471 489 return EINVAL; … … 498 516 | (1 << (USB_HUB_FEATURE_C_HUB_OVER_CURRENT + 16)); 499 517 bzero(bitmap, instance->interrupt_mask_size); 500 if ( (instance->registers->rh_status & mask) != 0) {518 if (instance->registers->rh_status & mask) { 501 519 bitmap[0] = 1; 502 520 } … … 504 522 mask = port_status_change_mask; 505 523 for (port = 1; port <= instance->port_count; ++port) { 506 if ( (mask & instance->registers->rh_port_status[port - 1]) != 0) {524 if (mask & instance->registers->rh_port_status[port - 1]) { 507 525 508 526 bitmap[(port) / 8] += 1 << (port % 8); … … 677 695 (instance->registers->rh_port_status[port - 1] | (1 << feature)) 678 696 & (~port_clear_feature_valid_mask); 697 /// \TODO any error? 698 679 699 return EOK; 680 700 } … … 704 724 & (~port_clear_feature_valid_mask)) 705 725 | (1 << feature); 726 /// \TODO any error? 706 727 707 728 return EOK; … … 921 942 * @return 922 943 */ 923 static int process_interrupt_mask_in_instance(rh_t *instance, 924 usb_transfer_batch_t * request) { 944 static int process_interrupt_mask_in_instance(rh_t *instance, usb_transfer_batch_t * request) { 925 945 memcpy(request->data_buffer, instance->interrupt_buffer, 926 946 instance->interrupt_mask_size); … … 942 962 * @return 943 963 */ 944 static bool is_zeros(void * buffer, size_t size) {964 static bool is_zeros(void * buffer, size_t size) { 945 965 if (!buffer) return true; 946 966 if (!size) return true; -
uspace/drv/uhci-hcd/uhci.c
rb9e3aa3 r2002595 61 61 } uhci_t; 62 62 63 static inline uhci_t * dev_to_uhci( constddf_dev_t *dev)63 static inline uhci_t * dev_to_uhci(ddf_dev_t *dev) 64 64 { 65 65 assert(dev); … … 77 77 { 78 78 assert(dev); 79 uhci_t *uhci = dev_to_uhci(dev); 79 uhci_t *uhci = dev->driver_data; 80 assert(uhci); 80 81 hc_t *hc = &uhci->hc; 81 constuint16_t status = IPC_GET_ARG1(*call);82 uint16_t status = IPC_GET_ARG1(*call); 82 83 assert(hc); 83 84 hc_interrupt(hc, status); 84 85 } 85 /*----------------------------------------------------------------------------*/86 /** Operations supported by the HC driver */87 static ddf_dev_ops_t hc_ops = {88 .interfaces[USBHC_DEV_IFACE] = &hc_iface, /* see iface.h/c */89 };90 86 /*----------------------------------------------------------------------------*/ 91 87 /** Get address of the device identified by handle. … … 119 115 * @return Error code. 120 116 */ 121 static int usb_iface_get_hc_handle(ddf_fun_t *fun, devman_handle_t *handle) 117 static int usb_iface_get_hc_handle( 118 ddf_fun_t *fun, devman_handle_t *handle) 122 119 { 123 120 assert(fun); … … 134 131 .get_hc_handle = usb_iface_get_hc_handle, 135 132 .get_address = usb_iface_get_address 133 }; 134 /*----------------------------------------------------------------------------*/ 135 /** Operations supported by the HC driver */ 136 static ddf_dev_ops_t hc_ops = { 137 .interfaces[USBHC_DEV_IFACE] = &hc_iface, /* see iface.h/c */ 136 138 }; 137 139 /*----------------------------------------------------------------------------*/ -
uspace/drv/uhci-rhd/port.h
rb9e3aa3 r2002595 55 55 56 56 /** UHCI port structure */ 57 typedef struct uhci_port { 57 typedef struct uhci_port 58 { 58 59 const char *id_string; 59 60 port_status_t *address; … … 67 68 68 69 int uhci_port_init( 69 70 70 uhci_port_t *port, port_status_t *address, unsigned number, 71 unsigned usec, ddf_dev_t *rh); 71 72 72 73 void uhci_port_fini(uhci_port_t *port); -
uspace/drv/usbhid/generic/hiddev.c
rb9e3aa3 r2002595 99 99 usb_hid_dev_t *hid_dev = (usb_hid_dev_t *)fun->driver_data; 100 100 101 usb_log_debug2("hid_dev: %p, Max input report size (% zu).\n",101 usb_log_debug2("hid_dev: %p, Max input report size (%d).\n", 102 102 hid_dev, hid_dev->max_input_report_size); 103 103 … … 226 226 } 227 227 228 usb_log_debug("HID function created. Handle: % " PRIun "\n", fun->handle);228 usb_log_debug("HID function created. Handle: %d\n", fun->handle); 229 229 230 230 return EOK; -
uspace/drv/usbhid/kbd/kbddev.c
rb9e3aa3 r2002595 798 798 } 799 799 800 usb_log_debug("%s function created. Handle: % " PRIun "\n",801 HID_KBD_FUN_NAME,fun->handle);800 usb_log_debug("%s function created. Handle: %d\n", HID_KBD_FUN_NAME, 801 fun->handle); 802 802 803 803 usb_log_debug("Adding DDF function to class %s...\n", -
uspace/drv/usbhid/multimedia/multimedia.c
rb9e3aa3 r2002595 211 211 } 212 212 213 usb_log_debug("%s function created (jandle: %" PRIun ").\n", 214 NAME, fun->handle); 213 usb_log_debug("%s function created. Handle: %d\n", NAME, fun->handle); 215 214 216 215 rc = ddf_fun_add_to_class(fun, "keyboard"); -
uspace/drv/usbhid/usbhid.c
rb9e3aa3 r2002595 217 217 // USB_HID_REPORT_TYPE_INPUT); 218 218 size_t size = 0; 219 220 usb_hid_report_description_t *report_des = 221 usb_hid_report_find_description(hid_dev->report, 222 mapping->report_id, USB_HID_REPORT_TYPE_INPUT); 223 224 while(report_des != NULL) { 225 226 if((mapping->report_id) == 0 && (report_des->report_id != 0)) { 227 usb_hid_report_path_set_report_id(usage_path, 228 report_des->report_id); 229 } 230 231 usb_hid_report_field_t *field = usb_hid_report_get_sibling ( 232 hid_dev->report, 233 NULL, usage_path, mapping->compare, 234 USB_HID_REPORT_TYPE_INPUT); 235 236 while(field != NULL) { 237 size++; 238 field = usb_hid_report_get_sibling (hid_dev->report, 219 usb_hid_report_field_t *field = usb_hid_report_get_sibling (hid_dev->report, 220 NULL, usage_path, mapping->compare, USB_HID_REPORT_TYPE_INPUT); 221 while(field != NULL) { 222 size++; 223 field = usb_hid_report_get_sibling (hid_dev->report, 239 224 field, usage_path, mapping->compare, 240 225 USB_HID_REPORT_TYPE_INPUT); 241 }242 243 if((mapping->report_id == 0) && (report_des->report_id != 0)) {244 uint8_t report_id = usb_hid_get_next_report_id(245 hid_dev->report, report_des->report_id,246 USB_HID_REPORT_TYPE_INPUT);247 248 if(report_id == 0) {249 break;250 }251 252 report_des = usb_hid_report_find_description(253 hid_dev->report, report_id,254 USB_HID_REPORT_TYPE_INPUT);255 }256 else {257 break;258 }259 226 } 260 227 -
uspace/drv/usbhub/main.c
rb9e3aa3 r2002595 87 87 88 88 usb_log_enable(USB_LOG_LEVEL_DEFAULT, NAME); 89 89 90 90 return usb_driver_main(&usb_hub_driver); 91 91 } -
uspace/drv/usbhub/port_status.h
rb9e3aa3 r2002595 64 64 */ 65 65 static inline void usb_hub_set_port_status_request( 66 usb_device_request_setup_packet_t *request, uint16_t port) { 66 usb_device_request_setup_packet_t * request, uint16_t port 67 ) { 67 68 request->index = port; 68 69 request->request_type = USB_HUB_REQ_TYPE_GET_PORT_STATUS; … … 78 79 */ 79 80 static inline void usb_hub_set_hub_status_request( 80 usb_device_request_setup_packet_t *request) { 81 usb_device_request_setup_packet_t * request 82 ) { 81 83 request->index = 0; 82 84 request->request_type = USB_HUB_REQ_TYPE_GET_HUB_STATUS; … … 93 95 static inline usb_device_request_setup_packet_t * 94 96 usb_hub_create_port_status_request(uint16_t port) { 95 usb_device_request_setup_packet_t * result =96 malloc(sizeof(usb_device_request_setup_packet_t));97 usb_device_request_setup_packet_t * result = 98 malloc(sizeof(usb_device_request_setup_packet_t)); 97 99 usb_hub_set_port_status_request(result, port); 98 100 return result; … … 106 108 */ 107 109 static inline void usb_hub_set_enable_port_feature_request( 108 usb_device_request_setup_packet_t *request, uint16_t port, 109 uint16_t feature_selector) { 110 usb_device_request_setup_packet_t * request, uint16_t port, 111 uint16_t feature_selector 112 ) { 110 113 request->index = port; 111 114 request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE; … … 122 125 */ 123 126 static inline void usb_hub_set_disable_port_feature_request( 124 usb_device_request_setup_packet_t *request, uint16_t port,125 126 127 usb_device_request_setup_packet_t * request, uint16_t port, 128 uint16_t feature_selector 129 ) { 127 130 request->index = port; 128 131 request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE; … … 138 141 */ 139 142 static inline void usb_hub_set_enable_port_request( 140 usb_device_request_setup_packet_t *request, uint16_t port141 143 usb_device_request_setup_packet_t * request, uint16_t port 144 ) { 142 145 request->index = port; 143 146 request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE; … … 154 157 static inline usb_device_request_setup_packet_t * 155 158 usb_hub_create_enable_port_request(uint16_t port) { 156 usb_device_request_setup_packet_t * result =157 malloc(sizeof(usb_device_request_setup_packet_t));159 usb_device_request_setup_packet_t * result = 160 malloc(sizeof(usb_device_request_setup_packet_t)); 158 161 usb_hub_set_enable_port_request(result, port); 159 162 return result; … … 166 169 */ 167 170 static inline void usb_hub_set_disable_port_request( 168 usb_device_request_setup_packet_t *request, uint16_t port169 171 usb_device_request_setup_packet_t * request, uint16_t port 172 ) { 170 173 request->index = port; 171 174 request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE; … … 182 185 static inline usb_device_request_setup_packet_t * 183 186 usb_hub_create_disable_port_request(uint16_t port) { 184 usb_device_request_setup_packet_t * result =185 malloc(sizeof(usb_device_request_setup_packet_t));187 usb_device_request_setup_packet_t * result = 188 malloc(sizeof(usb_device_request_setup_packet_t)); 186 189 usb_hub_set_disable_port_request(result, port); 187 190 return result; … … 194 197 */ 195 198 static inline void usb_hub_set_reset_port_request( 196 usb_device_request_setup_packet_t *request, uint16_t port197 199 usb_device_request_setup_packet_t * request, uint16_t port 200 ) { 198 201 request->index = port; 199 202 request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE; … … 210 213 static inline usb_device_request_setup_packet_t * 211 214 usb_hub_create_reset_port_request(uint16_t port) { 212 usb_device_request_setup_packet_t * result =213 malloc(sizeof(usb_device_request_setup_packet_t));215 usb_device_request_setup_packet_t * result = 216 malloc(sizeof(usb_device_request_setup_packet_t)); 214 217 usb_hub_set_reset_port_request(result, port); 215 218 return result; … … 222 225 */ 223 226 static inline void usb_hub_set_power_port_request( 224 usb_device_request_setup_packet_t *request, uint16_t port225 227 usb_device_request_setup_packet_t * request, uint16_t port 228 ) { 226 229 request->index = port; 227 230 request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE; … … 237 240 */ 238 241 static inline void usb_hub_unset_power_port_request( 239 usb_device_request_setup_packet_t *request, uint16_t port240 242 usb_device_request_setup_packet_t * request, uint16_t port 243 ) { 241 244 request->index = port; 242 245 request->request_type = USB_HUB_REQ_TYPE_SET_PORT_FEATURE; … … 254 257 */ 255 258 static inline bool usb_port_is_status(usb_port_status_t status, int idx) { 256 return (status & (1 << idx)) !=0;259 return (status&(1 << idx))!=0; 257 260 } 258 261 … … 265 268 */ 266 269 static inline void usb_port_status_set_bit( 267 270 usb_port_status_t * status, int idx, bool value) { 268 271 (*status) = value ? 269 270 272 ((*status) | (1 << (idx))) : 273 ((*status)&(~(1 << (idx)))); 271 274 } 272 275 … … 279 282 */ 280 283 static inline bool usb_hub_is_status(usb_hub_status_t status, int idx) { 281 return (status & (1 << idx)) !=0;284 return (status&(1 << idx))!=0; 282 285 } 283 286 … … 290 293 */ 291 294 static inline void usb_hub_status_set_bit( 292 usb_hub_status_t *status, int idx, bool value) {295 usb_hub_status_t * status, int idx, bool value) { 293 296 (*status) = value ? 294 ((*status) | (1 << (idx))) : 295 ((*status)&(~(1 << (idx)))); 296 } 297 297 ((*status) | (1 << (idx))) : 298 ((*status)&(~(1 << (idx)))); 299 } 300 301 302 #if 0 303 /** 304 * connection status geter for port status 305 * 306 * @param status 307 * @return true if there is something connected 308 */ 309 static inline bool usb_port_dev_connected(usb_port_status_t * status) { 310 return usb_port_get_bit(status, 0); 311 } 312 313 /** 314 * set device connected bit in port status 315 * 316 * @param status 317 * @param connected value of the bit 318 */ 319 static inline void usb_port_set_dev_connected(usb_port_status_t * status, bool connected) { 320 usb_port_set_bit(status, 0, connected); 321 } 322 323 //port enabled 324 325 /** 326 * port enabled getter for port status 327 * 328 * @param status 329 * @return true if the port is enabled 330 */ 331 static inline bool usb_port_enabled(usb_port_status_t * status) { 332 return usb_port_get_bit(status, 1); 333 } 334 335 /** 336 * set port enabled bit in port status 337 * 338 * @param status 339 * @param enabled value of the bit 340 */ 341 static inline void usb_port_set_enabled(usb_port_status_t * status, bool enabled) { 342 usb_port_set_bit(status, 1, enabled); 343 } 344 345 //port suspended 346 /** 347 * port suspended getter for port status 348 * 349 * @param status 350 * @return true if port is suspended 351 */ 352 static inline bool usb_port_suspended(usb_port_status_t * status) { 353 return usb_port_get_bit(status, 2); 354 } 355 356 /** 357 * set port suspended bit in port status 358 * 359 * @param status 360 * @param suspended value of the bit 361 */ 362 static inline void usb_port_set_suspended(usb_port_status_t * status, bool suspended) { 363 usb_port_set_bit(status, 2, suspended); 364 } 365 366 //over currect 367 /** 368 * over current condition indicator getter for port status 369 * 370 * @param status 371 * @return true if there is opver-current condition on the hub 372 */ 373 static inline bool usb_port_over_current(usb_port_status_t * status) { 374 return usb_port_get_bit(status, 3); 375 } 376 377 /** 378 * set over current indicator bit in port status 379 * 380 * @param status 381 * @param value value of the bit 382 */ 383 static inline void usb_port_set_over_current(usb_port_status_t * status, bool value) { 384 usb_port_set_bit(status, 3, value); 385 } 386 387 //port reset 388 /** 389 * port reset indicator getter for port status 390 * 391 * @param status 392 * @return true if port is reset 393 */ 394 static inline bool usb_port_reset(usb_port_status_t * status) { 395 return usb_port_get_bit(status, 4); 396 } 397 398 /** 399 * set port reset bit in port status 400 * 401 * @param status 402 * @param value value of the bit 403 */ 404 static inline void usb_port_set_reset(usb_port_status_t * status, bool value) { 405 usb_port_set_bit(status, 4, value); 406 } 407 408 //powered 409 /** 410 * power state getter for port status 411 * 412 * @param status 413 * @return true if port is powered 414 */ 415 static inline bool usb_port_powered(usb_port_status_t * status) { 416 return usb_port_get_bit(status, 8); 417 } 418 419 /** 420 * set port powered bit in port status 421 * 422 * @param status 423 * @param powered value of the bit 424 */ 425 static inline void usb_port_set_powered(usb_port_status_t * status, bool powered) { 426 usb_port_set_bit(status, 8, powered); 427 } 428 429 #endif 430 431 //low speed device attached 298 432 /** 299 433 * low speed device on the port indicator … … 312 446 * @param low_speed value of the bit 313 447 */ 314 static inline void usb_port_set_low_speed(usb_port_status_t * status, bool low_speed) {448 static inline void usb_port_set_low_speed(usb_port_status_t * status, bool low_speed) { 315 449 usb_port_status_set_bit(status, 9, low_speed); 316 450 } 317 451 318 452 //high speed device attached 319 320 453 /** 321 454 * high speed device on the port indicator … … 334 467 * @param high_speed value of the bit 335 468 */ 336 static inline void usb_port_set_high_speed(usb_port_status_t * status, bool high_speed) {469 static inline void usb_port_set_high_speed(usb_port_status_t * status, bool high_speed) { 337 470 usb_port_status_set_bit(status, 10, high_speed); 338 471 } … … 352 485 } 353 486 487 #if 0 488 //connect change 489 /** 490 * port connect change indicator 491 * 492 * @param status 493 * @return true if connection has changed 494 */ 495 static inline bool usb_port_connect_change(usb_port_status_t * status) { 496 return usb_port_get_bit(status, 16); 497 } 498 499 /** 500 * set connection change bit in port status 501 * @param status 502 * @param change value of the bit 503 */ 504 static inline void usb_port_set_connect_change(usb_port_status_t * status, bool change) { 505 usb_port_set_bit(status, 16, change); 506 } 507 508 //port enable change 509 /** 510 * port enable change for port status 511 * 512 * @param status 513 * @return true if the port has been enabled/disabled 514 */ 515 static inline bool usb_port_enabled_change(usb_port_status_t * status) { 516 return usb_port_get_bit(status, 17); 517 } 518 519 /** 520 * set port enable change bit in port status 521 * 522 * @param status 523 * @param change value of the bit 524 */ 525 static inline void usb_port_set_enabled_change(usb_port_status_t * status, bool change) { 526 usb_port_set_bit(status, 17, change); 527 } 528 529 //suspend change 530 /** 531 * port suspend change for port status 532 * 533 * @param status 534 * @return ture if suspend status has changed 535 */ 536 static inline bool usb_port_suspend_change(usb_port_status_t * status) { 537 return usb_port_get_bit(status, 18); 538 } 539 540 /** 541 * set port suspend change bit in port status 542 * 543 * @param status 544 * @param change value of the bit 545 */ 546 static inline void usb_port_set_suspend_change(usb_port_status_t * status, bool change) { 547 usb_port_set_bit(status, 18, change); 548 } 549 550 //over current change 551 /** 552 * over current change indicator 553 * 554 * @param status 555 * @return true if over-current condition on port has changed 556 */ 557 static inline bool usb_port_overcurrent_change(usb_port_status_t * status) { 558 return usb_port_get_bit(status, 19); 559 } 560 561 /** 562 * set port over current change bit in port status 563 * 564 * @param status 565 * @param change value of the bit 566 */ 567 static inline void usb_port_set_overcurrent_change(usb_port_status_t * status, bool change) { 568 usb_port_set_bit(status, 19, change); 569 } 570 571 //reset change 572 /** 573 * port reset change indicator 574 * @param status 575 * @return true if port has been reset 576 */ 577 static inline bool usb_port_reset_completed(usb_port_status_t * status) { 578 return usb_port_get_bit(status, 20); 579 } 580 581 /** 582 * set port reset completed bit in port status 583 * 584 * @param status 585 * @param change value of the bit 586 */ 587 static inline void usb_port_set_reset_completed(usb_port_status_t * status, bool completed) { 588 usb_port_set_bit(status, 20, completed); 589 } 590 591 //local power status 592 /** 593 * local power lost indicator for hub status 594 * 595 * @param status 596 * @return true if hub is not powered 597 */ 598 static inline bool usb_hub_local_power_lost(usb_hub_status_t * status) { 599 return usb_hub_get_bit(status, 0); 600 } 601 602 /** 603 * set hub power lost bit in hub status 604 * 605 * @param status 606 * @param change value of the bit 607 */ 608 static inline void usb_hub_set_local_power_lost(usb_port_status_t * status, 609 bool power_lost) { 610 usb_hub_set_bit(status, 0, power_lost); 611 } 612 613 //over current ocndition 614 /** 615 * hub over-current indicator 616 * 617 * @param status 618 * @return true if over-current condition occurred on hub 619 */ 620 static inline bool usb_hub_over_current(usb_hub_status_t * status) { 621 return usb_hub_get_bit(status, 1); 622 } 623 624 /** 625 * set hub over current bit in hub status 626 * 627 * @param status 628 * @param change value of the bit 629 */ 630 static inline void usb_hub_set_over_current(usb_port_status_t * status, 631 bool over_current) { 632 usb_hub_set_bit(status, 1, over_current); 633 } 634 635 //local power change 636 /** 637 * hub power change indicator 638 * 639 * @param status 640 * @return true if local power status has been changed - power has been 641 * dropped or re-established 642 */ 643 static inline bool usb_hub_local_power_change(usb_hub_status_t * status) { 644 return usb_hub_get_bit(status, 16); 645 } 646 647 /** 648 * set hub power change bit in hub status 649 * 650 * @param status 651 * @param change value of the bit 652 */ 653 static inline void usb_hub_set_local_power_change(usb_port_status_t * status, 654 bool change) { 655 usb_hub_set_bit(status, 16, change); 656 } 657 658 //local power status 659 /** 660 * hub over-current condition change indicator 661 * 662 * @param status 663 * @return true if over-current condition has changed 664 */ 665 static inline bool usb_hub_over_current_change(usb_hub_status_t * status) { 666 return usb_hub_get_bit(status, 17); 667 } 668 669 /** 670 * set hub over current change bit in hub status 671 * 672 * @param status 673 * @param change value of the bit 674 */ 675 static inline void usb_hub_set_over_current_change(usb_port_status_t * status, 676 bool change) { 677 usb_hub_set_bit(status, 17, change); 678 } 679 #endif 354 680 355 681 -
uspace/drv/usbhub/ports.c
rb9e3aa3 r2002595 47 47 #include "port_status.h" 48 48 49 49 50 /** Information for fibril for device discovery. */ 50 51 struct add_device_phase1 { … … 64 65 * any function here and must be cleared by hand 65 66 */ 66 static const int non_handled_changes[] = {67 static const int non_handled_changes[] = { 67 68 USB_HUB_FEATURE_C_PORT_ENABLE, 68 69 USB_HUB_FEATURE_C_PORT_SUSPEND … … 70 71 71 72 static void usb_hub_removed_device( 72 usb_hub_info_t *hub, uint16_t port);73 74 static void usb_hub_port_reset_completed(usb_hub_info_t * hub,75 76 77 static void usb_hub_port_over_current(usb_hub_info_t * hub,78 73 usb_hub_info_t * hub, uint16_t port); 74 75 static void usb_hub_port_reset_completed(usb_hub_info_t * hub, 76 uint16_t port, uint32_t status); 77 78 static void usb_hub_port_over_current(usb_hub_info_t * hub, 79 uint16_t port, uint32_t status); 79 80 80 81 static int get_port_status(usb_pipe_t *ctrl_pipe, size_t port, … … 95 96 * @param port port number, starting from 1 96 97 */ 97 void usb_hub_process_interrupt(usb_hub_info_t * hub,98 99 usb_log_debug(" Interrupt at port %zu\n", (size_t) port);98 void usb_hub_process_interrupt(usb_hub_info_t * hub, 99 uint16_t port) { 100 usb_log_debug("interrupt at port %zu\n", (size_t) port); 100 101 //determine type of change 101 102 //usb_pipe_t *pipe = hub->control_pipe; … … 133 134 if (usb_port_is_status(status, USB_HUB_FEATURE_C_PORT_OVER_CURRENT)) { 134 135 //check if it was not auto-resolved 135 usb_log_debug(" Overcurrent change on port\n");136 usb_log_debug("overcurrent change on port\n"); 136 137 usb_hub_port_over_current(hub, port, status); 137 138 } … … 140 141 usb_hub_port_reset_completed(hub, port, status); 141 142 } 142 usb_log_debug(" Status x%x : %d\n ", status, status);143 usb_log_debug("status x%x : %d\n ", status, status); 143 144 144 145 usb_port_status_set_bit( 145 &status, USB_HUB_FEATURE_C_PORT_CONNECTION, 146 &status, USB_HUB_FEATURE_C_PORT_CONNECTION,false); 146 147 usb_port_status_set_bit( 147 &status, USB_HUB_FEATURE_C_PORT_RESET, 148 &status, USB_HUB_FEATURE_C_PORT_RESET,false); 148 149 usb_port_status_set_bit( 149 &status, USB_HUB_FEATURE_C_PORT_OVER_CURRENT, 150 150 &status, USB_HUB_FEATURE_C_PORT_OVER_CURRENT,false); 151 151 152 //clearing not yet handled changes 152 153 unsigned int feature_idx; 153 for (feature_idx = 0; 154 feature_idx < non_handled_changes_count; 155 ++feature_idx) { 154 for(feature_idx = 0;feature_idx<non_handled_changes_count; 155 ++feature_idx){ 156 156 unsigned int bit_idx = non_handled_changes[feature_idx]; 157 if (status & (1 << bit_idx)){157 if(status & (1<<bit_idx)){ 158 158 usb_log_info( 159 " There was not yet handled change on port %d: %d"159 "there was not yet handled change on port %d: %d" 160 160 ";clearing it\n", 161 161 port, bit_idx); 162 162 int opResult = usb_hub_clear_port_feature( 163 163 hub->control_pipe, … … 165 165 if (opResult != EOK) { 166 166 usb_log_warning( 167 " Could not clear port flag %d: %s\n",168 bit_idx, str_error(opResult)167 "could not clear port flag %d: %d\n", 168 bit_idx, opResult 169 169 ); 170 170 } 171 171 usb_port_status_set_bit( 172 &status, bit_idx, 172 &status, bit_idx,false); 173 173 } 174 174 } 175 if (status >> 16){176 usb_log_info(" There is still some unhandled change %X\n",175 if(status>>16){ 176 usb_log_info("there is still some unhandled change %X\n", 177 177 status); 178 178 } 179 179 } 180 180 181 181 182 /** … … 189 190 */ 190 191 static void usb_hub_removed_device( 191 usb_hub_info_t *hub, uint16_t port) {192 usb_hub_info_t * hub, uint16_t port) { 192 193 193 194 int opResult = usb_hub_clear_port_feature(hub->control_pipe, 194 195 port, USB_HUB_FEATURE_C_PORT_CONNECTION); 195 196 if (opResult != EOK) { 196 usb_log_warning(" Could not clear port-change-connection flag\n");197 usb_log_warning("could not clear port-change-connection flag\n"); 197 198 } 198 199 /** \TODO remove device from device manager - not yet implemented in … … 201 202 202 203 //close address 203 204 usb_hub_port_t *the_port = hub->ports + port; 205 206 fibril_mutex_lock(&hub->port_mutex); 207 208 if (the_port->attached_device.address >= 0) { 209 usb_log_warning("Device unplug on `%s' (port %zu): " \ 210 "not implemented.\n", hub->usb_device->ddf_dev->name, 211 (size_t) port); 212 the_port->attached_device.address = -1; 213 the_port->attached_device.handle = 0; 204 if(hub->ports[port].attached_device.address >= 0){ 205 /*uncomment this code to use it when DDF allows device removal 206 opResult = usb_hc_unregister_device( 207 &hub->connection, 208 hub->attached_devs[port].address); 209 if(opResult != EOK) { 210 dprintf(USB_LOG_LEVEL_WARNING, "could not release " 211 "address of " 212 "removed device: %d", opResult); 213 } 214 hub->attached_devs[port].address = 0; 215 hub->attached_devs[port].handle = 0; 216 */ 214 217 } else { 215 218 usb_log_warning("Device removed before being registered.\n"); … … 220 223 * port reset callback from new device wrapper. 221 224 */ 225 usb_hub_port_t *the_port = hub->ports + port; 222 226 fibril_mutex_lock(&the_port->reset_mutex); 223 227 the_port->reset_completed = true; … … 226 230 fibril_mutex_unlock(&the_port->reset_mutex); 227 231 } 228 229 fibril_mutex_unlock(&hub->port_mutex); 230 } 232 } 233 231 234 232 235 /** … … 239 242 * @param status 240 243 */ 241 static void usb_hub_port_reset_completed(usb_hub_info_t * hub,242 uint16_t port, uint32_t status){244 static void usb_hub_port_reset_completed(usb_hub_info_t * hub, 245 uint16_t port, uint32_t status){ 243 246 usb_log_debug("Port %zu reset complete.\n", (size_t) port); 244 247 if (usb_port_is_status(status, USB_HUB_FEATURE_PORT_ENABLE)) { … … 272 275 * @param port port number, starting from 1 273 276 */ 274 static void usb_hub_port_over_current(usb_hub_info_t * hub,275 277 static void usb_hub_port_over_current(usb_hub_info_t * hub, 278 uint16_t port, uint32_t status) { 276 279 int opResult; 277 if (usb_port_is_status(status, USB_HUB_FEATURE_PORT_OVER_CURRENT)){280 if(usb_port_is_status(status, USB_HUB_FEATURE_PORT_OVER_CURRENT)){ 278 281 opResult = usb_hub_clear_port_feature(hub->control_pipe, 279 282 port, USB_HUB_FEATURE_PORT_POWER); 280 283 if (opResult != EOK) { 281 usb_log_error(" Cannot power off port %d; %s\n",282 port, str_error(opResult));284 usb_log_error("cannot power off port %d; %d\n", 285 port, opResult); 283 286 } 284 } else{287 }else{ 285 288 opResult = usb_hub_set_port_feature(hub->control_pipe, 286 289 port, USB_HUB_FEATURE_PORT_POWER); 287 290 if (opResult != EOK) { 288 usb_log_error(" Cannot power on port %d; %s\n",289 port, str_error(opResult));291 usb_log_error("cannot power on port %d; %d\n", 292 port, opResult); 290 293 } 291 294 } … … 300 303 */ 301 304 static int get_port_status(usb_pipe_t *ctrl_pipe, size_t port, 302 usb_port_status_t *status) { 305 usb_port_status_t *status) 306 { 303 307 size_t recv_size; 304 308 usb_device_request_setup_packet_t request; … … 307 311 usb_hub_set_port_status_request(&request, port); 308 312 int rc = usb_pipe_control_read(ctrl_pipe, 309 &request, sizeof 310 &status_tmp, sizeof 313 &request, sizeof(usb_device_request_setup_packet_t), 314 &status_tmp, sizeof(status_tmp), &recv_size); 311 315 if (rc != EOK) { 312 316 return rc; … … 333 337 * @return Error code. 334 338 */ 335 static int enable_port_callback(int port_no, void *arg) { 339 static int enable_port_callback(int port_no, void *arg) 340 { 336 341 usb_hub_info_t *hub = arg; 337 342 int rc; … … 341 346 usb_hub_set_reset_port_request(&request, port_no); 342 347 rc = usb_pipe_control_write(hub->control_pipe, 343 &request, sizeof 348 &request, sizeof(request), NULL, 0); 344 349 if (rc != EOK) { 345 350 usb_log_warning("Port reset failed: %s.\n", str_error(rc)); … … 371 376 * @return 0 Always. 372 377 */ 373 static int add_device_phase1_worker_fibril(void *arg) { 378 static int add_device_phase1_worker_fibril(void *arg) 379 { 374 380 struct add_device_phase1 *data 375 381 = (struct add_device_phase1 *) arg; … … 390 396 } 391 397 392 fibril_mutex_lock(&data->hub->port_mutex);393 398 data->hub->ports[data->port].attached_device.handle = child_handle; 394 399 data->hub->ports[data->port].attached_device.address = new_address; 395 fibril_mutex_unlock(&data->hub->port_mutex);396 400 397 401 usb_log_info("Detected new device on `%s' (port %zu), " … … 403 407 free(arg); 404 408 405 fibril_mutex_lock(&data->hub->pending_ops_mutex);406 assert(data->hub->pending_ops_count > 0);407 data->hub->pending_ops_count--;408 fibril_condvar_signal(&data->hub->pending_ops_cv);409 fibril_mutex_unlock(&data->hub->pending_ops_mutex);410 411 412 409 return EOK; 413 410 } 411 414 412 415 413 /** Start device adding when connection change is detected. … … 423 421 */ 424 422 static int create_add_device_fibril(usb_hub_info_t *hub, size_t port, 425 usb_speed_t speed) { 423 usb_speed_t speed) 424 { 426 425 struct add_device_phase1 *data 427 = malloc(sizeof 426 = malloc(sizeof(struct add_device_phase1)); 428 427 if (data == NULL) { 429 428 return ENOMEM; … … 453 452 return ENOMEM; 454 453 } 455 fibril_mutex_lock(&hub->pending_ops_mutex);456 hub->pending_ops_count++;457 fibril_mutex_unlock(&hub->pending_ops_mutex);458 454 fibril_add_ready(fibril); 459 455 -
uspace/drv/usbhub/ports.h
rb9e3aa3 r2002595 70 70 71 71 72 void usb_hub_process_interrupt(usb_hub_info_t * hub,72 void usb_hub_process_interrupt(usb_hub_info_t * hub, 73 73 uint16_t port); 74 74 -
uspace/drv/usbhub/usbhub.c
rb9e3aa3 r2002595 56 56 57 57 58 static usb_hub_info_t * usb_hub_info_create(usb_device_t * usb_dev);59 60 static int usb_hub_process_hub_specific_info(usb_hub_info_t * hub_info);61 62 static int usb_hub_set_configuration(usb_hub_info_t * hub_info);63 64 static int usb_hub_start_hub_fibril(usb_hub_info_t * hub_info);65 66 static int usb_process_hub_over_current(usb_hub_info_t * hub_info,58 static usb_hub_info_t * usb_hub_info_create(usb_device_t * usb_dev); 59 60 static int usb_hub_process_hub_specific_info(usb_hub_info_t * hub_info); 61 62 static int usb_hub_set_configuration(usb_hub_info_t * hub_info); 63 64 static int usb_hub_start_hub_fibril(usb_hub_info_t * hub_info); 65 66 static int usb_process_hub_over_current(usb_hub_info_t * hub_info, 67 67 usb_hub_status_t status); 68 68 69 static int usb_process_hub_ local_power_change(usb_hub_info_t *hub_info,69 static int usb_process_hub_power_change(usb_hub_info_t * hub_info, 70 70 usb_hub_status_t status); 71 71 72 static void usb_hub_process_global_interrupt(usb_hub_info_t * hub_info);73 74 static void usb_hub_polling_termin ated_callback(usb_device_t *device,75 bool was_error, void * data);72 static void usb_hub_process_global_interrupt(usb_hub_info_t * hub_info); 73 74 static void usb_hub_polling_terminted_callback(usb_device_t * device, 75 bool was_error, void * data); 76 76 77 77 … … 90 90 * @return error code 91 91 */ 92 int usb_hub_add_device(usb_device_t * usb_dev) {92 int usb_hub_add_device(usb_device_t * usb_dev) { 93 93 if (!usb_dev) return EINVAL; 94 usb_hub_info_t * hub_info = usb_hub_info_create(usb_dev);94 usb_hub_info_t * hub_info = usb_hub_info_create(usb_dev); 95 95 //create hc connection 96 96 usb_log_debug("Initializing USB wire abstraction.\n"); … … 99 99 hub_info->usb_device->ddf_dev); 100 100 if (opResult != EOK) { 101 usb_log_error(" Could not initialize connection to device, "102 " %s\n",103 str_error(opResult));101 usb_log_error("could not initialize connection to device, " 102 "errno %d\n", 103 opResult); 104 104 free(hub_info); 105 105 return opResult; … … 109 109 opResult = usb_hub_set_configuration(hub_info); 110 110 if (opResult != EOK) { 111 usb_log_error(" Could not set hub configuration, %s\n",112 str_error(opResult));111 usb_log_error("could not set hub configuration, errno %d\n", 112 opResult); 113 113 free(hub_info); 114 114 return opResult; … … 117 117 opResult = usb_hub_process_hub_specific_info(hub_info); 118 118 if (opResult != EOK) { 119 usb_log_error(" Could process hub specific info, %s\n",120 str_error(opResult));119 usb_log_error("could process hub specific info, errno %d\n", 120 opResult); 121 121 free(hub_info); 122 122 return opResult; … … 135 135 136 136 opResult = usb_hub_start_hub_fibril(hub_info); 137 if (opResult !=EOK)137 if(opResult!=EOK) 138 138 free(hub_info); 139 139 return opResult; 140 140 } 141 141 142 142 143 /** Callback for polling hub for changes. … … 192 193 * @return basic usb_hub_info_t structure 193 194 */ 194 static usb_hub_info_t * usb_hub_info_create(usb_device_t * usb_dev) {195 usb_hub_info_t * result = malloc(sizeof 195 static usb_hub_info_t * usb_hub_info_create(usb_device_t * usb_dev) { 196 usb_hub_info_t * result = malloc(sizeof(usb_hub_info_t)); 196 197 if (!result) return NULL; 197 198 result->usb_device = usb_dev; … … 199 200 result->control_pipe = &usb_dev->ctrl_pipe; 200 201 result->is_default_address_used = false; 201 202 result->ports = NULL;203 result->port_count = (size_t) - 1;204 fibril_mutex_initialize(&result->port_mutex);205 206 fibril_mutex_initialize(&result->pending_ops_mutex);207 fibril_condvar_initialize(&result->pending_ops_cv);208 result->pending_ops_count = 0;209 202 return result; 210 203 } … … 220 213 * @return error code 221 214 */ 222 static int usb_hub_process_hub_specific_info(usb_hub_info_t * hub_info) {215 static int usb_hub_process_hub_specific_info(usb_hub_info_t * hub_info) { 223 216 // get hub descriptor 224 usb_log_debug(" Creating serialized descriptor\n");217 usb_log_debug("creating serialized descriptor\n"); 225 218 uint8_t serialized_descriptor[USB_HUB_MAX_DESCRIPTOR_SIZE]; 226 219 usb_hub_descriptor_t * descriptor; … … 234 227 235 228 if (opResult != EOK) { 236 usb_log_error(" Failed when receiving hub descriptor, "237 " %s\n",238 str_error(opResult));229 usb_log_error("failed when receiving hub descriptor, " 230 "badcode = %d\n", 231 opResult); 239 232 free(serialized_descriptor); 240 233 return opResult; 241 234 } 242 usb_log_debug2(" Deserializing descriptor\n");235 usb_log_debug2("deserializing descriptor\n"); 243 236 descriptor = usb_create_deserialized_hub_desriptor( 244 237 serialized_descriptor); … … 249 242 usb_log_debug("setting port count to %d\n", descriptor->ports_count); 250 243 hub_info->port_count = descriptor->ports_count; 244 /// \TODO this is not semantically correct 251 245 bool is_power_switched = 252 ((descriptor->hub_characteristics & 1) == 246 ((descriptor->hub_characteristics & 1) ==0); 253 247 bool has_individual_port_powering = 254 ((descriptor->hub_characteristics & 1) != 248 ((descriptor->hub_characteristics & 1) !=0); 255 249 hub_info->ports = malloc( 256 250 sizeof (usb_hub_port_t) * (hub_info->port_count + 1)); 257 if (!hub_info->ports){251 if(!hub_info->ports){ 258 252 return ENOMEM; 259 253 } … … 262 256 usb_hub_port_init(&hub_info->ports[port]); 263 257 } 264 if (is_power_switched){265 usb_log_debug(" Hub powerswitched\n");266 267 if (!has_individual_port_powering){268 usb_log_debug(" Has_globalpowering\n");258 if(is_power_switched){ 259 usb_log_debug("is_power_switched\n"); 260 261 if(!has_individual_port_powering){ 262 usb_log_debug("!has_individual_port_powering\n"); 269 263 opResult = usb_hub_set_feature(hub_info->control_pipe, 270 264 USB_HUB_FEATURE_C_HUB_LOCAL_POWER); 271 265 if (opResult != EOK) { 272 usb_log_error(" Cannot power hub: %s\n",266 usb_log_error("cannot power hub: %s\n", 273 267 str_error(opResult)); 274 268 } … … 276 270 277 271 for (port = 1; port <= hub_info->port_count; ++port) { 278 usb_log_debug("Powering port %zu.\n", 272 usb_log_debug("Powering port %zu.\n",port); 279 273 opResult = usb_hub_set_port_feature(hub_info->control_pipe, 280 274 port, USB_HUB_FEATURE_PORT_POWER); … … 284 278 } 285 279 } 286 287 } else{288 usb_log_debug(" Power notswitched, not going to be powered\n");289 } 290 usb_log_debug2(" Freeing data\n");280 281 }else{ 282 usb_log_debug("!is_power_switched, not going to be powered\n"); 283 } 284 usb_log_debug2("freeing data\n"); 291 285 free(descriptor); 292 286 return EOK; … … 301 295 * @return error code 302 296 */ 303 static int usb_hub_set_configuration(usb_hub_info_t * hub_info) {297 static int usb_hub_set_configuration(usb_hub_info_t * hub_info) { 304 298 //device descriptor 305 299 usb_standard_device_descriptor_t *std_descriptor 306 300 = &hub_info->usb_device->descriptors.device; 307 usb_log_debug(" Hub has %d configurations\n",301 usb_log_debug("hub has %d configurations\n", 308 302 std_descriptor->configuration_count); 309 303 if (std_descriptor->configuration_count < 1) { 310 usb_log_error(" There are no configurations available\n");304 usb_log_error("there are no configurations available\n"); 311 305 return EINVAL; 312 306 } … … 326 320 return opResult; 327 321 } 328 usb_log_debug("\t Used configuration %d\n",322 usb_log_debug("\tused configuration %d\n", 329 323 config_descriptor->configuration_number); 330 324 … … 341 335 * @return error code 342 336 */ 343 static int usb_hub_start_hub_fibril(usb_hub_info_t *hub_info) { 344 int rc; 337 static int usb_hub_start_hub_fibril(usb_hub_info_t * hub_info){ 338 /* 339 * The processing will require opened control pipe and connection 340 * to the host controller. 341 * It is waste of resources but let's hope there will be less 342 * hubs than the phone limit. 343 * FIXME: with some proper locking over pipes and session 344 * auto destruction, this could work better. 345 */ 346 int rc = usb_hc_connection_open(&hub_info->connection); 347 if (rc != EOK) { 348 //usb_pipe_end_session(hub_info->control_pipe); 349 usb_log_error("Failed to open connection to HC: %s.\n", 350 str_error(rc)); 351 return rc; 352 } 345 353 346 354 rc = usb_device_auto_poll(hub_info->usb_device, 0, 347 355 hub_port_changes_callback, ((hub_info->port_count + 1) / 8) + 1, 348 usb_hub_polling_termin ated_callback, hub_info);356 usb_hub_polling_terminted_callback, hub_info); 349 357 if (rc != EOK) { 350 358 usb_log_error("Failed to create polling fibril: %s.\n", … … 365 373 //********************************************* 366 374 375 367 376 /** 368 377 * process hub over current change … … 373 382 * @return error code 374 383 */ 375 static int usb_process_hub_over_current(usb_hub_info_t * hub_info,384 static int usb_process_hub_over_current(usb_hub_info_t * hub_info, 376 385 usb_hub_status_t status) { 377 386 int opResult; 378 if (usb_hub_is_status(status, USB_HUB_FEATURE_HUB_OVER_CURRENT)) { 379 //poweroff all ports 380 unsigned int port; 381 for (port = 1; port <= hub_info->port_count; ++port) { 382 opResult = usb_hub_clear_port_feature( 383 hub_info->control_pipe, port, 384 USB_HUB_FEATURE_PORT_POWER); 385 if (opResult != EOK) { 386 usb_log_warning( 387 "Cannot power off port %d; %s\n", 388 port, str_error(opResult)); 389 } 387 if (usb_hub_is_status(status,USB_HUB_FEATURE_HUB_OVER_CURRENT)){ 388 opResult = usb_hub_clear_feature(hub_info->control_pipe, 389 USB_HUB_FEATURE_HUB_LOCAL_POWER); 390 if (opResult != EOK) { 391 usb_log_error("cannot power off hub: %d\n", 392 opResult); 390 393 } 391 394 } else { 392 //power all ports 393 unsigned int port; 394 for (port = 1; port <= hub_info->port_count; ++port) { 395 opResult = usb_hub_set_port_feature( 396 hub_info->control_pipe, port, 397 USB_HUB_FEATURE_PORT_POWER); 398 if (opResult != EOK) { 399 usb_log_warning( 400 "Cannot power off port %d; %s\n", 401 port, str_error(opResult)); 402 } 395 opResult = usb_hub_set_feature(hub_info->control_pipe, 396 USB_HUB_FEATURE_HUB_LOCAL_POWER); 397 if (opResult != EOK) { 398 usb_log_error("cannot power on hub: %d\n", 399 opResult); 403 400 } 404 401 } … … 407 404 408 405 /** 409 * process hub local power change 410 * 411 * This change is ignored. 406 * process hub power change 407 * 408 * If the power has been lost, reestablish it. 409 * If it was reestablished, re-power all ports. 412 410 * @param hub_info hub instance 413 411 * @param status hub status bitmask 414 412 * @return error code 415 413 */ 416 static int usb_process_hub_ local_power_change(usb_hub_info_t *hub_info,414 static int usb_process_hub_power_change(usb_hub_info_t * hub_info, 417 415 usb_hub_status_t status) { 418 416 int opResult = EOK; 417 if (!usb_hub_is_status(status,USB_HUB_FEATURE_HUB_LOCAL_POWER)) { 418 //restart power on hub 419 opResult = usb_hub_set_feature(hub_info->control_pipe, 420 USB_HUB_FEATURE_HUB_LOCAL_POWER); 421 if (opResult != EOK) { 422 usb_log_error("cannot power on hub: %d\n", 423 opResult); 424 } 425 } else {//power reestablished on hub- restart ports 426 size_t port; 427 for (port = 1; port <= hub_info->port_count; ++port) { 428 opResult = usb_hub_set_port_feature( 429 hub_info->control_pipe, 430 port, USB_HUB_FEATURE_PORT_POWER); 431 if (opResult != EOK) { 432 usb_log_error("Cannot power on port %zu: %s.\n", 433 port, str_error(opResult)); 434 } 435 } 436 } 437 if(opResult!=EOK){ 438 return opResult;//no feature clearing 439 } 419 440 opResult = usb_hub_clear_feature(hub_info->control_pipe, 420 441 USB_HUB_FEATURE_C_HUB_LOCAL_POWER); 421 if (opResult != EOK) {422 usb_log_error(" Cannnot clear hub power change flag: "423 "% s\n",424 str_error(opResult));442 if (opResult != EOK) { 443 usb_log_error("cannnot clear hub power change flag: " 444 "%d\n", 445 opResult); 425 446 } 426 447 return opResult; … … 431 452 * 432 453 * The change can be either in the over-current condition or 433 * local-power change.454 * local-power lost condition. 434 455 * @param hub_info hub instance 435 456 */ 436 static void usb_hub_process_global_interrupt(usb_hub_info_t * hub_info) {437 usb_log_debug(" Global interrupt on a hub\n");457 static void usb_hub_process_global_interrupt(usb_hub_info_t * hub_info) { 458 usb_log_debug("global interrupt on a hub\n"); 438 459 usb_pipe_t *pipe = hub_info->control_pipe; 439 460 int opResult; … … 452 473 ); 453 474 if (opResult != EOK) { 454 usb_log_error("Could not get hub status: %s\n", 455 str_error(opResult)); 475 usb_log_error("could not get hub status\n"); 456 476 return; 457 477 } 458 478 if (rcvd_size != sizeof (usb_port_status_t)) { 459 usb_log_error(" Received status has incorrect size\n");479 usb_log_error("received status has incorrect size\n"); 460 480 return; 461 481 } 462 482 //port reset 463 483 if ( 464 usb_hub_is_status(status, 16 +USB_HUB_FEATURE_C_HUB_OVER_CURRENT)) {484 usb_hub_is_status(status,16+USB_HUB_FEATURE_C_HUB_OVER_CURRENT)) { 465 485 usb_process_hub_over_current(hub_info, status); 466 486 } 467 487 if ( 468 usb_hub_is_status(status, 16 +USB_HUB_FEATURE_C_HUB_LOCAL_POWER)) {469 usb_process_hub_ local_power_change(hub_info, status);488 usb_hub_is_status(status,16+USB_HUB_FEATURE_C_HUB_LOCAL_POWER)) { 489 usb_process_hub_power_change(hub_info, status); 470 490 } 471 491 } … … 479 499 * @param data pointer to usb_hub_info_t structure 480 500 */ 481 static void usb_hub_polling_terminated_callback(usb_device_t *device, 482 bool was_error, void *data) { 483 usb_hub_info_t * hub = data; 484 assert(hub); 485 486 fibril_mutex_lock(&hub->pending_ops_mutex); 487 488 /* The device is dead. However there might be some pending operations 489 * that we need to wait for. 490 * One of them is device adding in progress. 491 * The respective fibril is probably waiting for status change 492 * in port reset (port enable) callback. 493 * Such change would never come (otherwise we would not be here). 494 * Thus, we would flush all pending port resets. 495 */ 496 if (hub->pending_ops_count > 0) { 497 fibril_mutex_lock(&hub->port_mutex); 498 size_t port; 499 for (port = 0; port < hub->port_count; port++) { 500 usb_hub_port_t *the_port = hub->ports + port; 501 fibril_mutex_lock(&the_port->reset_mutex); 502 the_port->reset_completed = true; 503 the_port->reset_okay = false; 504 fibril_condvar_broadcast(&the_port->reset_cv); 505 fibril_mutex_unlock(&the_port->reset_mutex); 506 } 507 fibril_mutex_unlock(&hub->port_mutex); 508 } 509 /* And now wait for them. */ 510 while (hub->pending_ops_count > 0) { 511 fibril_condvar_wait(&hub->pending_ops_cv, 512 &hub->pending_ops_mutex); 513 } 514 fibril_mutex_unlock(&hub->pending_ops_mutex); 515 516 usb_device_destroy(hub->usb_device); 517 518 free(hub->ports); 519 free(hub); 501 static void usb_hub_polling_terminted_callback(usb_device_t * device, 502 bool was_error, void * data){ 503 usb_hub_info_t * hub_info = data; 504 if(!hub_info) return; 505 free(hub_info->ports); 506 free(hub_info); 520 507 } 521 508 -
uspace/drv/usbhub/usbhub.h
rb9e3aa3 r2002595 51 51 #include "ports.h" 52 52 53 54 53 55 /** Information about attached hub. */ 54 struct usb_hub_info_t 56 struct usb_hub_info_t{ 55 57 /** Number of ports. */ 56 58 size_t port_count; … … 58 60 /** attached device handles, for each port one */ 59 61 usb_hub_port_t *ports; 60 61 fibril_mutex_t port_mutex;62 62 63 63 /** connection to hcd */ … … 89 89 /** generic usb device data*/ 90 90 usb_device_t * usb_device; 91 92 /** Number of pending operations on the mutex to prevent shooting93 * ourselves in the foot.94 * When the hub is disconnected but we are in the middle of some95 * operation, we cannot destroy this structure right away because96 * the pending operation might use it.97 */98 size_t pending_ops_count;99 /** Guard for pending_ops_count. */100 fibril_mutex_t pending_ops_mutex;101 /** Condition variable for pending_ops_count. */102 fibril_condvar_t pending_ops_cv;103 104 91 }; 105 92 106 int usb_hub_add_device(usb_device_t *usb_dev); 93 //int usb_hub_control_loop(void * hub_info_param); 94 95 int usb_hub_add_device(usb_device_t * usb_dev); 107 96 108 97 bool hub_port_changes_callback(usb_device_t *dev, -
uspace/drv/usbhub/usbhub_private.h
rb9e3aa3 r2002595 65 65 */ 66 66 static inline void usb_hub_set_descriptor_request( 67 68 ){67 usb_device_request_setup_packet_t * request 68 ){ 69 69 request->index = 0; 70 70 request->request_type = USB_HUB_REQ_TYPE_GET_DESCRIPTOR; … … 87 87 int port_index, 88 88 usb_hub_class_feature_t feature) { 89 89 90 90 usb_device_request_setup_packet_t clear_request = { 91 91 .request_type = USB_HUB_REQ_TYPE_CLEAR_PORT_FEATURE, … … 96 96 clear_request.value = feature; 97 97 return usb_pipe_control_write(pipe, &clear_request, 98 sizeof 98 sizeof(clear_request), NULL, 0); 99 99 } 100 100 … … 120 120 clear_request.value = feature; 121 121 return usb_pipe_control_write(pipe, &clear_request, 122 sizeof 122 sizeof(clear_request), NULL, 0); 123 123 } 124 124 125 125 126 /** … … 141 142 clear_request.value = feature; 142 143 return usb_pipe_control_write(pipe, &clear_request, 143 sizeof 144 sizeof(clear_request), NULL, 0); 144 145 } 145 146 … … 162 163 clear_request.value = feature; 163 164 return usb_pipe_control_write(pipe, &clear_request, 164 sizeof 165 sizeof(clear_request), NULL, 0); 165 166 } 166 167 -
uspace/drv/usbhub/utils.c
rb9e3aa3 r2002595 62 62 * @return newly created serializd descriptor pointer 63 63 */ 64 void * usb_create_serialized_hub_descriptor(usb_hub_descriptor_t * descriptor) {64 void * usb_create_serialized_hub_descriptor(usb_hub_descriptor_t * descriptor) { 65 65 //base size 66 66 size_t size = 7; 67 67 //variable size according to port count 68 size_t var_size = (descriptor->ports_count + 7) /8;68 size_t var_size = (descriptor->ports_count+7)/8; 69 69 size += 2 * var_size; 70 70 uint8_t * result = malloc(size); 71 71 //size 72 if 73 usb_serialize_hub_descriptor(descriptor, 72 if(result) 73 usb_serialize_hub_descriptor(descriptor,result); 74 74 return result; 75 75 } … … 82 82 * @param serialized_descriptor 83 83 */ 84 void usb_serialize_hub_descriptor(usb_hub_descriptor_t * descriptor,84 void usb_serialize_hub_descriptor(usb_hub_descriptor_t * descriptor, 85 85 void * serialized_descriptor) { 86 86 //base size … … 88 88 size_t size = 7; 89 89 //variable size according to port count 90 size_t var_size = (descriptor->ports_count + 7) /8;90 size_t var_size = (descriptor->ports_count+7)/8; 91 91 size += 2 * var_size; 92 92 //size … … 110 110 } 111 111 112 112 113 /** 113 114 * create deserialized desriptor structure out of serialized descriptor … … 120 121 */ 121 122 usb_hub_descriptor_t * usb_create_deserialized_hub_desriptor( 122 void *serialized_descriptor) {123 void * serialized_descriptor) { 123 124 uint8_t * sdescriptor = serialized_descriptor; 124 125 … … 129 130 } 130 131 131 usb_hub_descriptor_t * result = malloc(sizeof 132 if 133 usb_deserialize_hub_desriptor(serialized_descriptor, 132 usb_hub_descriptor_t * result = malloc(sizeof(usb_hub_descriptor_t)); 133 if(result) 134 usb_deserialize_hub_desriptor(serialized_descriptor,result); 134 135 return result; 135 136 } … … 143 144 */ 144 145 void usb_deserialize_hub_desriptor( 145 void * serialized_descriptor, usb_hub_descriptor_t *descriptor) {146 void * serialized_descriptor, usb_hub_descriptor_t * descriptor) { 146 147 uint8_t * sdescriptor = serialized_descriptor; 147 148 descriptor->ports_count = sdescriptor[2]; … … 150 151 descriptor->pwr_on_2_good_time = sdescriptor[5]; 151 152 descriptor->current_requirement = sdescriptor[6]; 152 size_t var_size = (descriptor->ports_count +7) / 8;153 size_t var_size = (descriptor->ports_count+7) / 8; 153 154 //descriptor->devices_removable = (uint8_t*) malloc(var_size); 154 155 -
uspace/drv/usbmouse/init.c
rb9e3aa3 r2002595 39 39 #include <usb/hid/hid.h> 40 40 #include <usb/dev/request.h> 41 #include <usb/hid/request.h>42 41 #include <errno.h> 43 42 … … 127 126 128 127 /* Set the boot protocol. */ 129 rc = usbhid_req_set_protocol(&dev->ctrl_pipe, dev->interface_no, 130 USB_HID_PROTOCOL_BOOT); 128 rc = usb_control_request_set(&dev->ctrl_pipe, 129 USB_REQUEST_TYPE_CLASS, USB_REQUEST_RECIPIENT_INTERFACE, 130 USB_HIDREQ_SET_PROTOCOL, USB_HID_PROTOCOL_BOOT, dev->interface_no, 131 NULL, 0); 131 132 if (rc != EOK) { 132 133 goto leave; -
uspace/drv/usbmouse/mouse.c
rb9e3aa3 r2002595 117 117 async_hangup(mouse->console_phone); 118 118 mouse->console_phone = -1; 119 120 usb_device_destroy(dev);121 119 } 122 120 -
uspace/lib/drv/generic/driver.c
rb9e3aa3 r2002595 405 405 /* The interface has not such method */ 406 406 printf("%s: driver_connection_gen error - " 407 "invalid interface method " 408 "(index %" PRIun ").\n", 407 "invalid interface method (%d).\n", 409 408 driver->name, iface_method_idx); 410 409 async_answer_0(callid, ENOTSUP); -
uspace/lib/drv/include/remote_pci.h
rb9e3aa3 r2002595 36 36 #define LIBDRV_REMOTE_PCI_H_ 37 37 38 externremote_iface_t remote_pci_iface;38 remote_iface_t remote_pci_iface; 39 39 40 40 #endif -
uspace/lib/drv/include/remote_usb.h
rb9e3aa3 r2002595 36 36 #define LIBDRV_REMOTE_USB_H_ 37 37 38 externremote_iface_t remote_usb_iface;38 remote_iface_t remote_usb_iface; 39 39 40 40 #endif -
uspace/lib/drv/include/remote_usbhc.h
rb9e3aa3 r2002595 36 36 #define LIBDRV_REMOTE_USBHC_H_ 37 37 38 externremote_iface_t remote_usbhc_iface;38 remote_iface_t remote_usbhc_iface; 39 39 40 40 #endif -
uspace/lib/drv/include/usbhc_iface.h
rb9e3aa3 r2002595 212 212 /** USB host controller communication interface. */ 213 213 typedef struct { 214 int (*reserve_default_address)(ddf_fun_t *, usb_speed_t); 215 int (*release_default_address)(ddf_fun_t *); 214 216 int (*request_address)(ddf_fun_t *, usb_speed_t, usb_address_t *); 215 217 int (*bind_address)(ddf_fun_t *, usb_address_t, devman_handle_t); -
uspace/lib/usbdev/include/usb/dev/driver.h
rb9e3aa3 r2002595 168 168 int usb_device_destroy_pipes(ddf_dev_t *, usb_endpoint_mapping_t *, size_t); 169 169 int usb_device_create(ddf_dev_t *, usb_endpoint_description_t **, usb_device_t **, const char **); 170 void usb_device_destroy(usb_device_t *);171 170 172 171 size_t usb_interface_count_alternates(uint8_t *, size_t, uint8_t); -
uspace/lib/usbdev/src/devdrv.c
rb9e3aa3 r2002595 533 533 } 534 534 535 /** Destroy instance of a USB device.536 *537 * @param dev Device to be destroyed.538 */539 void usb_device_destroy(usb_device_t *dev)540 {541 if (dev == NULL) {542 return;543 }544 545 /* Ignore errors and hope for the best. */546 usb_device_destroy_pipes(dev->ddf_dev, dev->pipes, dev->pipes_count);547 if (dev->descriptors.configuration != NULL) {548 free(dev->descriptors.configuration);549 }550 551 if (dev->alternate_interfaces != NULL) {552 if (dev->alternate_interfaces->alternatives != NULL) {553 free(dev->alternate_interfaces->alternatives);554 }555 free(dev->alternate_interfaces);556 }557 558 free(dev);559 }560 561 535 /** 562 536 * @} -
uspace/lib/usbdev/src/hub.c
rb9e3aa3 r2002595 331 331 goto leave_release_free_address; 332 332 } 333 334 usb_hc_connection_close(&hc_conn);335 333 336 334 /* -
uspace/lib/usbhid/src/hiddescriptor.c
rb9e3aa3 r2002595 187 187 188 188 field = malloc(sizeof(usb_hid_report_field_t)); 189 if(field == NULL) {190 return ENOMEM;191 }192 193 189 memset(field, 0, sizeof(usb_hid_report_field_t)); 194 190 list_initialize(&field->link); … … 220 216 } 221 217 else { 222 usage = 218 usage = report_item->usages[ 223 219 report_item->usages_count- 1]; 224 220 } … … 245 241 246 242 field->size = report_item->size; 247 248 if(report_item->type == USB_HID_REPORT_TYPE_INPUT) { 249 int offset = report_item->offset + report_item->size * i; 250 int field_offset = (offset/8)*8 + (offset/8 + 1) * 8 - 251 offset - report_item->size; 252 if(field_offset < 0) { 253 field->offset = 0; 254 } 255 else { 256 field->offset = field_offset; 257 } 258 } 259 else { 260 field->offset = report_item->offset + (i * report_item->size); 261 } 262 263 264 if(report->use_report_ids != 0) { 243 244 size_t offset_byte = (report_item->offset + (i * 245 report_item->size)) / 8; 246 247 size_t offset_bit = 8 - ((report_item->offset + (i * 248 report_item->size)) % 8) - report_item->size; 249 250 field->offset = 8 * offset_byte + offset_bit; 251 if(report_item->id != 0) { 265 252 field->offset += 8; 266 253 report->use_report_ids = 1; 267 254 } 268 269 255 field->item_flags = report_item->item_flags; 270 256 … … 336 322 usb_hid_report_description_t, link); 337 323 338 // if report id not set, return the first of the type 339 if(((report_des->report_id == report_id) || (report_id == 0)) && 324 if((report_des->report_id == report_id) && 340 325 (report_des->type == type)) { 341 326 return report_des; -
uspace/lib/usbhid/src/hidparser.c
rb9e3aa3 r2002595 153 153 154 154 155 report_des = usb_hid_report_find_description(report, *report_id, 156 type); 157 155 report_des = usb_hid_report_find_description(report, *report_id, type); 158 156 if(report_des == NULL) { 159 157 return EINVAL; … … 169 167 if(USB_HID_ITEM_FLAG_CONSTANT(item->item_flags) == 0) { 170 168 171 if(USB_HID_ITEM_FLAG_VARIABLE(item->item_flags) == 0) {169 if(USB_HID_ITEM_FLAG_VARIABLE(item->item_flags) == 0) { 172 170 173 171 // array … … 176 174 177 175 item->usage = USB_HID_EXTENDED_USAGE( 178 item->usages[ 179 item->value - item->physical_minimum]); 180 181 item->usage_page = 182 USB_HID_EXTENDED_USAGE_PAGE( 183 item->usages[ 184 item->value - item->physical_minimum]); 185 186 usb_hid_report_set_last_item ( 187 item->collection_path, 188 USB_HID_TAG_CLASS_GLOBAL, 189 item->usage_page); 190 191 usb_hid_report_set_last_item ( 192 item->collection_path, 176 item->usages[item->value - item->physical_minimum]); 177 178 item->usage_page = USB_HID_EXTENDED_USAGE_PAGE( 179 item->usages[item->value - item->physical_minimum]); 180 181 usb_hid_report_set_last_item (item->collection_path, 182 USB_HID_TAG_CLASS_GLOBAL, item->usage_page); 183 184 usb_hid_report_set_last_item (item->collection_path, 193 185 USB_HID_TAG_CLASS_LOCAL, item->usage); 194 186 … … 196 188 else { 197 189 // variable item 198 item->value = usb_hid_translate_data(item, 199 data); 200 } 190 item->value = usb_hid_translate_data(item, data); 191 } 201 192 } 202 193 list_item = list_item->next; … … 222 213 223 214 int32_t value=0; 224 int32_t mask =0;225 const uint8_t *foo =0;215 int32_t mask; 216 const uint8_t *foo; 226 217 227 218 // now only shot tags are allowed … … 249 240 if((size_t)(offset/8) != (size_t)((offset+item->size-1)/8)) { 250 241 251 part_size = 0;242 part_size = ((offset+item->size)%8); 252 243 253 244 size_t i=0; … … 255 246 if(i == (size_t)(offset/8)) { 256 247 // the higher one 257 part_size = 8 - (offset % 8);258 248 foo = data + i; 259 249 mask = ((1 << (item->size-part_size))-1); 260 value = (*foo & mask) ;250 value = (*foo & mask) << part_size; 261 251 } 262 252 else if(i == ((offset+item->size-1)/8)){ 263 253 // the lower one 264 254 foo = data + i; 265 mask = ((1 << (item->size - part_size)) - 1) 266 << (8 - (item->size - part_size)); 267 268 value = (((*foo & mask) >> (8 - 269 (item->size - part_size))) << part_size ) 270 + value; 255 mask = ((1 << part_size)-1) << (8-part_size); 256 value += ((*foo & mask) >> (8-part_size)); 271 257 } 272 258 else { 273 value = (*(data + 1) << (part_size + 8)) + value;274 part_size += 8;259 value = value << 8; 260 value += *(data + 1); 275 261 } 276 262 } … … 389 375 report_item = list_get_instance(item, usb_hid_report_field_t, link); 390 376 391 value = usb_hid_translate_data_reverse(report_item, 392 report_item->value); 393 394 offset = report_des->bit_length - report_item->offset - 1; 395 length = report_item->size; 396 377 if(USB_HID_ITEM_FLAG_VARIABLE(report_item->item_flags) == 0) { 378 379 // array 380 value = usb_hid_translate_data_reverse(report_item, 381 report_item->value); 382 383 offset = report_item->offset; 384 length = report_item->size; 385 } 386 else { 387 // variable item 388 value = usb_hid_translate_data_reverse(report_item, 389 report_item->value); 390 391 offset = report_item->offset; 392 length = report_item->size; 393 } 394 397 395 usb_log_debug("\ttranslated value: %x\n", value); 398 396 … … 619 617 return report_des->report_id; 620 618 } 621 622 report_it = report_it->next;623 619 } 624 620 -
uspace/lib/usbhid/src/hidpath.c
rb9e3aa3 r2002595 211 211 212 212 if(report_path->report_id != path->report_id) { 213 if(path->report_id != 0) { 214 return 1; 215 } 213 return 1; 216 214 } 217 215 -
uspace/srv/hid/console/console.c
rb9e3aa3 r2002595 57 57 #include <io/style.h> 58 58 #include <io/screenbuffer.h> 59 #include <inttypes.h>60 59 61 60 #include "console.h" … … 68 67 /** Interval for checking for new keyboard (1/4s). */ 69 68 #define HOTPLUG_WATCH_INTERVAL (1000 * 250) 70 71 /* Kernel defines 32 but does not export it. */72 #define MAX_IPC_OUTGOING_PHONES 12873 /** To allow proper phone closing. */74 static ipc_callid_t driver_phones[MAX_IPC_OUTGOING_PHONES] = { 0 };75 69 76 70 /** Phone to the keyboard driver. */ … … 96 90 contents and related settings. */ 97 91 } console_t; 98 99 100 92 101 93 /** Array of data for virtual consoles */ … … 409 401 } 410 402 411 static void close_driver_phone(ipc_callid_t hash)412 {413 int i;414 for (i = 0; i < MAX_IPC_OUTGOING_PHONES; i++) {415 if (driver_phones[i] == hash) {416 printf("Device %" PRIxn " gone.\n", hash);417 driver_phones[i] = 0;418 async_hangup(i);419 return;420 }421 }422 }423 424 403 /** Handler for keyboard */ 425 404 static void keyboard_events(ipc_callid_t iid, ipc_call_t *icall) … … 436 415 case IPC_M_PHONE_HUNGUP: 437 416 /* TODO: Handle hangup */ 438 close_driver_phone(iid);439 417 return; 440 418 case KBD_EVENT: … … 480 458 case IPC_M_PHONE_HUNGUP: 481 459 /* TODO: Handle hangup */ 482 close_driver_phone(iid);483 460 return; 484 461 case MEVENT_BUTTON: … … 738 715 } 739 716 740 static int async_connect_to_me_hack(int phone, sysarg_t arg1, sysarg_t arg2,741 sysarg_t arg3, async_client_conn_t client_receiver, ipc_callid_t *hash)742 {743 sysarg_t task_hash;744 sysarg_t phone_hash;745 int rc = async_req_3_5(phone, IPC_M_CONNECT_TO_ME, arg1, arg2, arg3,746 NULL, NULL, NULL, &task_hash, &phone_hash);747 if (rc != EOK)748 return rc;749 750 if (client_receiver != NULL)751 async_new_connection(task_hash, phone_hash, phone_hash, NULL,752 client_receiver);753 754 if (hash != NULL) {755 *hash = phone_hash;756 }757 758 return EOK;759 }760 761 717 static int connect_keyboard_or_mouse(const char *devname, 762 718 async_client_conn_t handler, const char *path) … … 773 729 } 774 730 775 ipc_callid_t hash; 776 int rc = async_connect_to_me_hack(phone, SERVICE_CONSOLE, 0, phone, 777 handler, &hash); 731 int rc = async_connect_to_me(phone, SERVICE_CONSOLE, 0, 0, handler); 778 732 if (rc != EOK) { 779 733 printf(NAME ": " \ … … 783 737 } 784 738 785 driver_phones[phone] = hash; 786 787 printf(NAME ": found %s \"%s\" (%" PRIxn ").\n", devname, path, hash); 739 printf(NAME ": found %s \"%s\".\n", devname, path); 788 740 789 741 return phone;
Note:
See TracChangeset
for help on using the changeset viewer.