1 /* 2 * USB hub driver. 3 * 4 * (C) Copyright 1999 Linus Torvalds 5 * (C) Copyright 1999 Johannes Erdfelt 6 * (C) Copyright 1999 Gregory P. Smith 7 * (C) Copyright 2001 Brad Hards (bhards@bigpond.net.au) 8 * 9 */ 10 11 #include <linux/kernel.h> 12 #include <linux/errno.h> 13 #include <linux/module.h> 14 #include <linux/moduleparam.h> 15 #include <linux/completion.h> 16 #include <linux/sched.h> 17 #include <linux/list.h> 18 #include <linux/slab.h> 19 #include <linux/smp_lock.h> 20 #include <linux/ioctl.h> 21 #include <linux/usb.h> 22 #include <linux/usbdevice_fs.h> 23 #include <linux/kthread.h> 24 #include <linux/mutex.h> 25 #include <linux/freezer.h> 26 27 #include <asm/semaphore.h> 28 #include <asm/uaccess.h> 29 #include <asm/byteorder.h> 30 31 #include "usb.h" 32 #include "hcd.h" 33 #include "hub.h" 34 35 struct usb_hub { 36 struct device *intfdev; /* the "interface" device */ 37 struct usb_device *hdev; 38 struct urb *urb; /* for interrupt polling pipe */ 39 40 /* buffer for urb ... with extra space in case of babble */ 41 char (*buffer)[8]; 42 dma_addr_t buffer_dma; /* DMA address for buffer */ 43 union { 44 struct usb_hub_status hub; 45 struct usb_port_status port; 46 } *status; /* buffer for status reports */ 47 48 int error; /* last reported error */ 49 int nerrors; /* track consecutive errors */ 50 51 struct list_head event_list; /* hubs w/data or errs ready */ 52 unsigned long event_bits[1]; /* status change bitmask */ 53 unsigned long change_bits[1]; /* ports with logical connect 54 status change */ 55 unsigned long busy_bits[1]; /* ports being reset or 56 resumed */ 57 #if USB_MAXCHILDREN > 31 /* 8*sizeof(unsigned long) - 1 */ 58 #error event_bits[] is too short! 59 #endif 60 61 struct usb_hub_descriptor *descriptor; /* class descriptor */ 62 struct usb_tt tt; /* Transaction Translator */ 63 64 unsigned mA_per_port; /* current for each child */ 65 66 unsigned limited_power:1; 67 unsigned quiescing:1; 68 unsigned activating:1; 69 70 unsigned has_indicators:1; 71 u8 indicator[USB_MAXCHILDREN]; 72 struct delayed_work leds; 73 }; 74 75 76 /* Protect struct usb_device->state and ->children members 77 * Note: Both are also protected by ->dev.sem, except that ->state can 78 * change to USB_STATE_NOTATTACHED even when the semaphore isn't held. */ 79 static DEFINE_SPINLOCK(device_state_lock); 80 81 /* khubd's worklist and its lock */ 82 static DEFINE_SPINLOCK(hub_event_lock); 83 static LIST_HEAD(hub_event_list); /* List of hubs needing servicing */ 84 85 /* Wakes up khubd */ 86 static DECLARE_WAIT_QUEUE_HEAD(khubd_wait); 87 88 static struct task_struct *khubd_task; 89 90 /* multithreaded probe logic */ 91 static int multithread_probe = 92 #ifdef CONFIG_USB_MULTITHREAD_PROBE 93 1; 94 #else 95 0; 96 #endif 97 module_param(multithread_probe, bool, S_IRUGO); 98 MODULE_PARM_DESC(multithread_probe, "Run each USB device probe in a new thread"); 99 100 /* cycle leds on hubs that aren't blinking for attention */ 101 static int blinkenlights = 0; 102 module_param (blinkenlights, bool, S_IRUGO); 103 MODULE_PARM_DESC (blinkenlights, "true to cycle leds on hubs"); 104 105 /* 106 * As of 2.6.10 we introduce a new USB device initialization scheme which 107 * closely resembles the way Windows works. Hopefully it will be compatible 108 * with a wider range of devices than the old scheme. However some previously 109 * working devices may start giving rise to "device not accepting address" 110 * errors; if that happens the user can try the old scheme by adjusting the 111 * following module parameters. 112 * 113 * For maximum flexibility there are two boolean parameters to control the 114 * hub driver's behavior. On the first initialization attempt, if the 115 * "old_scheme_first" parameter is set then the old scheme will be used, 116 * otherwise the new scheme is used. If that fails and "use_both_schemes" 117 * is set, then the driver will make another attempt, using the other scheme. 118 */ 119 static int old_scheme_first = 0; 120 module_param(old_scheme_first, bool, S_IRUGO | S_IWUSR); 121 MODULE_PARM_DESC(old_scheme_first, 122 "start with the old device initialization scheme"); 123 124 static int use_both_schemes = 1; 125 module_param(use_both_schemes, bool, S_IRUGO | S_IWUSR); 126 MODULE_PARM_DESC(use_both_schemes, 127 "try the other device initialization scheme if the " 128 "first one fails"); 129 130 131 #ifdef DEBUG 132 static inline char *portspeed (int portstatus) 133 { 134 if (portstatus & (1 << USB_PORT_FEAT_HIGHSPEED)) 135 return "480 Mb/s"; 136 else if (portstatus & (1 << USB_PORT_FEAT_LOWSPEED)) 137 return "1.5 Mb/s"; 138 else 139 return "12 Mb/s"; 140 } 141 #endif 142 143 /* Note that hdev or one of its children must be locked! */ 144 static inline struct usb_hub *hdev_to_hub(struct usb_device *hdev) 145 { 146 return usb_get_intfdata(hdev->actconfig->interface[0]); 147 } 148 149 /* USB 2.0 spec Section 11.24.4.5 */ 150 static int get_hub_descriptor(struct usb_device *hdev, void *data, int size) 151 { 152 int i, ret; 153 154 for (i = 0; i < 3; i++) { 155 ret = usb_control_msg(hdev, usb_rcvctrlpipe(hdev, 0), 156 USB_REQ_GET_DESCRIPTOR, USB_DIR_IN | USB_RT_HUB, 157 USB_DT_HUB << 8, 0, data, size, 158 USB_CTRL_GET_TIMEOUT); 159 if (ret >= (USB_DT_HUB_NONVAR_SIZE + 2)) 160 return ret; 161 } 162 return -EINVAL; 163 } 164 165 /* 166 * USB 2.0 spec Section 11.24.2.1 167 */ 168 static int clear_hub_feature(struct usb_device *hdev, int feature) 169 { 170 return usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0), 171 USB_REQ_CLEAR_FEATURE, USB_RT_HUB, feature, 0, NULL, 0, 1000); 172 } 173 174 /* 175 * USB 2.0 spec Section 11.24.2.2 176 */ 177 static int clear_port_feature(struct usb_device *hdev, int port1, int feature) 178 { 179 return usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0), 180 USB_REQ_CLEAR_FEATURE, USB_RT_PORT, feature, port1, 181 NULL, 0, 1000); 182 } 183 184 /* 185 * USB 2.0 spec Section 11.24.2.13 186 */ 187 static int set_port_feature(struct usb_device *hdev, int port1, int feature) 188 { 189 return usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0), 190 USB_REQ_SET_FEATURE, USB_RT_PORT, feature, port1, 191 NULL, 0, 1000); 192 } 193 194 /* 195 * USB 2.0 spec Section 11.24.2.7.1.10 and table 11-7 196 * for info about using port indicators 197 */ 198 static void set_port_led( 199 struct usb_hub *hub, 200 int port1, 201 int selector 202 ) 203 { 204 int status = set_port_feature(hub->hdev, (selector << 8) | port1, 205 USB_PORT_FEAT_INDICATOR); 206 if (status < 0) 207 dev_dbg (hub->intfdev, 208 "port %d indicator %s status %d\n", 209 port1, 210 ({ char *s; switch (selector) { 211 case HUB_LED_AMBER: s = "amber"; break; 212 case HUB_LED_GREEN: s = "green"; break; 213 case HUB_LED_OFF: s = "off"; break; 214 case HUB_LED_AUTO: s = "auto"; break; 215 default: s = "??"; break; 216 }; s; }), 217 status); 218 } 219 220 #define LED_CYCLE_PERIOD ((2*HZ)/3) 221 222 static void led_work (struct work_struct *work) 223 { 224 struct usb_hub *hub = 225 container_of(work, struct usb_hub, leds.work); 226 struct usb_device *hdev = hub->hdev; 227 unsigned i; 228 unsigned changed = 0; 229 int cursor = -1; 230 231 if (hdev->state != USB_STATE_CONFIGURED || hub->quiescing) 232 return; 233 234 for (i = 0; i < hub->descriptor->bNbrPorts; i++) { 235 unsigned selector, mode; 236 237 /* 30%-50% duty cycle */ 238 239 switch (hub->indicator[i]) { 240 /* cycle marker */ 241 case INDICATOR_CYCLE: 242 cursor = i; 243 selector = HUB_LED_AUTO; 244 mode = INDICATOR_AUTO; 245 break; 246 /* blinking green = sw attention */ 247 case INDICATOR_GREEN_BLINK: 248 selector = HUB_LED_GREEN; 249 mode = INDICATOR_GREEN_BLINK_OFF; 250 break; 251 case INDICATOR_GREEN_BLINK_OFF: 252 selector = HUB_LED_OFF; 253 mode = INDICATOR_GREEN_BLINK; 254 break; 255 /* blinking amber = hw attention */ 256 case INDICATOR_AMBER_BLINK: 257 selector = HUB_LED_AMBER; 258 mode = INDICATOR_AMBER_BLINK_OFF; 259 break; 260 case INDICATOR_AMBER_BLINK_OFF: 261 selector = HUB_LED_OFF; 262 mode = INDICATOR_AMBER_BLINK; 263 break; 264 /* blink green/amber = reserved */ 265 case INDICATOR_ALT_BLINK: 266 selector = HUB_LED_GREEN; 267 mode = INDICATOR_ALT_BLINK_OFF; 268 break; 269 case INDICATOR_ALT_BLINK_OFF: 270 selector = HUB_LED_AMBER; 271 mode = INDICATOR_ALT_BLINK; 272 break; 273 default: 274 continue; 275 } 276 if (selector != HUB_LED_AUTO) 277 changed = 1; 278 set_port_led(hub, i + 1, selector); 279 hub->indicator[i] = mode; 280 } 281 if (!changed && blinkenlights) { 282 cursor++; 283 cursor %= hub->descriptor->bNbrPorts; 284 set_port_led(hub, cursor + 1, HUB_LED_GREEN); 285 hub->indicator[cursor] = INDICATOR_CYCLE; 286 changed++; 287 } 288 if (changed) 289 schedule_delayed_work(&hub->leds, LED_CYCLE_PERIOD); 290 } 291 292 /* use a short timeout for hub/port status fetches */ 293 #define USB_STS_TIMEOUT 1000 294 #define USB_STS_RETRIES 5 295 296 /* 297 * USB 2.0 spec Section 11.24.2.6 298 */ 299 static int get_hub_status(struct usb_device *hdev, 300 struct usb_hub_status *data) 301 { 302 int i, status = -ETIMEDOUT; 303 304 for (i = 0; i < USB_STS_RETRIES && status == -ETIMEDOUT; i++) { 305 status = usb_control_msg(hdev, usb_rcvctrlpipe(hdev, 0), 306 USB_REQ_GET_STATUS, USB_DIR_IN | USB_RT_HUB, 0, 0, 307 data, sizeof(*data), USB_STS_TIMEOUT); 308 } 309 return status; 310 } 311 312 /* 313 * USB 2.0 spec Section 11.24.2.7 314 */ 315 static int get_port_status(struct usb_device *hdev, int port1, 316 struct usb_port_status *data) 317 { 318 int i, status = -ETIMEDOUT; 319 320 for (i = 0; i < USB_STS_RETRIES && status == -ETIMEDOUT; i++) { 321 status = usb_control_msg(hdev, usb_rcvctrlpipe(hdev, 0), 322 USB_REQ_GET_STATUS, USB_DIR_IN | USB_RT_PORT, 0, port1, 323 data, sizeof(*data), USB_STS_TIMEOUT); 324 } 325 return status; 326 } 327 328 static void kick_khubd(struct usb_hub *hub) 329 { 330 unsigned long flags; 331 332 /* Suppress autosuspend until khubd runs */ 333 to_usb_interface(hub->intfdev)->pm_usage_cnt = 1; 334 335 spin_lock_irqsave(&hub_event_lock, flags); 336 if (list_empty(&hub->event_list)) { 337 list_add_tail(&hub->event_list, &hub_event_list); 338 wake_up(&khubd_wait); 339 } 340 spin_unlock_irqrestore(&hub_event_lock, flags); 341 } 342 343 void usb_kick_khubd(struct usb_device *hdev) 344 { 345 kick_khubd(hdev_to_hub(hdev)); 346 } 347 348 349 /* completion function, fires on port status changes and various faults */ 350 static void hub_irq(struct urb *urb) 351 { 352 struct usb_hub *hub = urb->context; 353 int status; 354 int i; 355 unsigned long bits; 356 357 switch (urb->status) { 358 case -ENOENT: /* synchronous unlink */ 359 case -ECONNRESET: /* async unlink */ 360 case -ESHUTDOWN: /* hardware going away */ 361 return; 362 363 default: /* presumably an error */ 364 /* Cause a hub reset after 10 consecutive errors */ 365 dev_dbg (hub->intfdev, "transfer --> %d\n", urb->status); 366 if ((++hub->nerrors < 10) || hub->error) 367 goto resubmit; 368 hub->error = urb->status; 369 /* FALL THROUGH */ 370 371 /* let khubd handle things */ 372 case 0: /* we got data: port status changed */ 373 bits = 0; 374 for (i = 0; i < urb->actual_length; ++i) 375 bits |= ((unsigned long) ((*hub->buffer)[i])) 376 << (i*8); 377 hub->event_bits[0] = bits; 378 break; 379 } 380 381 hub->nerrors = 0; 382 383 /* Something happened, let khubd figure it out */ 384 kick_khubd(hub); 385 386 resubmit: 387 if (hub->quiescing) 388 return; 389 390 if ((status = usb_submit_urb (hub->urb, GFP_ATOMIC)) != 0 391 && status != -ENODEV && status != -EPERM) 392 dev_err (hub->intfdev, "resubmit --> %d\n", status); 393 } 394 395 /* USB 2.0 spec Section 11.24.2.3 */ 396 static inline int 397 hub_clear_tt_buffer (struct usb_device *hdev, u16 devinfo, u16 tt) 398 { 399 return usb_control_msg(hdev, usb_rcvctrlpipe(hdev, 0), 400 HUB_CLEAR_TT_BUFFER, USB_RT_PORT, devinfo, 401 tt, NULL, 0, 1000); 402 } 403 404 /* 405 * enumeration blocks khubd for a long time. we use keventd instead, since 406 * long blocking there is the exception, not the rule. accordingly, HCDs 407 * talking to TTs must queue control transfers (not just bulk and iso), so 408 * both can talk to the same hub concurrently. 409 */ 410 static void hub_tt_kevent (struct work_struct *work) 411 { 412 struct usb_hub *hub = 413 container_of(work, struct usb_hub, tt.kevent); 414 unsigned long flags; 415 416 spin_lock_irqsave (&hub->tt.lock, flags); 417 while (!list_empty (&hub->tt.clear_list)) { 418 struct list_head *temp; 419 struct usb_tt_clear *clear; 420 struct usb_device *hdev = hub->hdev; 421 int status; 422 423 temp = hub->tt.clear_list.next; 424 clear = list_entry (temp, struct usb_tt_clear, clear_list); 425 list_del (&clear->clear_list); 426 427 /* drop lock so HCD can concurrently report other TT errors */ 428 spin_unlock_irqrestore (&hub->tt.lock, flags); 429 status = hub_clear_tt_buffer (hdev, clear->devinfo, clear->tt); 430 spin_lock_irqsave (&hub->tt.lock, flags); 431 432 if (status) 433 dev_err (&hdev->dev, 434 "clear tt %d (%04x) error %d\n", 435 clear->tt, clear->devinfo, status); 436 kfree(clear); 437 } 438 spin_unlock_irqrestore (&hub->tt.lock, flags); 439 } 440 441 /** 442 * usb_hub_tt_clear_buffer - clear control/bulk TT state in high speed hub 443 * @udev: the device whose split transaction failed 444 * @pipe: identifies the endpoint of the failed transaction 445 * 446 * High speed HCDs use this to tell the hub driver that some split control or 447 * bulk transaction failed in a way that requires clearing internal state of 448 * a transaction translator. This is normally detected (and reported) from 449 * interrupt context. 450 * 451 * It may not be possible for that hub to handle additional full (or low) 452 * speed transactions until that state is fully cleared out. 453 */ 454 void usb_hub_tt_clear_buffer (struct usb_device *udev, int pipe) 455 { 456 struct usb_tt *tt = udev->tt; 457 unsigned long flags; 458 struct usb_tt_clear *clear; 459 460 /* we've got to cope with an arbitrary number of pending TT clears, 461 * since each TT has "at least two" buffers that can need it (and 462 * there can be many TTs per hub). even if they're uncommon. 463 */ 464 if ((clear = kmalloc (sizeof *clear, GFP_ATOMIC)) == NULL) { 465 dev_err (&udev->dev, "can't save CLEAR_TT_BUFFER state\n"); 466 /* FIXME recover somehow ... RESET_TT? */ 467 return; 468 } 469 470 /* info that CLEAR_TT_BUFFER needs */ 471 clear->tt = tt->multi ? udev->ttport : 1; 472 clear->devinfo = usb_pipeendpoint (pipe); 473 clear->devinfo |= udev->devnum << 4; 474 clear->devinfo |= usb_pipecontrol (pipe) 475 ? (USB_ENDPOINT_XFER_CONTROL << 11) 476 : (USB_ENDPOINT_XFER_BULK << 11); 477 if (usb_pipein (pipe)) 478 clear->devinfo |= 1 << 15; 479 480 /* tell keventd to clear state for this TT */ 481 spin_lock_irqsave (&tt->lock, flags); 482 list_add_tail (&clear->clear_list, &tt->clear_list); 483 schedule_work (&tt->kevent); 484 spin_unlock_irqrestore (&tt->lock, flags); 485 } 486 487 static void hub_power_on(struct usb_hub *hub) 488 { 489 int port1; 490 unsigned pgood_delay = hub->descriptor->bPwrOn2PwrGood * 2; 491 u16 wHubCharacteristics = 492 le16_to_cpu(hub->descriptor->wHubCharacteristics); 493 494 /* Enable power on each port. Some hubs have reserved values 495 * of LPSM (> 2) in their descriptors, even though they are 496 * USB 2.0 hubs. Some hubs do not implement port-power switching 497 * but only emulate it. In all cases, the ports won't work 498 * unless we send these messages to the hub. 499 */ 500 if ((wHubCharacteristics & HUB_CHAR_LPSM) < 2) 501 dev_dbg(hub->intfdev, "enabling power on all ports\n"); 502 else 503 dev_dbg(hub->intfdev, "trying to enable port power on " 504 "non-switchable hub\n"); 505 for (port1 = 1; port1 <= hub->descriptor->bNbrPorts; port1++) 506 set_port_feature(hub->hdev, port1, USB_PORT_FEAT_POWER); 507 508 /* Wait at least 100 msec for power to become stable */ 509 msleep(max(pgood_delay, (unsigned) 100)); 510 } 511 512 static void hub_quiesce(struct usb_hub *hub) 513 { 514 /* (nonblocking) khubd and related activity won't re-trigger */ 515 hub->quiescing = 1; 516 hub->activating = 0; 517 518 /* (blocking) stop khubd and related activity */ 519 usb_kill_urb(hub->urb); 520 if (hub->has_indicators) 521 cancel_delayed_work(&hub->leds); 522 if (hub->has_indicators || hub->tt.hub) 523 flush_scheduled_work(); 524 } 525 526 static void hub_activate(struct usb_hub *hub) 527 { 528 int status; 529 530 hub->quiescing = 0; 531 hub->activating = 1; 532 533 status = usb_submit_urb(hub->urb, GFP_NOIO); 534 if (status < 0) 535 dev_err(hub->intfdev, "activate --> %d\n", status); 536 if (hub->has_indicators && blinkenlights) 537 schedule_delayed_work(&hub->leds, LED_CYCLE_PERIOD); 538 539 /* scan all ports ASAP */ 540 kick_khubd(hub); 541 } 542 543 static int hub_hub_status(struct usb_hub *hub, 544 u16 *status, u16 *change) 545 { 546 int ret; 547 548 ret = get_hub_status(hub->hdev, &hub->status->hub); 549 if (ret < 0) 550 dev_err (hub->intfdev, 551 "%s failed (err = %d)\n", __FUNCTION__, ret); 552 else { 553 *status = le16_to_cpu(hub->status->hub.wHubStatus); 554 *change = le16_to_cpu(hub->status->hub.wHubChange); 555 ret = 0; 556 } 557 return ret; 558 } 559 560 static int hub_port_disable(struct usb_hub *hub, int port1, int set_state) 561 { 562 struct usb_device *hdev = hub->hdev; 563 int ret; 564 565 if (hdev->children[port1-1] && set_state) { 566 usb_set_device_state(hdev->children[port1-1], 567 USB_STATE_NOTATTACHED); 568 } 569 ret = clear_port_feature(hdev, port1, USB_PORT_FEAT_ENABLE); 570 if (ret) 571 dev_err(hub->intfdev, "cannot disable port %d (err = %d)\n", 572 port1, ret); 573 574 return ret; 575 } 576 577 578 /* caller has locked the hub device */ 579 static void hub_pre_reset(struct usb_interface *intf) 580 { 581 struct usb_hub *hub = usb_get_intfdata(intf); 582 struct usb_device *hdev = hub->hdev; 583 int port1; 584 585 for (port1 = 1; port1 <= hdev->maxchild; ++port1) { 586 if (hdev->children[port1 - 1]) { 587 usb_disconnect(&hdev->children[port1 - 1]); 588 if (hub->error == 0) 589 hub_port_disable(hub, port1, 0); 590 } 591 } 592 hub_quiesce(hub); 593 } 594 595 /* caller has locked the hub device */ 596 static void hub_post_reset(struct usb_interface *intf) 597 { 598 struct usb_hub *hub = usb_get_intfdata(intf); 599 600 hub_activate(hub); 601 hub_power_on(hub); 602 } 603 604 605 static int hub_configure(struct usb_hub *hub, 606 struct usb_endpoint_descriptor *endpoint) 607 { 608 struct usb_device *hdev = hub->hdev; 609 struct device *hub_dev = hub->intfdev; 610 u16 hubstatus, hubchange; 611 u16 wHubCharacteristics; 612 unsigned int pipe; 613 int maxp, ret; 614 char *message; 615 616 hub->buffer = usb_buffer_alloc(hdev, sizeof(*hub->buffer), GFP_KERNEL, 617 &hub->buffer_dma); 618 if (!hub->buffer) { 619 message = "can't allocate hub irq buffer"; 620 ret = -ENOMEM; 621 goto fail; 622 } 623 624 hub->status = kmalloc(sizeof(*hub->status), GFP_KERNEL); 625 if (!hub->status) { 626 message = "can't kmalloc hub status buffer"; 627 ret = -ENOMEM; 628 goto fail; 629 } 630 631 hub->descriptor = kmalloc(sizeof(*hub->descriptor), GFP_KERNEL); 632 if (!hub->descriptor) { 633 message = "can't kmalloc hub descriptor"; 634 ret = -ENOMEM; 635 goto fail; 636 } 637 638 /* Request the entire hub descriptor. 639 * hub->descriptor can handle USB_MAXCHILDREN ports, 640 * but the hub can/will return fewer bytes here. 641 */ 642 ret = get_hub_descriptor(hdev, hub->descriptor, 643 sizeof(*hub->descriptor)); 644 if (ret < 0) { 645 message = "can't read hub descriptor"; 646 goto fail; 647 } else if (hub->descriptor->bNbrPorts > USB_MAXCHILDREN) { 648 message = "hub has too many ports!"; 649 ret = -ENODEV; 650 goto fail; 651 } 652 653 hdev->maxchild = hub->descriptor->bNbrPorts; 654 dev_info (hub_dev, "%d port%s detected\n", hdev->maxchild, 655 (hdev->maxchild == 1) ? "" : "s"); 656 657 wHubCharacteristics = le16_to_cpu(hub->descriptor->wHubCharacteristics); 658 659 if (wHubCharacteristics & HUB_CHAR_COMPOUND) { 660 int i; 661 char portstr [USB_MAXCHILDREN + 1]; 662 663 for (i = 0; i < hdev->maxchild; i++) 664 portstr[i] = hub->descriptor->DeviceRemovable 665 [((i + 1) / 8)] & (1 << ((i + 1) % 8)) 666 ? 'F' : 'R'; 667 portstr[hdev->maxchild] = 0; 668 dev_dbg(hub_dev, "compound device; port removable status: %s\n", portstr); 669 } else 670 dev_dbg(hub_dev, "standalone hub\n"); 671 672 switch (wHubCharacteristics & HUB_CHAR_LPSM) { 673 case 0x00: 674 dev_dbg(hub_dev, "ganged power switching\n"); 675 break; 676 case 0x01: 677 dev_dbg(hub_dev, "individual port power switching\n"); 678 break; 679 case 0x02: 680 case 0x03: 681 dev_dbg(hub_dev, "no power switching (usb 1.0)\n"); 682 break; 683 } 684 685 switch (wHubCharacteristics & HUB_CHAR_OCPM) { 686 case 0x00: 687 dev_dbg(hub_dev, "global over-current protection\n"); 688 break; 689 case 0x08: 690 dev_dbg(hub_dev, "individual port over-current protection\n"); 691 break; 692 case 0x10: 693 case 0x18: 694 dev_dbg(hub_dev, "no over-current protection\n"); 695 break; 696 } 697 698 spin_lock_init (&hub->tt.lock); 699 INIT_LIST_HEAD (&hub->tt.clear_list); 700 INIT_WORK (&hub->tt.kevent, hub_tt_kevent); 701 switch (hdev->descriptor.bDeviceProtocol) { 702 case 0: 703 break; 704 case 1: 705 dev_dbg(hub_dev, "Single TT\n"); 706 hub->tt.hub = hdev; 707 break; 708 case 2: 709 ret = usb_set_interface(hdev, 0, 1); 710 if (ret == 0) { 711 dev_dbg(hub_dev, "TT per port\n"); 712 hub->tt.multi = 1; 713 } else 714 dev_err(hub_dev, "Using single TT (err %d)\n", 715 ret); 716 hub->tt.hub = hdev; 717 break; 718 default: 719 dev_dbg(hub_dev, "Unrecognized hub protocol %d\n", 720 hdev->descriptor.bDeviceProtocol); 721 break; 722 } 723 724 /* Note 8 FS bit times == (8 bits / 12000000 bps) ~= 666ns */ 725 switch (wHubCharacteristics & HUB_CHAR_TTTT) { 726 case HUB_TTTT_8_BITS: 727 if (hdev->descriptor.bDeviceProtocol != 0) { 728 hub->tt.think_time = 666; 729 dev_dbg(hub_dev, "TT requires at most %d " 730 "FS bit times (%d ns)\n", 731 8, hub->tt.think_time); 732 } 733 break; 734 case HUB_TTTT_16_BITS: 735 hub->tt.think_time = 666 * 2; 736 dev_dbg(hub_dev, "TT requires at most %d " 737 "FS bit times (%d ns)\n", 738 16, hub->tt.think_time); 739 break; 740 case HUB_TTTT_24_BITS: 741 hub->tt.think_time = 666 * 3; 742 dev_dbg(hub_dev, "TT requires at most %d " 743 "FS bit times (%d ns)\n", 744 24, hub->tt.think_time); 745 break; 746 case HUB_TTTT_32_BITS: 747 hub->tt.think_time = 666 * 4; 748 dev_dbg(hub_dev, "TT requires at most %d " 749 "FS bit times (%d ns)\n", 750 32, hub->tt.think_time); 751 break; 752 } 753 754 /* probe() zeroes hub->indicator[] */ 755 if (wHubCharacteristics & HUB_CHAR_PORTIND) { 756 hub->has_indicators = 1; 757 dev_dbg(hub_dev, "Port indicators are supported\n"); 758 } 759 760 dev_dbg(hub_dev, "power on to power good time: %dms\n", 761 hub->descriptor->bPwrOn2PwrGood * 2); 762 763 /* power budgeting mostly matters with bus-powered hubs, 764 * and battery-powered root hubs (may provide just 8 mA). 765 */ 766 ret = usb_get_status(hdev, USB_RECIP_DEVICE, 0, &hubstatus); 767 if (ret < 2) { 768 message = "can't get hub status"; 769 goto fail; 770 } 771 le16_to_cpus(&hubstatus); 772 if (hdev == hdev->bus->root_hub) { 773 if (hdev->bus_mA == 0 || hdev->bus_mA >= 500) 774 hub->mA_per_port = 500; 775 else { 776 hub->mA_per_port = hdev->bus_mA; 777 hub->limited_power = 1; 778 } 779 } else if ((hubstatus & (1 << USB_DEVICE_SELF_POWERED)) == 0) { 780 dev_dbg(hub_dev, "hub controller current requirement: %dmA\n", 781 hub->descriptor->bHubContrCurrent); 782 hub->limited_power = 1; 783 if (hdev->maxchild > 0) { 784 int remaining = hdev->bus_mA - 785 hub->descriptor->bHubContrCurrent; 786 787 if (remaining < hdev->maxchild * 100) 788 dev_warn(hub_dev, 789 "insufficient power available " 790 "to use all downstream ports\n"); 791 hub->mA_per_port = 100; /* 7.2.1.1 */ 792 } 793 } else { /* Self-powered external hub */ 794 /* FIXME: What about battery-powered external hubs that 795 * provide less current per port? */ 796 hub->mA_per_port = 500; 797 } 798 if (hub->mA_per_port < 500) 799 dev_dbg(hub_dev, "%umA bus power budget for each child\n", 800 hub->mA_per_port); 801 802 ret = hub_hub_status(hub, &hubstatus, &hubchange); 803 if (ret < 0) { 804 message = "can't get hub status"; 805 goto fail; 806 } 807 808 /* local power status reports aren't always correct */ 809 if (hdev->actconfig->desc.bmAttributes & USB_CONFIG_ATT_SELFPOWER) 810 dev_dbg(hub_dev, "local power source is %s\n", 811 (hubstatus & HUB_STATUS_LOCAL_POWER) 812 ? "lost (inactive)" : "good"); 813 814 if ((wHubCharacteristics & HUB_CHAR_OCPM) == 0) 815 dev_dbg(hub_dev, "%sover-current condition exists\n", 816 (hubstatus & HUB_STATUS_OVERCURRENT) ? "" : "no "); 817 818 /* set up the interrupt endpoint 819 * We use the EP's maxpacket size instead of (PORTS+1+7)/8 820 * bytes as USB2.0[11.12.3] says because some hubs are known 821 * to send more data (and thus cause overflow). For root hubs, 822 * maxpktsize is defined in hcd.c's fake endpoint descriptors 823 * to be big enough for at least USB_MAXCHILDREN ports. */ 824 pipe = usb_rcvintpipe(hdev, endpoint->bEndpointAddress); 825 maxp = usb_maxpacket(hdev, pipe, usb_pipeout(pipe)); 826 827 if (maxp > sizeof(*hub->buffer)) 828 maxp = sizeof(*hub->buffer); 829 830 hub->urb = usb_alloc_urb(0, GFP_KERNEL); 831 if (!hub->urb) { 832 message = "couldn't allocate interrupt urb"; 833 ret = -ENOMEM; 834 goto fail; 835 } 836 837 usb_fill_int_urb(hub->urb, hdev, pipe, *hub->buffer, maxp, hub_irq, 838 hub, endpoint->bInterval); 839 hub->urb->transfer_dma = hub->buffer_dma; 840 hub->urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; 841 842 /* maybe cycle the hub leds */ 843 if (hub->has_indicators && blinkenlights) 844 hub->indicator [0] = INDICATOR_CYCLE; 845 846 hub_power_on(hub); 847 hub_activate(hub); 848 return 0; 849 850 fail: 851 dev_err (hub_dev, "config failed, %s (err %d)\n", 852 message, ret); 853 /* hub_disconnect() frees urb and descriptor */ 854 return ret; 855 } 856 857 static unsigned highspeed_hubs; 858 859 static void hub_disconnect(struct usb_interface *intf) 860 { 861 struct usb_hub *hub = usb_get_intfdata (intf); 862 struct usb_device *hdev; 863 864 /* Disconnect all children and quiesce the hub */ 865 hub->error = 0; 866 hub_pre_reset(intf); 867 868 usb_set_intfdata (intf, NULL); 869 hdev = hub->hdev; 870 871 if (hdev->speed == USB_SPEED_HIGH) 872 highspeed_hubs--; 873 874 usb_free_urb(hub->urb); 875 hub->urb = NULL; 876 877 spin_lock_irq(&hub_event_lock); 878 list_del_init(&hub->event_list); 879 spin_unlock_irq(&hub_event_lock); 880 881 kfree(hub->descriptor); 882 hub->descriptor = NULL; 883 884 kfree(hub->status); 885 hub->status = NULL; 886 887 if (hub->buffer) { 888 usb_buffer_free(hdev, sizeof(*hub->buffer), hub->buffer, 889 hub->buffer_dma); 890 hub->buffer = NULL; 891 } 892 893 kfree(hub); 894 } 895 896 static int hub_probe(struct usb_interface *intf, const struct usb_device_id *id) 897 { 898 struct usb_host_interface *desc; 899 struct usb_endpoint_descriptor *endpoint; 900 struct usb_device *hdev; 901 struct usb_hub *hub; 902 903 desc = intf->cur_altsetting; 904 hdev = interface_to_usbdev(intf); 905 906 #ifdef CONFIG_USB_OTG_BLACKLIST_HUB 907 if (hdev->parent) { 908 dev_warn(&intf->dev, "ignoring external hub\n"); 909 return -ENODEV; 910 } 911 #endif 912 913 /* Some hubs have a subclass of 1, which AFAICT according to the */ 914 /* specs is not defined, but it works */ 915 if ((desc->desc.bInterfaceSubClass != 0) && 916 (desc->desc.bInterfaceSubClass != 1)) { 917 descriptor_error: 918 dev_err (&intf->dev, "bad descriptor, ignoring hub\n"); 919 return -EIO; 920 } 921 922 /* Multiple endpoints? What kind of mutant ninja-hub is this? */ 923 if (desc->desc.bNumEndpoints != 1) 924 goto descriptor_error; 925 926 endpoint = &desc->endpoint[0].desc; 927 928 /* If it's not an interrupt in endpoint, we'd better punt! */ 929 if (!usb_endpoint_is_int_in(endpoint)) 930 goto descriptor_error; 931 932 /* We found a hub */ 933 dev_info (&intf->dev, "USB hub found\n"); 934 935 hub = kzalloc(sizeof(*hub), GFP_KERNEL); 936 if (!hub) { 937 dev_dbg (&intf->dev, "couldn't kmalloc hub struct\n"); 938 return -ENOMEM; 939 } 940 941 INIT_LIST_HEAD(&hub->event_list); 942 hub->intfdev = &intf->dev; 943 hub->hdev = hdev; 944 INIT_DELAYED_WORK(&hub->leds, led_work); 945 946 usb_set_intfdata (intf, hub); 947 intf->needs_remote_wakeup = 1; 948 949 if (hdev->speed == USB_SPEED_HIGH) 950 highspeed_hubs++; 951 952 if (hub_configure(hub, endpoint) >= 0) 953 return 0; 954 955 hub_disconnect (intf); 956 return -ENODEV; 957 } 958 959 static int 960 hub_ioctl(struct usb_interface *intf, unsigned int code, void *user_data) 961 { 962 struct usb_device *hdev = interface_to_usbdev (intf); 963 964 /* assert ifno == 0 (part of hub spec) */ 965 switch (code) { 966 case USBDEVFS_HUB_PORTINFO: { 967 struct usbdevfs_hub_portinfo *info = user_data; 968 int i; 969 970 spin_lock_irq(&device_state_lock); 971 if (hdev->devnum <= 0) 972 info->nports = 0; 973 else { 974 info->nports = hdev->maxchild; 975 for (i = 0; i < info->nports; i++) { 976 if (hdev->children[i] == NULL) 977 info->port[i] = 0; 978 else 979 info->port[i] = 980 hdev->children[i]->devnum; 981 } 982 } 983 spin_unlock_irq(&device_state_lock); 984 985 return info->nports + 1; 986 } 987 988 default: 989 return -ENOSYS; 990 } 991 } 992 993 994 /* grab device/port lock, returning index of that port (zero based). 995 * protects the upstream link used by this device from concurrent 996 * tree operations like suspend, resume, reset, and disconnect, which 997 * apply to everything downstream of a given port. 998 */ 999 static int locktree(struct usb_device *udev) 1000 { 1001 int t; 1002 struct usb_device *hdev; 1003 1004 if (!udev) 1005 return -ENODEV; 1006 1007 /* root hub is always the first lock in the series */ 1008 hdev = udev->parent; 1009 if (!hdev) { 1010 usb_lock_device(udev); 1011 return 0; 1012 } 1013 1014 /* on the path from root to us, lock everything from 1015 * top down, dropping parent locks when not needed 1016 */ 1017 t = locktree(hdev); 1018 if (t < 0) 1019 return t; 1020 1021 /* everything is fail-fast once disconnect 1022 * processing starts 1023 */ 1024 if (udev->state == USB_STATE_NOTATTACHED) { 1025 usb_unlock_device(hdev); 1026 return -ENODEV; 1027 } 1028 1029 /* when everyone grabs locks top->bottom, 1030 * non-overlapping work may be concurrent 1031 */ 1032 usb_lock_device(udev); 1033 usb_unlock_device(hdev); 1034 return udev->portnum; 1035 } 1036 1037 static void recursively_mark_NOTATTACHED(struct usb_device *udev) 1038 { 1039 int i; 1040 1041 for (i = 0; i < udev->maxchild; ++i) { 1042 if (udev->children[i]) 1043 recursively_mark_NOTATTACHED(udev->children[i]); 1044 } 1045 if (udev->state == USB_STATE_SUSPENDED) 1046 udev->discon_suspended = 1; 1047 udev->state = USB_STATE_NOTATTACHED; 1048 } 1049 1050 /** 1051 * usb_set_device_state - change a device's current state (usbcore, hcds) 1052 * @udev: pointer to device whose state should be changed 1053 * @new_state: new state value to be stored 1054 * 1055 * udev->state is _not_ fully protected by the device lock. Although 1056 * most transitions are made only while holding the lock, the state can 1057 * can change to USB_STATE_NOTATTACHED at almost any time. This 1058 * is so that devices can be marked as disconnected as soon as possible, 1059 * without having to wait for any semaphores to be released. As a result, 1060 * all changes to any device's state must be protected by the 1061 * device_state_lock spinlock. 1062 * 1063 * Once a device has been added to the device tree, all changes to its state 1064 * should be made using this routine. The state should _not_ be set directly. 1065 * 1066 * If udev->state is already USB_STATE_NOTATTACHED then no change is made. 1067 * Otherwise udev->state is set to new_state, and if new_state is 1068 * USB_STATE_NOTATTACHED then all of udev's descendants' states are also set 1069 * to USB_STATE_NOTATTACHED. 1070 */ 1071 void usb_set_device_state(struct usb_device *udev, 1072 enum usb_device_state new_state) 1073 { 1074 unsigned long flags; 1075 1076 spin_lock_irqsave(&device_state_lock, flags); 1077 if (udev->state == USB_STATE_NOTATTACHED) 1078 ; /* do nothing */ 1079 else if (new_state != USB_STATE_NOTATTACHED) { 1080 1081 /* root hub wakeup capabilities are managed out-of-band 1082 * and may involve silicon errata ... ignore them here. 1083 */ 1084 if (udev->parent) { 1085 if (udev->state == USB_STATE_SUSPENDED 1086 || new_state == USB_STATE_SUSPENDED) 1087 ; /* No change to wakeup settings */ 1088 else if (new_state == USB_STATE_CONFIGURED) 1089 device_init_wakeup(&udev->dev, 1090 (udev->actconfig->desc.bmAttributes 1091 & USB_CONFIG_ATT_WAKEUP)); 1092 else 1093 device_init_wakeup(&udev->dev, 0); 1094 } 1095 udev->state = new_state; 1096 } else 1097 recursively_mark_NOTATTACHED(udev); 1098 spin_unlock_irqrestore(&device_state_lock, flags); 1099 } 1100 1101 1102 #ifdef CONFIG_PM 1103 1104 /** 1105 * usb_root_hub_lost_power - called by HCD if the root hub lost Vbus power 1106 * @rhdev: struct usb_device for the root hub 1107 * 1108 * The USB host controller driver calls this function when its root hub 1109 * is resumed and Vbus power has been interrupted or the controller 1110 * has been reset. The routine marks all the children of the root hub 1111 * as NOTATTACHED and marks logical connect-change events on their ports. 1112 */ 1113 void usb_root_hub_lost_power(struct usb_device *rhdev) 1114 { 1115 struct usb_hub *hub; 1116 int port1; 1117 unsigned long flags; 1118 1119 dev_warn(&rhdev->dev, "root hub lost power or was reset\n"); 1120 1121 /* Make sure no potential wakeup events get lost, 1122 * by forcing the root hub to be resumed. 1123 */ 1124 rhdev->dev.power.prev_state.event = PM_EVENT_ON; 1125 1126 spin_lock_irqsave(&device_state_lock, flags); 1127 hub = hdev_to_hub(rhdev); 1128 for (port1 = 1; port1 <= rhdev->maxchild; ++port1) { 1129 if (rhdev->children[port1 - 1]) { 1130 recursively_mark_NOTATTACHED( 1131 rhdev->children[port1 - 1]); 1132 set_bit(port1, hub->change_bits); 1133 } 1134 } 1135 spin_unlock_irqrestore(&device_state_lock, flags); 1136 } 1137 EXPORT_SYMBOL_GPL(usb_root_hub_lost_power); 1138 1139 #endif /* CONFIG_PM */ 1140 1141 static void choose_address(struct usb_device *udev) 1142 { 1143 int devnum; 1144 struct usb_bus *bus = udev->bus; 1145 1146 /* If khubd ever becomes multithreaded, this will need a lock */ 1147 1148 /* Try to allocate the next devnum beginning at bus->devnum_next. */ 1149 devnum = find_next_zero_bit(bus->devmap.devicemap, 128, 1150 bus->devnum_next); 1151 if (devnum >= 128) 1152 devnum = find_next_zero_bit(bus->devmap.devicemap, 128, 1); 1153 1154 bus->devnum_next = ( devnum >= 127 ? 1 : devnum + 1); 1155 1156 if (devnum < 128) { 1157 set_bit(devnum, bus->devmap.devicemap); 1158 udev->devnum = devnum; 1159 } 1160 } 1161 1162 static void release_address(struct usb_device *udev) 1163 { 1164 if (udev->devnum > 0) { 1165 clear_bit(udev->devnum, udev->bus->devmap.devicemap); 1166 udev->devnum = -1; 1167 } 1168 } 1169 1170 /** 1171 * usb_disconnect - disconnect a device (usbcore-internal) 1172 * @pdev: pointer to device being disconnected 1173 * Context: !in_interrupt () 1174 * 1175 * Something got disconnected. Get rid of it and all of its children. 1176 * 1177 * If *pdev is a normal device then the parent hub must already be locked. 1178 * If *pdev is a root hub then this routine will acquire the 1179 * usb_bus_list_lock on behalf of the caller. 1180 * 1181 * Only hub drivers (including virtual root hub drivers for host 1182 * controllers) should ever call this. 1183 * 1184 * This call is synchronous, and may not be used in an interrupt context. 1185 */ 1186 void usb_disconnect(struct usb_device **pdev) 1187 { 1188 struct usb_device *udev = *pdev; 1189 int i; 1190 1191 if (!udev) { 1192 pr_debug ("%s nodev\n", __FUNCTION__); 1193 return; 1194 } 1195 1196 /* mark the device as inactive, so any further urb submissions for 1197 * this device (and any of its children) will fail immediately. 1198 * this quiesces everyting except pending urbs. 1199 */ 1200 usb_set_device_state(udev, USB_STATE_NOTATTACHED); 1201 dev_info (&udev->dev, "USB disconnect, address %d\n", udev->devnum); 1202 1203 usb_lock_device(udev); 1204 1205 /* Free up all the children before we remove this device */ 1206 for (i = 0; i < USB_MAXCHILDREN; i++) { 1207 if (udev->children[i]) 1208 usb_disconnect(&udev->children[i]); 1209 } 1210 1211 /* deallocate hcd/hardware state ... nuking all pending urbs and 1212 * cleaning up all state associated with the current configuration 1213 * so that the hardware is now fully quiesced. 1214 */ 1215 dev_dbg (&udev->dev, "unregistering device\n"); 1216 usb_disable_device(udev, 0); 1217 1218 usb_unlock_device(udev); 1219 1220 /* Unregister the device. The device driver is responsible 1221 * for removing the device files from usbfs and sysfs and for 1222 * de-configuring the device. 1223 */ 1224 device_del(&udev->dev); 1225 1226 /* Free the device number and delete the parent's children[] 1227 * (or root_hub) pointer. 1228 */ 1229 release_address(udev); 1230 1231 /* Avoid races with recursively_mark_NOTATTACHED() */ 1232 spin_lock_irq(&device_state_lock); 1233 *pdev = NULL; 1234 spin_unlock_irq(&device_state_lock); 1235 1236 /* Decrement the parent's count of unsuspended children */ 1237 if (udev->parent) { 1238 usb_pm_lock(udev); 1239 if (!udev->discon_suspended) 1240 usb_autosuspend_device(udev->parent); 1241 usb_pm_unlock(udev); 1242 } 1243 1244 put_device(&udev->dev); 1245 } 1246 1247 #ifdef DEBUG 1248 static void show_string(struct usb_device *udev, char *id, char *string) 1249 { 1250 if (!string) 1251 return; 1252 dev_printk(KERN_INFO, &udev->dev, "%s: %s\n", id, string); 1253 } 1254 1255 #else 1256 static inline void show_string(struct usb_device *udev, char *id, char *string) 1257 {} 1258 #endif 1259 1260 1261 #ifdef CONFIG_USB_OTG 1262 #include "otg_whitelist.h" 1263 static int __usb_port_suspend(struct usb_device *, int port1); 1264 #endif 1265 1266 static int __usb_new_device(void *void_data) 1267 { 1268 struct usb_device *udev = void_data; 1269 int err; 1270 1271 /* Lock ourself into memory in order to keep a probe sequence 1272 * sleeping in a new thread from allowing us to be unloaded. 1273 */ 1274 if (!try_module_get(THIS_MODULE)) 1275 return -EINVAL; 1276 1277 err = usb_get_configuration(udev); 1278 if (err < 0) { 1279 dev_err(&udev->dev, "can't read configurations, error %d\n", 1280 err); 1281 goto fail; 1282 } 1283 1284 /* read the standard strings and cache them if present */ 1285 udev->product = usb_cache_string(udev, udev->descriptor.iProduct); 1286 udev->manufacturer = usb_cache_string(udev, 1287 udev->descriptor.iManufacturer); 1288 udev->serial = usb_cache_string(udev, udev->descriptor.iSerialNumber); 1289 1290 /* Tell the world! */ 1291 dev_dbg(&udev->dev, "new device strings: Mfr=%d, Product=%d, " 1292 "SerialNumber=%d\n", 1293 udev->descriptor.iManufacturer, 1294 udev->descriptor.iProduct, 1295 udev->descriptor.iSerialNumber); 1296 show_string(udev, "Product", udev->product); 1297 show_string(udev, "Manufacturer", udev->manufacturer); 1298 show_string(udev, "SerialNumber", udev->serial); 1299 1300 #ifdef CONFIG_USB_OTG 1301 /* 1302 * OTG-aware devices on OTG-capable root hubs may be able to use SRP, 1303 * to wake us after we've powered off VBUS; and HNP, switching roles 1304 * "host" to "peripheral". The OTG descriptor helps figure this out. 1305 */ 1306 if (!udev->bus->is_b_host 1307 && udev->config 1308 && udev->parent == udev->bus->root_hub) { 1309 struct usb_otg_descriptor *desc = 0; 1310 struct usb_bus *bus = udev->bus; 1311 1312 /* descriptor may appear anywhere in config */ 1313 if (__usb_get_extra_descriptor (udev->rawdescriptors[0], 1314 le16_to_cpu(udev->config[0].desc.wTotalLength), 1315 USB_DT_OTG, (void **) &desc) == 0) { 1316 if (desc->bmAttributes & USB_OTG_HNP) { 1317 unsigned port1 = udev->portnum; 1318 1319 dev_info(&udev->dev, 1320 "Dual-Role OTG device on %sHNP port\n", 1321 (port1 == bus->otg_port) 1322 ? "" : "non-"); 1323 1324 /* enable HNP before suspend, it's simpler */ 1325 if (port1 == bus->otg_port) 1326 bus->b_hnp_enable = 1; 1327 err = usb_control_msg(udev, 1328 usb_sndctrlpipe(udev, 0), 1329 USB_REQ_SET_FEATURE, 0, 1330 bus->b_hnp_enable 1331 ? USB_DEVICE_B_HNP_ENABLE 1332 : USB_DEVICE_A_ALT_HNP_SUPPORT, 1333 0, NULL, 0, USB_CTRL_SET_TIMEOUT); 1334 if (err < 0) { 1335 /* OTG MESSAGE: report errors here, 1336 * customize to match your product. 1337 */ 1338 dev_info(&udev->dev, 1339 "can't set HNP mode; %d\n", 1340 err); 1341 bus->b_hnp_enable = 0; 1342 } 1343 } 1344 } 1345 } 1346 1347 if (!is_targeted(udev)) { 1348 1349 /* Maybe it can talk to us, though we can't talk to it. 1350 * (Includes HNP test device.) 1351 */ 1352 if (udev->bus->b_hnp_enable || udev->bus->is_b_host) { 1353 err = __usb_port_suspend(udev, udev->bus->otg_port); 1354 if (err < 0) 1355 dev_dbg(&udev->dev, "HNP fail, %d\n", err); 1356 } 1357 err = -ENODEV; 1358 goto fail; 1359 } 1360 #endif 1361 1362 /* Register the device. The device driver is responsible 1363 * for adding the device files to usbfs and sysfs and for 1364 * configuring the device. 1365 */ 1366 err = device_add (&udev->dev); 1367 if (err) { 1368 dev_err(&udev->dev, "can't device_add, error %d\n", err); 1369 goto fail; 1370 } 1371 1372 /* Increment the parent's count of unsuspended children */ 1373 if (udev->parent) 1374 usb_autoresume_device(udev->parent); 1375 1376 exit: 1377 module_put(THIS_MODULE); 1378 return err; 1379 1380 fail: 1381 usb_set_device_state(udev, USB_STATE_NOTATTACHED); 1382 goto exit; 1383 } 1384 1385 /** 1386 * usb_new_device - perform initial device setup (usbcore-internal) 1387 * @udev: newly addressed device (in ADDRESS state) 1388 * 1389 * This is called with devices which have been enumerated, but not yet 1390 * configured. The device descriptor is available, but not descriptors 1391 * for any device configuration. The caller must have locked either 1392 * the parent hub (if udev is a normal device) or else the 1393 * usb_bus_list_lock (if udev is a root hub). The parent's pointer to 1394 * udev has already been installed, but udev is not yet visible through 1395 * sysfs or other filesystem code. 1396 * 1397 * The return value for this function depends on if the 1398 * multithread_probe variable is set or not. If it's set, it will 1399 * return a if the probe thread was successfully created or not. If the 1400 * variable is not set, it will return if the device is configured 1401 * properly or not. interfaces, in sysfs); else a negative errno value. 1402 * 1403 * This call is synchronous, and may not be used in an interrupt context. 1404 * 1405 * Only the hub driver or root-hub registrar should ever call this. 1406 */ 1407 int usb_new_device(struct usb_device *udev) 1408 { 1409 struct task_struct *probe_task; 1410 int ret = 0; 1411 1412 if (multithread_probe) { 1413 probe_task = kthread_run(__usb_new_device, udev, 1414 "usb-probe-%s", udev->devnum); 1415 if (IS_ERR(probe_task)) 1416 ret = PTR_ERR(probe_task); 1417 } else 1418 ret = __usb_new_device(udev); 1419 1420 return ret; 1421 } 1422 1423 static int hub_port_status(struct usb_hub *hub, int port1, 1424 u16 *status, u16 *change) 1425 { 1426 int ret; 1427 1428 ret = get_port_status(hub->hdev, port1, &hub->status->port); 1429 if (ret < 4) { 1430 dev_err (hub->intfdev, 1431 "%s failed (err = %d)\n", __FUNCTION__, ret); 1432 if (ret >= 0) 1433 ret = -EIO; 1434 } else { 1435 *status = le16_to_cpu(hub->status->port.wPortStatus); 1436 *change = le16_to_cpu(hub->status->port.wPortChange); 1437 ret = 0; 1438 } 1439 return ret; 1440 } 1441 1442 1443 /* Returns 1 if @hub is a WUSB root hub, 0 otherwise */ 1444 static unsigned hub_is_wusb(struct usb_hub *hub) 1445 { 1446 struct usb_hcd *hcd; 1447 if (hub->hdev->parent != NULL) /* not a root hub? */ 1448 return 0; 1449 hcd = container_of(hub->hdev->bus, struct usb_hcd, self); 1450 return hcd->wireless; 1451 } 1452 1453 1454 #define PORT_RESET_TRIES 5 1455 #define SET_ADDRESS_TRIES 2 1456 #define GET_DESCRIPTOR_TRIES 2 1457 #define SET_CONFIG_TRIES (2 * (use_both_schemes + 1)) 1458 #define USE_NEW_SCHEME(i) ((i) / 2 == old_scheme_first) 1459 1460 #define HUB_ROOT_RESET_TIME 50 /* times are in msec */ 1461 #define HUB_SHORT_RESET_TIME 10 1462 #define HUB_LONG_RESET_TIME 200 1463 #define HUB_RESET_TIMEOUT 500 1464 1465 static int hub_port_wait_reset(struct usb_hub *hub, int port1, 1466 struct usb_device *udev, unsigned int delay) 1467 { 1468 int delay_time, ret; 1469 u16 portstatus; 1470 u16 portchange; 1471 1472 for (delay_time = 0; 1473 delay_time < HUB_RESET_TIMEOUT; 1474 delay_time += delay) { 1475 /* wait to give the device a chance to reset */ 1476 msleep(delay); 1477 1478 /* read and decode port status */ 1479 ret = hub_port_status(hub, port1, &portstatus, &portchange); 1480 if (ret < 0) 1481 return ret; 1482 1483 /* Device went away? */ 1484 if (!(portstatus & USB_PORT_STAT_CONNECTION)) 1485 return -ENOTCONN; 1486 1487 /* bomb out completely if something weird happened */ 1488 if ((portchange & USB_PORT_STAT_C_CONNECTION)) 1489 return -EINVAL; 1490 1491 /* if we`ve finished resetting, then break out of the loop */ 1492 if (!(portstatus & USB_PORT_STAT_RESET) && 1493 (portstatus & USB_PORT_STAT_ENABLE)) { 1494 if (hub_is_wusb(hub)) 1495 udev->speed = USB_SPEED_VARIABLE; 1496 else if (portstatus & USB_PORT_STAT_HIGH_SPEED) 1497 udev->speed = USB_SPEED_HIGH; 1498 else if (portstatus & USB_PORT_STAT_LOW_SPEED) 1499 udev->speed = USB_SPEED_LOW; 1500 else 1501 udev->speed = USB_SPEED_FULL; 1502 return 0; 1503 } 1504 1505 /* switch to the long delay after two short delay failures */ 1506 if (delay_time >= 2 * HUB_SHORT_RESET_TIME) 1507 delay = HUB_LONG_RESET_TIME; 1508 1509 dev_dbg (hub->intfdev, 1510 "port %d not reset yet, waiting %dms\n", 1511 port1, delay); 1512 } 1513 1514 return -EBUSY; 1515 } 1516 1517 static int hub_port_reset(struct usb_hub *hub, int port1, 1518 struct usb_device *udev, unsigned int delay) 1519 { 1520 int i, status; 1521 1522 /* Reset the port */ 1523 for (i = 0; i < PORT_RESET_TRIES; i++) { 1524 status = set_port_feature(hub->hdev, 1525 port1, USB_PORT_FEAT_RESET); 1526 if (status) 1527 dev_err(hub->intfdev, 1528 "cannot reset port %d (err = %d)\n", 1529 port1, status); 1530 else { 1531 status = hub_port_wait_reset(hub, port1, udev, delay); 1532 if (status && status != -ENOTCONN) 1533 dev_dbg(hub->intfdev, 1534 "port_wait_reset: err = %d\n", 1535 status); 1536 } 1537 1538 /* return on disconnect or reset */ 1539 switch (status) { 1540 case 0: 1541 /* TRSTRCY = 10 ms; plus some extra */ 1542 msleep(10 + 40); 1543 /* FALL THROUGH */ 1544 case -ENOTCONN: 1545 case -ENODEV: 1546 clear_port_feature(hub->hdev, 1547 port1, USB_PORT_FEAT_C_RESET); 1548 /* FIXME need disconnect() for NOTATTACHED device */ 1549 usb_set_device_state(udev, status 1550 ? USB_STATE_NOTATTACHED 1551 : USB_STATE_DEFAULT); 1552 return status; 1553 } 1554 1555 dev_dbg (hub->intfdev, 1556 "port %d not enabled, trying reset again...\n", 1557 port1); 1558 delay = HUB_LONG_RESET_TIME; 1559 } 1560 1561 dev_err (hub->intfdev, 1562 "Cannot enable port %i. Maybe the USB cable is bad?\n", 1563 port1); 1564 1565 return status; 1566 } 1567 1568 /* 1569 * Disable a port and mark a logical connnect-change event, so that some 1570 * time later khubd will disconnect() any existing usb_device on the port 1571 * and will re-enumerate if there actually is a device attached. 1572 */ 1573 static void hub_port_logical_disconnect(struct usb_hub *hub, int port1) 1574 { 1575 dev_dbg(hub->intfdev, "logical disconnect on port %d\n", port1); 1576 hub_port_disable(hub, port1, 1); 1577 1578 /* FIXME let caller ask to power down the port: 1579 * - some devices won't enumerate without a VBUS power cycle 1580 * - SRP saves power that way 1581 * - ... new call, TBD ... 1582 * That's easy if this hub can switch power per-port, and 1583 * khubd reactivates the port later (timer, SRP, etc). 1584 * Powerdown must be optional, because of reset/DFU. 1585 */ 1586 1587 set_bit(port1, hub->change_bits); 1588 kick_khubd(hub); 1589 } 1590 1591 #ifdef CONFIG_PM 1592 1593 #ifdef CONFIG_USB_SUSPEND 1594 1595 /* 1596 * Selective port suspend reduces power; most suspended devices draw 1597 * less than 500 uA. It's also used in OTG, along with remote wakeup. 1598 * All devices below the suspended port are also suspended. 1599 * 1600 * Devices leave suspend state when the host wakes them up. Some devices 1601 * also support "remote wakeup", where the device can activate the USB 1602 * tree above them to deliver data, such as a keypress or packet. In 1603 * some cases, this wakes the USB host. 1604 */ 1605 static int hub_port_suspend(struct usb_hub *hub, int port1, 1606 struct usb_device *udev) 1607 { 1608 int status; 1609 1610 // dev_dbg(hub->intfdev, "suspend port %d\n", port1); 1611 1612 /* enable remote wakeup when appropriate; this lets the device 1613 * wake up the upstream hub (including maybe the root hub). 1614 * 1615 * NOTE: OTG devices may issue remote wakeup (or SRP) even when 1616 * we don't explicitly enable it here. 1617 */ 1618 if (udev->do_remote_wakeup) { 1619 status = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 1620 USB_REQ_SET_FEATURE, USB_RECIP_DEVICE, 1621 USB_DEVICE_REMOTE_WAKEUP, 0, 1622 NULL, 0, 1623 USB_CTRL_SET_TIMEOUT); 1624 if (status) 1625 dev_dbg(&udev->dev, 1626 "won't remote wakeup, status %d\n", 1627 status); 1628 } 1629 1630 /* see 7.1.7.6 */ 1631 status = set_port_feature(hub->hdev, port1, USB_PORT_FEAT_SUSPEND); 1632 if (status) { 1633 dev_dbg(hub->intfdev, 1634 "can't suspend port %d, status %d\n", 1635 port1, status); 1636 /* paranoia: "should not happen" */ 1637 (void) usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 1638 USB_REQ_CLEAR_FEATURE, USB_RECIP_DEVICE, 1639 USB_DEVICE_REMOTE_WAKEUP, 0, 1640 NULL, 0, 1641 USB_CTRL_SET_TIMEOUT); 1642 } else { 1643 /* device has up to 10 msec to fully suspend */ 1644 dev_dbg(&udev->dev, "usb %ssuspend\n", 1645 udev->auto_pm ? "auto-" : ""); 1646 usb_set_device_state(udev, USB_STATE_SUSPENDED); 1647 msleep(10); 1648 } 1649 return status; 1650 } 1651 1652 /* 1653 * Devices on USB hub ports have only one "suspend" state, corresponding 1654 * to ACPI D2, "may cause the device to lose some context". 1655 * State transitions include: 1656 * 1657 * - suspend, resume ... when the VBUS power link stays live 1658 * - suspend, disconnect ... VBUS lost 1659 * 1660 * Once VBUS drop breaks the circuit, the port it's using has to go through 1661 * normal re-enumeration procedures, starting with enabling VBUS power. 1662 * Other than re-initializing the hub (plug/unplug, except for root hubs), 1663 * Linux (2.6) currently has NO mechanisms to initiate that: no khubd 1664 * timer, no SRP, no requests through sysfs. 1665 * 1666 * If CONFIG_USB_SUSPEND isn't enabled, devices only really suspend when 1667 * the root hub for their bus goes into global suspend ... so we don't 1668 * (falsely) update the device power state to say it suspended. 1669 */ 1670 static int __usb_port_suspend (struct usb_device *udev, int port1) 1671 { 1672 int status = 0; 1673 1674 /* caller owns the udev device lock */ 1675 if (port1 < 0) 1676 return port1; 1677 1678 /* we change the device's upstream USB link, 1679 * but root hubs have no upstream USB link. 1680 */ 1681 if (udev->parent) 1682 status = hub_port_suspend(hdev_to_hub(udev->parent), port1, 1683 udev); 1684 else { 1685 dev_dbg(&udev->dev, "usb %ssuspend\n", 1686 udev->auto_pm ? "auto-" : ""); 1687 usb_set_device_state(udev, USB_STATE_SUSPENDED); 1688 } 1689 return status; 1690 } 1691 1692 /* 1693 * usb_port_suspend - suspend a usb device's upstream port 1694 * @udev: device that's no longer in active use 1695 * Context: must be able to sleep; device not locked; pm locks held 1696 * 1697 * Suspends a USB device that isn't in active use, conserving power. 1698 * Devices may wake out of a suspend, if anything important happens, 1699 * using the remote wakeup mechanism. They may also be taken out of 1700 * suspend by the host, using usb_port_resume(). It's also routine 1701 * to disconnect devices while they are suspended. 1702 * 1703 * This only affects the USB hardware for a device; its interfaces 1704 * (and, for hubs, child devices) must already have been suspended. 1705 * 1706 * Suspending OTG devices may trigger HNP, if that's been enabled 1707 * between a pair of dual-role devices. That will change roles, such 1708 * as from A-Host to A-Peripheral or from B-Host back to B-Peripheral. 1709 * 1710 * Returns 0 on success, else negative errno. 1711 */ 1712 int usb_port_suspend(struct usb_device *udev) 1713 { 1714 return __usb_port_suspend(udev, udev->portnum); 1715 } 1716 1717 /* 1718 * If the USB "suspend" state is in use (rather than "global suspend"), 1719 * many devices will be individually taken out of suspend state using 1720 * special" resume" signaling. These routines kick in shortly after 1721 * hardware resume signaling is finished, either because of selective 1722 * resume (by host) or remote wakeup (by device) ... now see what changed 1723 * in the tree that's rooted at this device. 1724 */ 1725 static int finish_port_resume(struct usb_device *udev) 1726 { 1727 int status; 1728 u16 devstatus; 1729 1730 /* caller owns the udev device lock */ 1731 dev_dbg(&udev->dev, "finish resume\n"); 1732 1733 /* usb ch9 identifies four variants of SUSPENDED, based on what 1734 * state the device resumes to. Linux currently won't see the 1735 * first two on the host side; they'd be inside hub_port_init() 1736 * during many timeouts, but khubd can't suspend until later. 1737 */ 1738 usb_set_device_state(udev, udev->actconfig 1739 ? USB_STATE_CONFIGURED 1740 : USB_STATE_ADDRESS); 1741 1742 /* 10.5.4.5 says be sure devices in the tree are still there. 1743 * For now let's assume the device didn't go crazy on resume, 1744 * and device drivers will know about any resume quirks. 1745 */ 1746 status = usb_get_status(udev, USB_RECIP_DEVICE, 0, &devstatus); 1747 if (status >= 0) 1748 status = (status == 2 ? 0 : -ENODEV); 1749 1750 if (status) 1751 dev_dbg(&udev->dev, 1752 "gone after usb resume? status %d\n", 1753 status); 1754 else if (udev->actconfig) { 1755 le16_to_cpus(&devstatus); 1756 if ((devstatus & (1 << USB_DEVICE_REMOTE_WAKEUP)) 1757 && udev->parent) { 1758 status = usb_control_msg(udev, 1759 usb_sndctrlpipe(udev, 0), 1760 USB_REQ_CLEAR_FEATURE, 1761 USB_RECIP_DEVICE, 1762 USB_DEVICE_REMOTE_WAKEUP, 0, 1763 NULL, 0, 1764 USB_CTRL_SET_TIMEOUT); 1765 if (status) 1766 dev_dbg(&udev->dev, "disable remote " 1767 "wakeup, status %d\n", status); 1768 } 1769 status = 0; 1770 1771 } else if (udev->devnum <= 0) { 1772 dev_dbg(&udev->dev, "bogus resume!\n"); 1773 status = -EINVAL; 1774 } 1775 return status; 1776 } 1777 1778 static int 1779 hub_port_resume(struct usb_hub *hub, int port1, struct usb_device *udev) 1780 { 1781 int status; 1782 u16 portchange, portstatus; 1783 1784 /* Skip the initial Clear-Suspend step for a remote wakeup */ 1785 status = hub_port_status(hub, port1, &portstatus, &portchange); 1786 if (status == 0 && !(portstatus & USB_PORT_STAT_SUSPEND)) 1787 goto SuspendCleared; 1788 1789 // dev_dbg(hub->intfdev, "resume port %d\n", port1); 1790 1791 set_bit(port1, hub->busy_bits); 1792 1793 /* see 7.1.7.7; affects power usage, but not budgeting */ 1794 status = clear_port_feature(hub->hdev, 1795 port1, USB_PORT_FEAT_SUSPEND); 1796 if (status) { 1797 dev_dbg(hub->intfdev, 1798 "can't resume port %d, status %d\n", 1799 port1, status); 1800 } else { 1801 /* drive resume for at least 20 msec */ 1802 if (udev) 1803 dev_dbg(&udev->dev, "usb %sresume\n", 1804 udev->auto_pm ? "auto-" : ""); 1805 msleep(25); 1806 1807 #define LIVE_FLAGS ( USB_PORT_STAT_POWER \ 1808 | USB_PORT_STAT_ENABLE \ 1809 | USB_PORT_STAT_CONNECTION) 1810 1811 /* Virtual root hubs can trigger on GET_PORT_STATUS to 1812 * stop resume signaling. Then finish the resume 1813 * sequence. 1814 */ 1815 status = hub_port_status(hub, port1, &portstatus, &portchange); 1816 SuspendCleared: 1817 if (status < 0 1818 || (portstatus & LIVE_FLAGS) != LIVE_FLAGS 1819 || (portstatus & USB_PORT_STAT_SUSPEND) != 0 1820 ) { 1821 dev_dbg(hub->intfdev, 1822 "port %d status %04x.%04x after resume, %d\n", 1823 port1, portchange, portstatus, status); 1824 if (status >= 0) 1825 status = -ENODEV; 1826 } else { 1827 if (portchange & USB_PORT_STAT_C_SUSPEND) 1828 clear_port_feature(hub->hdev, port1, 1829 USB_PORT_FEAT_C_SUSPEND); 1830 /* TRSMRCY = 10 msec */ 1831 msleep(10); 1832 if (udev) 1833 status = finish_port_resume(udev); 1834 } 1835 } 1836 if (status < 0) 1837 hub_port_logical_disconnect(hub, port1); 1838 1839 clear_bit(port1, hub->busy_bits); 1840 if (!hub->hdev->parent && !hub->busy_bits[0]) 1841 usb_enable_root_hub_irq(hub->hdev->bus); 1842 1843 return status; 1844 } 1845 1846 /* 1847 * usb_port_resume - re-activate a suspended usb device's upstream port 1848 * @udev: device to re-activate 1849 * Context: must be able to sleep; device not locked; pm locks held 1850 * 1851 * This will re-activate the suspended device, increasing power usage 1852 * while letting drivers communicate again with its endpoints. 1853 * USB resume explicitly guarantees that the power session between 1854 * the host and the device is the same as it was when the device 1855 * suspended. 1856 * 1857 * Returns 0 on success, else negative errno. 1858 */ 1859 int usb_port_resume(struct usb_device *udev) 1860 { 1861 int status; 1862 1863 /* we change the device's upstream USB link, 1864 * but root hubs have no upstream USB link. 1865 */ 1866 if (udev->parent) { 1867 // NOTE this fails if parent is also suspended... 1868 status = hub_port_resume(hdev_to_hub(udev->parent), 1869 udev->portnum, udev); 1870 } else { 1871 dev_dbg(&udev->dev, "usb %sresume\n", 1872 udev->auto_pm ? "auto-" : ""); 1873 status = finish_port_resume(udev); 1874 } 1875 if (status < 0) 1876 dev_dbg(&udev->dev, "can't resume, status %d\n", status); 1877 return status; 1878 } 1879 1880 static int remote_wakeup(struct usb_device *udev) 1881 { 1882 int status = 0; 1883 1884 usb_lock_device(udev); 1885 if (udev->state == USB_STATE_SUSPENDED) { 1886 dev_dbg(&udev->dev, "usb %sresume\n", "wakeup-"); 1887 status = usb_autoresume_device(udev); 1888 1889 /* Give the interface drivers a chance to do something, 1890 * then autosuspend the device again. */ 1891 if (status == 0) 1892 usb_autosuspend_device(udev); 1893 } 1894 usb_unlock_device(udev); 1895 return status; 1896 } 1897 1898 #else /* CONFIG_USB_SUSPEND */ 1899 1900 /* When CONFIG_USB_SUSPEND isn't set, we never suspend or resume any ports. */ 1901 1902 int usb_port_suspend(struct usb_device *udev) 1903 { 1904 return 0; 1905 } 1906 1907 static inline int 1908 finish_port_resume(struct usb_device *udev) 1909 { 1910 return 0; 1911 } 1912 1913 static inline int 1914 hub_port_resume(struct usb_hub *hub, int port1, struct usb_device *udev) 1915 { 1916 return 0; 1917 } 1918 1919 int usb_port_resume(struct usb_device *udev) 1920 { 1921 return 0; 1922 } 1923 1924 static inline int remote_wakeup(struct usb_device *udev) 1925 { 1926 return 0; 1927 } 1928 1929 #endif 1930 1931 static int hub_suspend(struct usb_interface *intf, pm_message_t msg) 1932 { 1933 struct usb_hub *hub = usb_get_intfdata (intf); 1934 struct usb_device *hdev = hub->hdev; 1935 unsigned port1; 1936 1937 /* fail if children aren't already suspended */ 1938 for (port1 = 1; port1 <= hdev->maxchild; port1++) { 1939 struct usb_device *udev; 1940 1941 udev = hdev->children [port1-1]; 1942 if (udev && msg.event == PM_EVENT_SUSPEND && 1943 #ifdef CONFIG_USB_SUSPEND 1944 udev->state != USB_STATE_SUSPENDED 1945 #else 1946 udev->dev.power.power_state.event 1947 == PM_EVENT_ON 1948 #endif 1949 ) { 1950 if (!hdev->auto_pm) 1951 dev_dbg(&intf->dev, "port %d nyet suspended\n", 1952 port1); 1953 return -EBUSY; 1954 } 1955 } 1956 1957 dev_dbg(&intf->dev, "%s\n", __FUNCTION__); 1958 1959 /* "global suspend" of the downstream HC-to-USB interface */ 1960 if (!hdev->parent) { 1961 struct usb_bus *bus = hdev->bus; 1962 if (bus) { 1963 int status = hcd_bus_suspend (bus); 1964 1965 if (status != 0) { 1966 dev_dbg(&hdev->dev, "'global' suspend %d\n", 1967 status); 1968 return status; 1969 } 1970 } else 1971 return -EOPNOTSUPP; 1972 } 1973 1974 /* stop khubd and related activity */ 1975 hub_quiesce(hub); 1976 return 0; 1977 } 1978 1979 static int hub_resume(struct usb_interface *intf) 1980 { 1981 struct usb_hub *hub = usb_get_intfdata (intf); 1982 struct usb_device *hdev = hub->hdev; 1983 int status; 1984 1985 dev_dbg(&intf->dev, "%s\n", __FUNCTION__); 1986 1987 /* "global resume" of the downstream HC-to-USB interface */ 1988 if (!hdev->parent) { 1989 struct usb_bus *bus = hdev->bus; 1990 if (bus) { 1991 status = hcd_bus_resume (bus); 1992 if (status) { 1993 dev_dbg(&intf->dev, "'global' resume %d\n", 1994 status); 1995 return status; 1996 } 1997 } else 1998 return -EOPNOTSUPP; 1999 if (status == 0) { 2000 /* TRSMRCY = 10 msec */ 2001 msleep(10); 2002 } 2003 } 2004 2005 /* tell khubd to look for changes on this hub */ 2006 hub_activate(hub); 2007 return 0; 2008 } 2009 2010 #else /* CONFIG_PM */ 2011 2012 static inline int remote_wakeup(struct usb_device *udev) 2013 { 2014 return 0; 2015 } 2016 2017 #define hub_suspend NULL 2018 #define hub_resume NULL 2019 #endif 2020 2021 void usb_resume_root_hub(struct usb_device *hdev) 2022 { 2023 struct usb_hub *hub = hdev_to_hub(hdev); 2024 2025 kick_khubd(hub); 2026 } 2027 2028 2029 /* USB 2.0 spec, 7.1.7.3 / fig 7-29: 2030 * 2031 * Between connect detection and reset signaling there must be a delay 2032 * of 100ms at least for debounce and power-settling. The corresponding 2033 * timer shall restart whenever the downstream port detects a disconnect. 2034 * 2035 * Apparently there are some bluetooth and irda-dongles and a number of 2036 * low-speed devices for which this debounce period may last over a second. 2037 * Not covered by the spec - but easy to deal with. 2038 * 2039 * This implementation uses a 1500ms total debounce timeout; if the 2040 * connection isn't stable by then it returns -ETIMEDOUT. It checks 2041 * every 25ms for transient disconnects. When the port status has been 2042 * unchanged for 100ms it returns the port status. 2043 */ 2044 2045 #define HUB_DEBOUNCE_TIMEOUT 1500 2046 #define HUB_DEBOUNCE_STEP 25 2047 #define HUB_DEBOUNCE_STABLE 100 2048 2049 static int hub_port_debounce(struct usb_hub *hub, int port1) 2050 { 2051 int ret; 2052 int total_time, stable_time = 0; 2053 u16 portchange, portstatus; 2054 unsigned connection = 0xffff; 2055 2056 for (total_time = 0; ; total_time += HUB_DEBOUNCE_STEP) { 2057 ret = hub_port_status(hub, port1, &portstatus, &portchange); 2058 if (ret < 0) 2059 return ret; 2060 2061 if (!(portchange & USB_PORT_STAT_C_CONNECTION) && 2062 (portstatus & USB_PORT_STAT_CONNECTION) == connection) { 2063 stable_time += HUB_DEBOUNCE_STEP; 2064 if (stable_time >= HUB_DEBOUNCE_STABLE) 2065 break; 2066 } else { 2067 stable_time = 0; 2068 connection = portstatus & USB_PORT_STAT_CONNECTION; 2069 } 2070 2071 if (portchange & USB_PORT_STAT_C_CONNECTION) { 2072 clear_port_feature(hub->hdev, port1, 2073 USB_PORT_FEAT_C_CONNECTION); 2074 } 2075 2076 if (total_time >= HUB_DEBOUNCE_TIMEOUT) 2077 break; 2078 msleep(HUB_DEBOUNCE_STEP); 2079 } 2080 2081 dev_dbg (hub->intfdev, 2082 "debounce: port %d: total %dms stable %dms status 0x%x\n", 2083 port1, total_time, stable_time, portstatus); 2084 2085 if (stable_time < HUB_DEBOUNCE_STABLE) 2086 return -ETIMEDOUT; 2087 return portstatus; 2088 } 2089 2090 static void ep0_reinit(struct usb_device *udev) 2091 { 2092 usb_disable_endpoint(udev, 0 + USB_DIR_IN); 2093 usb_disable_endpoint(udev, 0 + USB_DIR_OUT); 2094 udev->ep_in[0] = udev->ep_out[0] = &udev->ep0; 2095 } 2096 2097 #define usb_sndaddr0pipe() (PIPE_CONTROL << 30) 2098 #define usb_rcvaddr0pipe() ((PIPE_CONTROL << 30) | USB_DIR_IN) 2099 2100 static int hub_set_address(struct usb_device *udev) 2101 { 2102 int retval; 2103 2104 if (udev->devnum == 0) 2105 return -EINVAL; 2106 if (udev->state == USB_STATE_ADDRESS) 2107 return 0; 2108 if (udev->state != USB_STATE_DEFAULT) 2109 return -EINVAL; 2110 retval = usb_control_msg(udev, usb_sndaddr0pipe(), 2111 USB_REQ_SET_ADDRESS, 0, udev->devnum, 0, 2112 NULL, 0, USB_CTRL_SET_TIMEOUT); 2113 if (retval == 0) { 2114 usb_set_device_state(udev, USB_STATE_ADDRESS); 2115 ep0_reinit(udev); 2116 } 2117 return retval; 2118 } 2119 2120 /* Reset device, (re)assign address, get device descriptor. 2121 * Device connection must be stable, no more debouncing needed. 2122 * Returns device in USB_STATE_ADDRESS, except on error. 2123 * 2124 * If this is called for an already-existing device (as part of 2125 * usb_reset_device), the caller must own the device lock. For a 2126 * newly detected device that is not accessible through any global 2127 * pointers, it's not necessary to lock the device. 2128 */ 2129 static int 2130 hub_port_init (struct usb_hub *hub, struct usb_device *udev, int port1, 2131 int retry_counter) 2132 { 2133 static DEFINE_MUTEX(usb_address0_mutex); 2134 2135 struct usb_device *hdev = hub->hdev; 2136 int i, j, retval; 2137 unsigned delay = HUB_SHORT_RESET_TIME; 2138 enum usb_device_speed oldspeed = udev->speed; 2139 char *speed, *type; 2140 2141 /* root hub ports have a slightly longer reset period 2142 * (from USB 2.0 spec, section 7.1.7.5) 2143 */ 2144 if (!hdev->parent) { 2145 delay = HUB_ROOT_RESET_TIME; 2146 if (port1 == hdev->bus->otg_port) 2147 hdev->bus->b_hnp_enable = 0; 2148 } 2149 2150 /* Some low speed devices have problems with the quick delay, so */ 2151 /* be a bit pessimistic with those devices. RHbug #23670 */ 2152 if (oldspeed == USB_SPEED_LOW) 2153 delay = HUB_LONG_RESET_TIME; 2154 2155 mutex_lock(&usb_address0_mutex); 2156 2157 /* Reset the device; full speed may morph to high speed */ 2158 retval = hub_port_reset(hub, port1, udev, delay); 2159 if (retval < 0) /* error or disconnect */ 2160 goto fail; 2161 /* success, speed is known */ 2162 retval = -ENODEV; 2163 2164 if (oldspeed != USB_SPEED_UNKNOWN && oldspeed != udev->speed) { 2165 dev_dbg(&udev->dev, "device reset changed speed!\n"); 2166 goto fail; 2167 } 2168 oldspeed = udev->speed; 2169 2170 /* USB 2.0 section 5.5.3 talks about ep0 maxpacket ... 2171 * it's fixed size except for full speed devices. 2172 * For Wireless USB devices, ep0 max packet is always 512 (tho 2173 * reported as 0xff in the device descriptor). WUSB1.0[4.8.1]. 2174 */ 2175 switch (udev->speed) { 2176 case USB_SPEED_VARIABLE: /* fixed at 512 */ 2177 udev->ep0.desc.wMaxPacketSize = __constant_cpu_to_le16(512); 2178 break; 2179 case USB_SPEED_HIGH: /* fixed at 64 */ 2180 udev->ep0.desc.wMaxPacketSize = __constant_cpu_to_le16(64); 2181 break; 2182 case USB_SPEED_FULL: /* 8, 16, 32, or 64 */ 2183 /* to determine the ep0 maxpacket size, try to read 2184 * the device descriptor to get bMaxPacketSize0 and 2185 * then correct our initial guess. 2186 */ 2187 udev->ep0.desc.wMaxPacketSize = __constant_cpu_to_le16(64); 2188 break; 2189 case USB_SPEED_LOW: /* fixed at 8 */ 2190 udev->ep0.desc.wMaxPacketSize = __constant_cpu_to_le16(8); 2191 break; 2192 default: 2193 goto fail; 2194 } 2195 2196 type = ""; 2197 switch (udev->speed) { 2198 case USB_SPEED_LOW: speed = "low"; break; 2199 case USB_SPEED_FULL: speed = "full"; break; 2200 case USB_SPEED_HIGH: speed = "high"; break; 2201 case USB_SPEED_VARIABLE: 2202 speed = "variable"; 2203 type = "Wireless "; 2204 break; 2205 default: speed = "?"; break; 2206 } 2207 dev_info (&udev->dev, 2208 "%s %s speed %sUSB device using %s and address %d\n", 2209 (udev->config) ? "reset" : "new", speed, type, 2210 udev->bus->controller->driver->name, udev->devnum); 2211 2212 /* Set up TT records, if needed */ 2213 if (hdev->tt) { 2214 udev->tt = hdev->tt; 2215 udev->ttport = hdev->ttport; 2216 } else if (udev->speed != USB_SPEED_HIGH 2217 && hdev->speed == USB_SPEED_HIGH) { 2218 udev->tt = &hub->tt; 2219 udev->ttport = port1; 2220 } 2221 2222 /* Why interleave GET_DESCRIPTOR and SET_ADDRESS this way? 2223 * Because device hardware and firmware is sometimes buggy in 2224 * this area, and this is how Linux has done it for ages. 2225 * Change it cautiously. 2226 * 2227 * NOTE: If USE_NEW_SCHEME() is true we will start by issuing 2228 * a 64-byte GET_DESCRIPTOR request. This is what Windows does, 2229 * so it may help with some non-standards-compliant devices. 2230 * Otherwise we start with SET_ADDRESS and then try to read the 2231 * first 8 bytes of the device descriptor to get the ep0 maxpacket 2232 * value. 2233 */ 2234 for (i = 0; i < GET_DESCRIPTOR_TRIES; (++i, msleep(100))) { 2235 if (USE_NEW_SCHEME(retry_counter)) { 2236 struct usb_device_descriptor *buf; 2237 int r = 0; 2238 2239 #define GET_DESCRIPTOR_BUFSIZE 64 2240 buf = kmalloc(GET_DESCRIPTOR_BUFSIZE, GFP_NOIO); 2241 if (!buf) { 2242 retval = -ENOMEM; 2243 continue; 2244 } 2245 2246 /* Use a short timeout the first time through, 2247 * so that recalcitrant full-speed devices with 2248 * 8- or 16-byte ep0-maxpackets won't slow things 2249 * down tremendously by NAKing the unexpectedly 2250 * early status stage. Also, retry on all errors; 2251 * some devices are flakey. 2252 * 255 is for WUSB devices, we actually need to use 512. 2253 * WUSB1.0[4.8.1]. 2254 */ 2255 for (j = 0; j < 3; ++j) { 2256 buf->bMaxPacketSize0 = 0; 2257 r = usb_control_msg(udev, usb_rcvaddr0pipe(), 2258 USB_REQ_GET_DESCRIPTOR, USB_DIR_IN, 2259 USB_DT_DEVICE << 8, 0, 2260 buf, GET_DESCRIPTOR_BUFSIZE, 2261 (i ? USB_CTRL_GET_TIMEOUT : 1000)); 2262 switch (buf->bMaxPacketSize0) { 2263 case 8: case 16: case 32: case 64: case 255: 2264 if (buf->bDescriptorType == 2265 USB_DT_DEVICE) { 2266 r = 0; 2267 break; 2268 } 2269 /* FALL THROUGH */ 2270 default: 2271 if (r == 0) 2272 r = -EPROTO; 2273 break; 2274 } 2275 if (r == 0) 2276 break; 2277 } 2278 udev->descriptor.bMaxPacketSize0 = 2279 buf->bMaxPacketSize0; 2280 kfree(buf); 2281 2282 retval = hub_port_reset(hub, port1, udev, delay); 2283 if (retval < 0) /* error or disconnect */ 2284 goto fail; 2285 if (oldspeed != udev->speed) { 2286 dev_dbg(&udev->dev, 2287 "device reset changed speed!\n"); 2288 retval = -ENODEV; 2289 goto fail; 2290 } 2291 if (r) { 2292 dev_err(&udev->dev, "device descriptor " 2293 "read/%s, error %d\n", 2294 "64", r); 2295 retval = -EMSGSIZE; 2296 continue; 2297 } 2298 #undef GET_DESCRIPTOR_BUFSIZE 2299 } 2300 2301 for (j = 0; j < SET_ADDRESS_TRIES; ++j) { 2302 retval = hub_set_address(udev); 2303 if (retval >= 0) 2304 break; 2305 msleep(200); 2306 } 2307 if (retval < 0) { 2308 dev_err(&udev->dev, 2309 "device not accepting address %d, error %d\n", 2310 udev->devnum, retval); 2311 goto fail; 2312 } 2313 2314 /* cope with hardware quirkiness: 2315 * - let SET_ADDRESS settle, some device hardware wants it 2316 * - read ep0 maxpacket even for high and low speed, 2317 */ 2318 msleep(10); 2319 if (USE_NEW_SCHEME(retry_counter)) 2320 break; 2321 2322 retval = usb_get_device_descriptor(udev, 8); 2323 if (retval < 8) { 2324 dev_err(&udev->dev, "device descriptor " 2325 "read/%s, error %d\n", 2326 "8", retval); 2327 if (retval >= 0) 2328 retval = -EMSGSIZE; 2329 } else { 2330 retval = 0; 2331 break; 2332 } 2333 } 2334 if (retval) 2335 goto fail; 2336 2337 i = udev->descriptor.bMaxPacketSize0 == 0xff? 2338 512 : udev->descriptor.bMaxPacketSize0; 2339 if (le16_to_cpu(udev->ep0.desc.wMaxPacketSize) != i) { 2340 if (udev->speed != USB_SPEED_FULL || 2341 !(i == 8 || i == 16 || i == 32 || i == 64)) { 2342 dev_err(&udev->dev, "ep0 maxpacket = %d\n", i); 2343 retval = -EMSGSIZE; 2344 goto fail; 2345 } 2346 dev_dbg(&udev->dev, "ep0 maxpacket = %d\n", i); 2347 udev->ep0.desc.wMaxPacketSize = cpu_to_le16(i); 2348 ep0_reinit(udev); 2349 } 2350 2351 retval = usb_get_device_descriptor(udev, USB_DT_DEVICE_SIZE); 2352 if (retval < (signed)sizeof(udev->descriptor)) { 2353 dev_err(&udev->dev, "device descriptor read/%s, error %d\n", 2354 "all", retval); 2355 if (retval >= 0) 2356 retval = -ENOMSG; 2357 goto fail; 2358 } 2359 2360 retval = 0; 2361 2362 fail: 2363 if (retval) 2364 hub_port_disable(hub, port1, 0); 2365 mutex_unlock(&usb_address0_mutex); 2366 return retval; 2367 } 2368 2369 static void 2370 check_highspeed (struct usb_hub *hub, struct usb_device *udev, int port1) 2371 { 2372 struct usb_qualifier_descriptor *qual; 2373 int status; 2374 2375 qual = kmalloc (sizeof *qual, GFP_KERNEL); 2376 if (qual == NULL) 2377 return; 2378 2379 status = usb_get_descriptor (udev, USB_DT_DEVICE_QUALIFIER, 0, 2380 qual, sizeof *qual); 2381 if (status == sizeof *qual) { 2382 dev_info(&udev->dev, "not running at top speed; " 2383 "connect to a high speed hub\n"); 2384 /* hub LEDs are probably harder to miss than syslog */ 2385 if (hub->has_indicators) { 2386 hub->indicator[port1-1] = INDICATOR_GREEN_BLINK; 2387 schedule_delayed_work (&hub->leds, 0); 2388 } 2389 } 2390 kfree(qual); 2391 } 2392 2393 static unsigned 2394 hub_power_remaining (struct usb_hub *hub) 2395 { 2396 struct usb_device *hdev = hub->hdev; 2397 int remaining; 2398 int port1; 2399 2400 if (!hub->limited_power) 2401 return 0; 2402 2403 remaining = hdev->bus_mA - hub->descriptor->bHubContrCurrent; 2404 for (port1 = 1; port1 <= hdev->maxchild; ++port1) { 2405 struct usb_device *udev = hdev->children[port1 - 1]; 2406 int delta; 2407 2408 if (!udev) 2409 continue; 2410 2411 /* Unconfigured devices may not use more than 100mA, 2412 * or 8mA for OTG ports */ 2413 if (udev->actconfig) 2414 delta = udev->actconfig->desc.bMaxPower * 2; 2415 else if (port1 != udev->bus->otg_port || hdev->parent) 2416 delta = 100; 2417 else 2418 delta = 8; 2419 if (delta > hub->mA_per_port) 2420 dev_warn(&udev->dev, "%dmA is over %umA budget " 2421 "for port %d!\n", 2422 delta, hub->mA_per_port, port1); 2423 remaining -= delta; 2424 } 2425 if (remaining < 0) { 2426 dev_warn(hub->intfdev, "%dmA over power budget!\n", 2427 - remaining); 2428 remaining = 0; 2429 } 2430 return remaining; 2431 } 2432 2433 /* Handle physical or logical connection change events. 2434 * This routine is called when: 2435 * a port connection-change occurs; 2436 * a port enable-change occurs (often caused by EMI); 2437 * usb_reset_device() encounters changed descriptors (as from 2438 * a firmware download) 2439 * caller already locked the hub 2440 */ 2441 static void hub_port_connect_change(struct usb_hub *hub, int port1, 2442 u16 portstatus, u16 portchange) 2443 { 2444 struct usb_device *hdev = hub->hdev; 2445 struct device *hub_dev = hub->intfdev; 2446 u16 wHubCharacteristics = le16_to_cpu(hub->descriptor->wHubCharacteristics); 2447 int status, i; 2448 2449 dev_dbg (hub_dev, 2450 "port %d, status %04x, change %04x, %s\n", 2451 port1, portstatus, portchange, portspeed (portstatus)); 2452 2453 if (hub->has_indicators) { 2454 set_port_led(hub, port1, HUB_LED_AUTO); 2455 hub->indicator[port1-1] = INDICATOR_AUTO; 2456 } 2457 2458 /* Disconnect any existing devices under this port */ 2459 if (hdev->children[port1-1]) 2460 usb_disconnect(&hdev->children[port1-1]); 2461 clear_bit(port1, hub->change_bits); 2462 2463 #ifdef CONFIG_USB_OTG 2464 /* during HNP, don't repeat the debounce */ 2465 if (hdev->bus->is_b_host) 2466 portchange &= ~USB_PORT_STAT_C_CONNECTION; 2467 #endif 2468 2469 if (portchange & USB_PORT_STAT_C_CONNECTION) { 2470 status = hub_port_debounce(hub, port1); 2471 if (status < 0) { 2472 dev_err (hub_dev, 2473 "connect-debounce failed, port %d disabled\n", 2474 port1); 2475 goto done; 2476 } 2477 portstatus = status; 2478 } 2479 2480 /* Return now if nothing is connected */ 2481 if (!(portstatus & USB_PORT_STAT_CONNECTION)) { 2482 2483 /* maybe switch power back on (e.g. root hub was reset) */ 2484 if ((wHubCharacteristics & HUB_CHAR_LPSM) < 2 2485 && !(portstatus & (1 << USB_PORT_FEAT_POWER))) 2486 set_port_feature(hdev, port1, USB_PORT_FEAT_POWER); 2487 2488 if (portstatus & USB_PORT_STAT_ENABLE) 2489 goto done; 2490 return; 2491 } 2492 2493 #ifdef CONFIG_USB_SUSPEND 2494 /* If something is connected, but the port is suspended, wake it up. */ 2495 if (portstatus & USB_PORT_STAT_SUSPEND) { 2496 status = hub_port_resume(hub, port1, NULL); 2497 if (status < 0) { 2498 dev_dbg(hub_dev, 2499 "can't clear suspend on port %d; %d\n", 2500 port1, status); 2501 goto done; 2502 } 2503 } 2504 #endif 2505 2506 for (i = 0; i < SET_CONFIG_TRIES; i++) { 2507 struct usb_device *udev; 2508 2509 /* reallocate for each attempt, since references 2510 * to the previous one can escape in various ways 2511 */ 2512 udev = usb_alloc_dev(hdev, hdev->bus, port1); 2513 if (!udev) { 2514 dev_err (hub_dev, 2515 "couldn't allocate port %d usb_device\n", 2516 port1); 2517 goto done; 2518 } 2519 2520 usb_set_device_state(udev, USB_STATE_POWERED); 2521 udev->speed = USB_SPEED_UNKNOWN; 2522 udev->bus_mA = hub->mA_per_port; 2523 udev->level = hdev->level + 1; 2524 2525 /* set the address */ 2526 choose_address(udev); 2527 if (udev->devnum <= 0) { 2528 status = -ENOTCONN; /* Don't retry */ 2529 goto loop; 2530 } 2531 2532 /* reset and get descriptor */ 2533 status = hub_port_init(hub, udev, port1, i); 2534 if (status < 0) 2535 goto loop; 2536 2537 /* consecutive bus-powered hubs aren't reliable; they can 2538 * violate the voltage drop budget. if the new child has 2539 * a "powered" LED, users should notice we didn't enable it 2540 * (without reading syslog), even without per-port LEDs 2541 * on the parent. 2542 */ 2543 if (udev->descriptor.bDeviceClass == USB_CLASS_HUB 2544 && udev->bus_mA <= 100) { 2545 u16 devstat; 2546 2547 status = usb_get_status(udev, USB_RECIP_DEVICE, 0, 2548 &devstat); 2549 if (status < 2) { 2550 dev_dbg(&udev->dev, "get status %d ?\n", status); 2551 goto loop_disable; 2552 } 2553 le16_to_cpus(&devstat); 2554 if ((devstat & (1 << USB_DEVICE_SELF_POWERED)) == 0) { 2555 dev_err(&udev->dev, 2556 "can't connect bus-powered hub " 2557 "to this port\n"); 2558 if (hub->has_indicators) { 2559 hub->indicator[port1-1] = 2560 INDICATOR_AMBER_BLINK; 2561 schedule_delayed_work (&hub->leds, 0); 2562 } 2563 status = -ENOTCONN; /* Don't retry */ 2564 goto loop_disable; 2565 } 2566 } 2567 2568 /* check for devices running slower than they could */ 2569 if (le16_to_cpu(udev->descriptor.bcdUSB) >= 0x0200 2570 && udev->speed == USB_SPEED_FULL 2571 && highspeed_hubs != 0) 2572 check_highspeed (hub, udev, port1); 2573 2574 /* Store the parent's children[] pointer. At this point 2575 * udev becomes globally accessible, although presumably 2576 * no one will look at it until hdev is unlocked. 2577 */ 2578 status = 0; 2579 2580 /* We mustn't add new devices if the parent hub has 2581 * been disconnected; we would race with the 2582 * recursively_mark_NOTATTACHED() routine. 2583 */ 2584 spin_lock_irq(&device_state_lock); 2585 if (hdev->state == USB_STATE_NOTATTACHED) 2586 status = -ENOTCONN; 2587 else 2588 hdev->children[port1-1] = udev; 2589 spin_unlock_irq(&device_state_lock); 2590 2591 /* Run it through the hoops (find a driver, etc) */ 2592 if (!status) { 2593 status = usb_new_device(udev); 2594 if (status) { 2595 spin_lock_irq(&device_state_lock); 2596 hdev->children[port1-1] = NULL; 2597 spin_unlock_irq(&device_state_lock); 2598 } 2599 } 2600 2601 if (status) 2602 goto loop_disable; 2603 2604 status = hub_power_remaining(hub); 2605 if (status) 2606 dev_dbg(hub_dev, "%dmA power budget left\n", status); 2607 2608 return; 2609 2610 loop_disable: 2611 hub_port_disable(hub, port1, 1); 2612 loop: 2613 ep0_reinit(udev); 2614 release_address(udev); 2615 usb_put_dev(udev); 2616 if (status == -ENOTCONN) 2617 break; 2618 } 2619 2620 done: 2621 hub_port_disable(hub, port1, 1); 2622 } 2623 2624 static void hub_events(void) 2625 { 2626 struct list_head *tmp; 2627 struct usb_device *hdev; 2628 struct usb_interface *intf; 2629 struct usb_hub *hub; 2630 struct device *hub_dev; 2631 u16 hubstatus; 2632 u16 hubchange; 2633 u16 portstatus; 2634 u16 portchange; 2635 int i, ret; 2636 int connect_change; 2637 2638 /* 2639 * We restart the list every time to avoid a deadlock with 2640 * deleting hubs downstream from this one. This should be 2641 * safe since we delete the hub from the event list. 2642 * Not the most efficient, but avoids deadlocks. 2643 */ 2644 while (1) { 2645 2646 /* Grab the first entry at the beginning of the list */ 2647 spin_lock_irq(&hub_event_lock); 2648 if (list_empty(&hub_event_list)) { 2649 spin_unlock_irq(&hub_event_lock); 2650 break; 2651 } 2652 2653 tmp = hub_event_list.next; 2654 list_del_init(tmp); 2655 2656 hub = list_entry(tmp, struct usb_hub, event_list); 2657 hdev = hub->hdev; 2658 intf = to_usb_interface(hub->intfdev); 2659 hub_dev = &intf->dev; 2660 2661 dev_dbg(hub_dev, "state %d ports %d chg %04x evt %04x\n", 2662 hdev->state, hub->descriptor 2663 ? hub->descriptor->bNbrPorts 2664 : 0, 2665 /* NOTE: expects max 15 ports... */ 2666 (u16) hub->change_bits[0], 2667 (u16) hub->event_bits[0]); 2668 2669 usb_get_intf(intf); 2670 spin_unlock_irq(&hub_event_lock); 2671 2672 /* Lock the device, then check to see if we were 2673 * disconnected while waiting for the lock to succeed. */ 2674 if (locktree(hdev) < 0) { 2675 usb_put_intf(intf); 2676 continue; 2677 } 2678 if (hub != usb_get_intfdata(intf)) 2679 goto loop; 2680 2681 /* If the hub has died, clean up after it */ 2682 if (hdev->state == USB_STATE_NOTATTACHED) { 2683 hub->error = -ENODEV; 2684 hub_pre_reset(intf); 2685 goto loop; 2686 } 2687 2688 /* Autoresume */ 2689 ret = usb_autopm_get_interface(intf); 2690 if (ret) { 2691 dev_dbg(hub_dev, "Can't autoresume: %d\n", ret); 2692 goto loop; 2693 } 2694 2695 /* If this is an inactive hub, do nothing */ 2696 if (hub->quiescing) 2697 goto loop_autopm; 2698 2699 if (hub->error) { 2700 dev_dbg (hub_dev, "resetting for error %d\n", 2701 hub->error); 2702 2703 ret = usb_reset_composite_device(hdev, intf); 2704 if (ret) { 2705 dev_dbg (hub_dev, 2706 "error resetting hub: %d\n", ret); 2707 goto loop_autopm; 2708 } 2709 2710 hub->nerrors = 0; 2711 hub->error = 0; 2712 } 2713 2714 /* deal with port status changes */ 2715 for (i = 1; i <= hub->descriptor->bNbrPorts; i++) { 2716 if (test_bit(i, hub->busy_bits)) 2717 continue; 2718 connect_change = test_bit(i, hub->change_bits); 2719 if (!test_and_clear_bit(i, hub->event_bits) && 2720 !connect_change && !hub->activating) 2721 continue; 2722 2723 ret = hub_port_status(hub, i, 2724 &portstatus, &portchange); 2725 if (ret < 0) 2726 continue; 2727 2728 if (hub->activating && !hdev->children[i-1] && 2729 (portstatus & 2730 USB_PORT_STAT_CONNECTION)) 2731 connect_change = 1; 2732 2733 if (portchange & USB_PORT_STAT_C_CONNECTION) { 2734 clear_port_feature(hdev, i, 2735 USB_PORT_FEAT_C_CONNECTION); 2736 connect_change = 1; 2737 } 2738 2739 if (portchange & USB_PORT_STAT_C_ENABLE) { 2740 if (!connect_change) 2741 dev_dbg (hub_dev, 2742 "port %d enable change, " 2743 "status %08x\n", 2744 i, portstatus); 2745 clear_port_feature(hdev, i, 2746 USB_PORT_FEAT_C_ENABLE); 2747 2748 /* 2749 * EM interference sometimes causes badly 2750 * shielded USB devices to be shutdown by 2751 * the hub, this hack enables them again. 2752 * Works at least with mouse driver. 2753 */ 2754 if (!(portstatus & USB_PORT_STAT_ENABLE) 2755 && !connect_change 2756 && hdev->children[i-1]) { 2757 dev_err (hub_dev, 2758 "port %i " 2759 "disabled by hub (EMI?), " 2760 "re-enabling...\n", 2761 i); 2762 connect_change = 1; 2763 } 2764 } 2765 2766 if (portchange & USB_PORT_STAT_C_SUSPEND) { 2767 clear_port_feature(hdev, i, 2768 USB_PORT_FEAT_C_SUSPEND); 2769 if (hdev->children[i-1]) { 2770 ret = remote_wakeup(hdev-> 2771 children[i-1]); 2772 if (ret < 0) 2773 connect_change = 1; 2774 } else { 2775 ret = -ENODEV; 2776 hub_port_disable(hub, i, 1); 2777 } 2778 dev_dbg (hub_dev, 2779 "resume on port %d, status %d\n", 2780 i, ret); 2781 } 2782 2783 if (portchange & USB_PORT_STAT_C_OVERCURRENT) { 2784 dev_err (hub_dev, 2785 "over-current change on port %d\n", 2786 i); 2787 clear_port_feature(hdev, i, 2788 USB_PORT_FEAT_C_OVER_CURRENT); 2789 hub_power_on(hub); 2790 } 2791 2792 if (portchange & USB_PORT_STAT_C_RESET) { 2793 dev_dbg (hub_dev, 2794 "reset change on port %d\n", 2795 i); 2796 clear_port_feature(hdev, i, 2797 USB_PORT_FEAT_C_RESET); 2798 } 2799 2800 if (connect_change) 2801 hub_port_connect_change(hub, i, 2802 portstatus, portchange); 2803 } /* end for i */ 2804 2805 /* deal with hub status changes */ 2806 if (test_and_clear_bit(0, hub->event_bits) == 0) 2807 ; /* do nothing */ 2808 else if (hub_hub_status(hub, &hubstatus, &hubchange) < 0) 2809 dev_err (hub_dev, "get_hub_status failed\n"); 2810 else { 2811 if (hubchange & HUB_CHANGE_LOCAL_POWER) { 2812 dev_dbg (hub_dev, "power change\n"); 2813 clear_hub_feature(hdev, C_HUB_LOCAL_POWER); 2814 if (hubstatus & HUB_STATUS_LOCAL_POWER) 2815 /* FIXME: Is this always true? */ 2816 hub->limited_power = 0; 2817 else 2818 hub->limited_power = 1; 2819 } 2820 if (hubchange & HUB_CHANGE_OVERCURRENT) { 2821 dev_dbg (hub_dev, "overcurrent change\n"); 2822 msleep(500); /* Cool down */ 2823 clear_hub_feature(hdev, C_HUB_OVER_CURRENT); 2824 hub_power_on(hub); 2825 } 2826 } 2827 2828 hub->activating = 0; 2829 2830 /* If this is a root hub, tell the HCD it's okay to 2831 * re-enable port-change interrupts now. */ 2832 if (!hdev->parent && !hub->busy_bits[0]) 2833 usb_enable_root_hub_irq(hdev->bus); 2834 2835 loop_autopm: 2836 /* Allow autosuspend if we're not going to run again */ 2837 if (list_empty(&hub->event_list)) 2838 usb_autopm_enable(intf); 2839 loop: 2840 usb_unlock_device(hdev); 2841 usb_put_intf(intf); 2842 2843 } /* end while (1) */ 2844 } 2845 2846 static int hub_thread(void *__unused) 2847 { 2848 do { 2849 hub_events(); 2850 wait_event_interruptible(khubd_wait, 2851 !list_empty(&hub_event_list) || 2852 kthread_should_stop()); 2853 try_to_freeze(); 2854 } while (!kthread_should_stop() || !list_empty(&hub_event_list)); 2855 2856 pr_debug("%s: khubd exiting\n", usbcore_name); 2857 return 0; 2858 } 2859 2860 static struct usb_device_id hub_id_table [] = { 2861 { .match_flags = USB_DEVICE_ID_MATCH_DEV_CLASS, 2862 .bDeviceClass = USB_CLASS_HUB}, 2863 { .match_flags = USB_DEVICE_ID_MATCH_INT_CLASS, 2864 .bInterfaceClass = USB_CLASS_HUB}, 2865 { } /* Terminating entry */ 2866 }; 2867 2868 MODULE_DEVICE_TABLE (usb, hub_id_table); 2869 2870 static struct usb_driver hub_driver = { 2871 .name = "hub", 2872 .probe = hub_probe, 2873 .disconnect = hub_disconnect, 2874 .suspend = hub_suspend, 2875 .resume = hub_resume, 2876 .pre_reset = hub_pre_reset, 2877 .post_reset = hub_post_reset, 2878 .ioctl = hub_ioctl, 2879 .id_table = hub_id_table, 2880 .supports_autosuspend = 1, 2881 }; 2882 2883 int usb_hub_init(void) 2884 { 2885 if (usb_register(&hub_driver) < 0) { 2886 printk(KERN_ERR "%s: can't register hub driver\n", 2887 usbcore_name); 2888 return -1; 2889 } 2890 2891 khubd_task = kthread_run(hub_thread, NULL, "khubd"); 2892 if (!IS_ERR(khubd_task)) 2893 return 0; 2894 2895 /* Fall through if kernel_thread failed */ 2896 usb_deregister(&hub_driver); 2897 printk(KERN_ERR "%s: can't start khubd\n", usbcore_name); 2898 2899 return -1; 2900 } 2901 2902 void usb_hub_cleanup(void) 2903 { 2904 kthread_stop(khubd_task); 2905 2906 /* 2907 * Hub resources are freed for us by usb_deregister. It calls 2908 * usb_driver_purge on every device which in turn calls that 2909 * devices disconnect function if it is using this driver. 2910 * The hub_disconnect function takes care of releasing the 2911 * individual hub resources. -greg 2912 */ 2913 usb_deregister(&hub_driver); 2914 } /* usb_hub_cleanup() */ 2915 2916 static int config_descriptors_changed(struct usb_device *udev) 2917 { 2918 unsigned index; 2919 unsigned len = 0; 2920 struct usb_config_descriptor *buf; 2921 2922 for (index = 0; index < udev->descriptor.bNumConfigurations; index++) { 2923 if (len < le16_to_cpu(udev->config[index].desc.wTotalLength)) 2924 len = le16_to_cpu(udev->config[index].desc.wTotalLength); 2925 } 2926 buf = kmalloc (len, GFP_KERNEL); 2927 if (buf == NULL) { 2928 dev_err(&udev->dev, "no mem to re-read configs after reset\n"); 2929 /* assume the worst */ 2930 return 1; 2931 } 2932 for (index = 0; index < udev->descriptor.bNumConfigurations; index++) { 2933 int length; 2934 int old_length = le16_to_cpu(udev->config[index].desc.wTotalLength); 2935 2936 length = usb_get_descriptor(udev, USB_DT_CONFIG, index, buf, 2937 old_length); 2938 if (length < old_length) { 2939 dev_dbg(&udev->dev, "config index %d, error %d\n", 2940 index, length); 2941 break; 2942 } 2943 if (memcmp (buf, udev->rawdescriptors[index], old_length) 2944 != 0) { 2945 dev_dbg(&udev->dev, "config index %d changed (#%d)\n", 2946 index, buf->bConfigurationValue); 2947 break; 2948 } 2949 } 2950 kfree(buf); 2951 return index != udev->descriptor.bNumConfigurations; 2952 } 2953 2954 /** 2955 * usb_reset_device - perform a USB port reset to reinitialize a device 2956 * @udev: device to reset (not in SUSPENDED or NOTATTACHED state) 2957 * 2958 * WARNING - don't use this routine to reset a composite device 2959 * (one with multiple interfaces owned by separate drivers)! 2960 * Use usb_reset_composite_device() instead. 2961 * 2962 * Do a port reset, reassign the device's address, and establish its 2963 * former operating configuration. If the reset fails, or the device's 2964 * descriptors change from their values before the reset, or the original 2965 * configuration and altsettings cannot be restored, a flag will be set 2966 * telling khubd to pretend the device has been disconnected and then 2967 * re-connected. All drivers will be unbound, and the device will be 2968 * re-enumerated and probed all over again. 2969 * 2970 * Returns 0 if the reset succeeded, -ENODEV if the device has been 2971 * flagged for logical disconnection, or some other negative error code 2972 * if the reset wasn't even attempted. 2973 * 2974 * The caller must own the device lock. For example, it's safe to use 2975 * this from a driver probe() routine after downloading new firmware. 2976 * For calls that might not occur during probe(), drivers should lock 2977 * the device using usb_lock_device_for_reset(). 2978 */ 2979 int usb_reset_device(struct usb_device *udev) 2980 { 2981 struct usb_device *parent_hdev = udev->parent; 2982 struct usb_hub *parent_hub; 2983 struct usb_device_descriptor descriptor = udev->descriptor; 2984 int i, ret = 0; 2985 int port1 = udev->portnum; 2986 2987 if (udev->state == USB_STATE_NOTATTACHED || 2988 udev->state == USB_STATE_SUSPENDED) { 2989 dev_dbg(&udev->dev, "device reset not allowed in state %d\n", 2990 udev->state); 2991 return -EINVAL; 2992 } 2993 2994 if (!parent_hdev) { 2995 /* this requires hcd-specific logic; see OHCI hc_restart() */ 2996 dev_dbg(&udev->dev, "%s for root hub!\n", __FUNCTION__); 2997 return -EISDIR; 2998 } 2999 parent_hub = hdev_to_hub(parent_hdev); 3000 3001 set_bit(port1, parent_hub->busy_bits); 3002 for (i = 0; i < SET_CONFIG_TRIES; ++i) { 3003 3004 /* ep0 maxpacket size may change; let the HCD know about it. 3005 * Other endpoints will be handled by re-enumeration. */ 3006 ep0_reinit(udev); 3007 ret = hub_port_init(parent_hub, udev, port1, i); 3008 if (ret >= 0) 3009 break; 3010 } 3011 clear_bit(port1, parent_hub->busy_bits); 3012 if (!parent_hdev->parent && !parent_hub->busy_bits[0]) 3013 usb_enable_root_hub_irq(parent_hdev->bus); 3014 3015 if (ret < 0) 3016 goto re_enumerate; 3017 3018 /* Device might have changed firmware (DFU or similar) */ 3019 if (memcmp(&udev->descriptor, &descriptor, sizeof descriptor) 3020 || config_descriptors_changed (udev)) { 3021 dev_info(&udev->dev, "device firmware changed\n"); 3022 udev->descriptor = descriptor; /* for disconnect() calls */ 3023 goto re_enumerate; 3024 } 3025 3026 if (!udev->actconfig) 3027 goto done; 3028 3029 ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 3030 USB_REQ_SET_CONFIGURATION, 0, 3031 udev->actconfig->desc.bConfigurationValue, 0, 3032 NULL, 0, USB_CTRL_SET_TIMEOUT); 3033 if (ret < 0) { 3034 dev_err(&udev->dev, 3035 "can't restore configuration #%d (error=%d)\n", 3036 udev->actconfig->desc.bConfigurationValue, ret); 3037 goto re_enumerate; 3038 } 3039 usb_set_device_state(udev, USB_STATE_CONFIGURED); 3040 3041 for (i = 0; i < udev->actconfig->desc.bNumInterfaces; i++) { 3042 struct usb_interface *intf = udev->actconfig->interface[i]; 3043 struct usb_interface_descriptor *desc; 3044 3045 /* set_interface resets host side toggle even 3046 * for altsetting zero. the interface may have no driver. 3047 */ 3048 desc = &intf->cur_altsetting->desc; 3049 ret = usb_set_interface(udev, desc->bInterfaceNumber, 3050 desc->bAlternateSetting); 3051 if (ret < 0) { 3052 dev_err(&udev->dev, "failed to restore interface %d " 3053 "altsetting %d (error=%d)\n", 3054 desc->bInterfaceNumber, 3055 desc->bAlternateSetting, 3056 ret); 3057 goto re_enumerate; 3058 } 3059 } 3060 3061 done: 3062 return 0; 3063 3064 re_enumerate: 3065 hub_port_logical_disconnect(parent_hub, port1); 3066 return -ENODEV; 3067 } 3068 EXPORT_SYMBOL(usb_reset_device); 3069 3070 /** 3071 * usb_reset_composite_device - warn interface drivers and perform a USB port reset 3072 * @udev: device to reset (not in SUSPENDED or NOTATTACHED state) 3073 * @iface: interface bound to the driver making the request (optional) 3074 * 3075 * Warns all drivers bound to registered interfaces (using their pre_reset 3076 * method), performs the port reset, and then lets the drivers know that 3077 * the reset is over (using their post_reset method). 3078 * 3079 * Return value is the same as for usb_reset_device(). 3080 * 3081 * The caller must own the device lock. For example, it's safe to use 3082 * this from a driver probe() routine after downloading new firmware. 3083 * For calls that might not occur during probe(), drivers should lock 3084 * the device using usb_lock_device_for_reset(). 3085 * 3086 * The interface locks are acquired during the pre_reset stage and released 3087 * during the post_reset stage. However if iface is not NULL and is 3088 * currently being probed, we assume that the caller already owns its 3089 * lock. 3090 */ 3091 int usb_reset_composite_device(struct usb_device *udev, 3092 struct usb_interface *iface) 3093 { 3094 int ret; 3095 struct usb_host_config *config = udev->actconfig; 3096 3097 if (udev->state == USB_STATE_NOTATTACHED || 3098 udev->state == USB_STATE_SUSPENDED) { 3099 dev_dbg(&udev->dev, "device reset not allowed in state %d\n", 3100 udev->state); 3101 return -EINVAL; 3102 } 3103 3104 /* Prevent autosuspend during the reset */ 3105 usb_autoresume_device(udev); 3106 3107 if (iface && iface->condition != USB_INTERFACE_BINDING) 3108 iface = NULL; 3109 3110 if (config) { 3111 int i; 3112 struct usb_interface *cintf; 3113 struct usb_driver *drv; 3114 3115 for (i = 0; i < config->desc.bNumInterfaces; ++i) { 3116 cintf = config->interface[i]; 3117 if (cintf != iface) 3118 down(&cintf->dev.sem); 3119 if (device_is_registered(&cintf->dev) && 3120 cintf->dev.driver) { 3121 drv = to_usb_driver(cintf->dev.driver); 3122 if (drv->pre_reset) 3123 (drv->pre_reset)(cintf); 3124 } 3125 } 3126 } 3127 3128 ret = usb_reset_device(udev); 3129 3130 if (config) { 3131 int i; 3132 struct usb_interface *cintf; 3133 struct usb_driver *drv; 3134 3135 for (i = config->desc.bNumInterfaces - 1; i >= 0; --i) { 3136 cintf = config->interface[i]; 3137 if (device_is_registered(&cintf->dev) && 3138 cintf->dev.driver) { 3139 drv = to_usb_driver(cintf->dev.driver); 3140 if (drv->post_reset) 3141 (drv->post_reset)(cintf); 3142 } 3143 if (cintf != iface) 3144 up(&cintf->dev.sem); 3145 } 3146 } 3147 3148 usb_autosuspend_device(udev); 3149 return ret; 3150 } 3151 EXPORT_SYMBOL(usb_reset_composite_device); 3152