Linux 4.16.11
[linux/fpc-iii.git] / drivers / usb / core / hub.c
blob83c58a20d16f90d1fd8a79dbb38b9a01b008badc
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * USB hub driver.
5 * (C) Copyright 1999 Linus Torvalds
6 * (C) Copyright 1999 Johannes Erdfelt
7 * (C) Copyright 1999 Gregory P. Smith
8 * (C) Copyright 2001 Brad Hards (bhards@bigpond.net.au)
10 * Released under the GPLv2 only.
13 #include <linux/kernel.h>
14 #include <linux/errno.h>
15 #include <linux/module.h>
16 #include <linux/moduleparam.h>
17 #include <linux/completion.h>
18 #include <linux/sched/mm.h>
19 #include <linux/list.h>
20 #include <linux/slab.h>
21 #include <linux/ioctl.h>
22 #include <linux/usb.h>
23 #include <linux/usbdevice_fs.h>
24 #include <linux/usb/hcd.h>
25 #include <linux/usb/otg.h>
26 #include <linux/usb/quirks.h>
27 #include <linux/workqueue.h>
28 #include <linux/mutex.h>
29 #include <linux/random.h>
30 #include <linux/pm_qos.h>
32 #include <linux/uaccess.h>
33 #include <asm/byteorder.h>
35 #include "hub.h"
36 #include "otg_whitelist.h"
38 #define USB_VENDOR_GENESYS_LOGIC 0x05e3
39 #define HUB_QUIRK_CHECK_PORT_AUTOSUSPEND 0x01
41 #define USB_TP_TRANSMISSION_DELAY 40 /* ns */
42 #define USB_TP_TRANSMISSION_DELAY_MAX 65535 /* ns */
44 /* Protect struct usb_device->state and ->children members
45 * Note: Both are also protected by ->dev.sem, except that ->state can
46 * change to USB_STATE_NOTATTACHED even when the semaphore isn't held. */
47 static DEFINE_SPINLOCK(device_state_lock);
49 /* workqueue to process hub events */
50 static struct workqueue_struct *hub_wq;
51 static void hub_event(struct work_struct *work);
53 /* synchronize hub-port add/remove and peering operations */
54 DEFINE_MUTEX(usb_port_peer_mutex);
56 /* cycle leds on hubs that aren't blinking for attention */
57 static bool blinkenlights;
58 module_param(blinkenlights, bool, S_IRUGO);
59 MODULE_PARM_DESC(blinkenlights, "true to cycle leds on hubs");
62 * Device SATA8000 FW1.0 from DATAST0R Technology Corp requires about
63 * 10 seconds to send reply for the initial 64-byte descriptor request.
65 /* define initial 64-byte descriptor request timeout in milliseconds */
66 static int initial_descriptor_timeout = USB_CTRL_GET_TIMEOUT;
67 module_param(initial_descriptor_timeout, int, S_IRUGO|S_IWUSR);
68 MODULE_PARM_DESC(initial_descriptor_timeout,
69 "initial 64-byte descriptor request timeout in milliseconds "
70 "(default 5000 - 5.0 seconds)");
73 * As of 2.6.10 we introduce a new USB device initialization scheme which
74 * closely resembles the way Windows works. Hopefully it will be compatible
75 * with a wider range of devices than the old scheme. However some previously
76 * working devices may start giving rise to "device not accepting address"
77 * errors; if that happens the user can try the old scheme by adjusting the
78 * following module parameters.
80 * For maximum flexibility there are two boolean parameters to control the
81 * hub driver's behavior. On the first initialization attempt, if the
82 * "old_scheme_first" parameter is set then the old scheme will be used,
83 * otherwise the new scheme is used. If that fails and "use_both_schemes"
84 * is set, then the driver will make another attempt, using the other scheme.
86 static bool old_scheme_first;
87 module_param(old_scheme_first, bool, S_IRUGO | S_IWUSR);
88 MODULE_PARM_DESC(old_scheme_first,
89 "start with the old device initialization scheme");
91 static bool use_both_schemes = 1;
92 module_param(use_both_schemes, bool, S_IRUGO | S_IWUSR);
93 MODULE_PARM_DESC(use_both_schemes,
94 "try the other device initialization scheme if the "
95 "first one fails");
97 /* Mutual exclusion for EHCI CF initialization. This interferes with
98 * port reset on some companion controllers.
100 DECLARE_RWSEM(ehci_cf_port_reset_rwsem);
101 EXPORT_SYMBOL_GPL(ehci_cf_port_reset_rwsem);
103 #define HUB_DEBOUNCE_TIMEOUT 2000
104 #define HUB_DEBOUNCE_STEP 25
105 #define HUB_DEBOUNCE_STABLE 100
107 static void hub_release(struct kref *kref);
108 static int usb_reset_and_verify_device(struct usb_device *udev);
109 static int hub_port_disable(struct usb_hub *hub, int port1, int set_state);
111 static inline char *portspeed(struct usb_hub *hub, int portstatus)
113 if (hub_is_superspeedplus(hub->hdev))
114 return "10.0 Gb/s";
115 if (hub_is_superspeed(hub->hdev))
116 return "5.0 Gb/s";
117 if (portstatus & USB_PORT_STAT_HIGH_SPEED)
118 return "480 Mb/s";
119 else if (portstatus & USB_PORT_STAT_LOW_SPEED)
120 return "1.5 Mb/s";
121 else
122 return "12 Mb/s";
125 /* Note that hdev or one of its children must be locked! */
126 struct usb_hub *usb_hub_to_struct_hub(struct usb_device *hdev)
128 if (!hdev || !hdev->actconfig || !hdev->maxchild)
129 return NULL;
130 return usb_get_intfdata(hdev->actconfig->interface[0]);
133 int usb_device_supports_lpm(struct usb_device *udev)
135 /* Some devices have trouble with LPM */
136 if (udev->quirks & USB_QUIRK_NO_LPM)
137 return 0;
139 /* USB 2.1 (and greater) devices indicate LPM support through
140 * their USB 2.0 Extended Capabilities BOS descriptor.
142 if (udev->speed == USB_SPEED_HIGH || udev->speed == USB_SPEED_FULL) {
143 if (udev->bos->ext_cap &&
144 (USB_LPM_SUPPORT &
145 le32_to_cpu(udev->bos->ext_cap->bmAttributes)))
146 return 1;
147 return 0;
151 * According to the USB 3.0 spec, all USB 3.0 devices must support LPM.
152 * However, there are some that don't, and they set the U1/U2 exit
153 * latencies to zero.
155 if (!udev->bos->ss_cap) {
156 dev_info(&udev->dev, "No LPM exit latency info found, disabling LPM.\n");
157 return 0;
160 if (udev->bos->ss_cap->bU1devExitLat == 0 &&
161 udev->bos->ss_cap->bU2DevExitLat == 0) {
162 if (udev->parent)
163 dev_info(&udev->dev, "LPM exit latency is zeroed, disabling LPM.\n");
164 else
165 dev_info(&udev->dev, "We don't know the algorithms for LPM for this host, disabling LPM.\n");
166 return 0;
169 if (!udev->parent || udev->parent->lpm_capable)
170 return 1;
171 return 0;
175 * Set the Maximum Exit Latency (MEL) for the host to initiate a transition from
176 * either U1 or U2.
178 static void usb_set_lpm_mel(struct usb_device *udev,
179 struct usb3_lpm_parameters *udev_lpm_params,
180 unsigned int udev_exit_latency,
181 struct usb_hub *hub,
182 struct usb3_lpm_parameters *hub_lpm_params,
183 unsigned int hub_exit_latency)
185 unsigned int total_mel;
186 unsigned int device_mel;
187 unsigned int hub_mel;
190 * Calculate the time it takes to transition all links from the roothub
191 * to the parent hub into U0. The parent hub must then decode the
192 * packet (hub header decode latency) to figure out which port it was
193 * bound for.
195 * The Hub Header decode latency is expressed in 0.1us intervals (0x1
196 * means 0.1us). Multiply that by 100 to get nanoseconds.
198 total_mel = hub_lpm_params->mel +
199 (hub->descriptor->u.ss.bHubHdrDecLat * 100);
202 * How long will it take to transition the downstream hub's port into
203 * U0? The greater of either the hub exit latency or the device exit
204 * latency.
206 * The BOS U1/U2 exit latencies are expressed in 1us intervals.
207 * Multiply that by 1000 to get nanoseconds.
209 device_mel = udev_exit_latency * 1000;
210 hub_mel = hub_exit_latency * 1000;
211 if (device_mel > hub_mel)
212 total_mel += device_mel;
213 else
214 total_mel += hub_mel;
216 udev_lpm_params->mel = total_mel;
220 * Set the maximum Device to Host Exit Latency (PEL) for the device to initiate
221 * a transition from either U1 or U2.
223 static void usb_set_lpm_pel(struct usb_device *udev,
224 struct usb3_lpm_parameters *udev_lpm_params,
225 unsigned int udev_exit_latency,
226 struct usb_hub *hub,
227 struct usb3_lpm_parameters *hub_lpm_params,
228 unsigned int hub_exit_latency,
229 unsigned int port_to_port_exit_latency)
231 unsigned int first_link_pel;
232 unsigned int hub_pel;
235 * First, the device sends an LFPS to transition the link between the
236 * device and the parent hub into U0. The exit latency is the bigger of
237 * the device exit latency or the hub exit latency.
239 if (udev_exit_latency > hub_exit_latency)
240 first_link_pel = udev_exit_latency * 1000;
241 else
242 first_link_pel = hub_exit_latency * 1000;
245 * When the hub starts to receive the LFPS, there is a slight delay for
246 * it to figure out that one of the ports is sending an LFPS. Then it
247 * will forward the LFPS to its upstream link. The exit latency is the
248 * delay, plus the PEL that we calculated for this hub.
250 hub_pel = port_to_port_exit_latency * 1000 + hub_lpm_params->pel;
253 * According to figure C-7 in the USB 3.0 spec, the PEL for this device
254 * is the greater of the two exit latencies.
256 if (first_link_pel > hub_pel)
257 udev_lpm_params->pel = first_link_pel;
258 else
259 udev_lpm_params->pel = hub_pel;
263 * Set the System Exit Latency (SEL) to indicate the total worst-case time from
264 * when a device initiates a transition to U0, until when it will receive the
265 * first packet from the host controller.
267 * Section C.1.5.1 describes the four components to this:
268 * - t1: device PEL
269 * - t2: time for the ERDY to make it from the device to the host.
270 * - t3: a host-specific delay to process the ERDY.
271 * - t4: time for the packet to make it from the host to the device.
273 * t3 is specific to both the xHCI host and the platform the host is integrated
274 * into. The Intel HW folks have said it's negligible, FIXME if a different
275 * vendor says otherwise.
277 static void usb_set_lpm_sel(struct usb_device *udev,
278 struct usb3_lpm_parameters *udev_lpm_params)
280 struct usb_device *parent;
281 unsigned int num_hubs;
282 unsigned int total_sel;
284 /* t1 = device PEL */
285 total_sel = udev_lpm_params->pel;
286 /* How many external hubs are in between the device & the root port. */
287 for (parent = udev->parent, num_hubs = 0; parent->parent;
288 parent = parent->parent)
289 num_hubs++;
290 /* t2 = 2.1us + 250ns * (num_hubs - 1) */
291 if (num_hubs > 0)
292 total_sel += 2100 + 250 * (num_hubs - 1);
294 /* t4 = 250ns * num_hubs */
295 total_sel += 250 * num_hubs;
297 udev_lpm_params->sel = total_sel;
300 static void usb_set_lpm_parameters(struct usb_device *udev)
302 struct usb_hub *hub;
303 unsigned int port_to_port_delay;
304 unsigned int udev_u1_del;
305 unsigned int udev_u2_del;
306 unsigned int hub_u1_del;
307 unsigned int hub_u2_del;
309 if (!udev->lpm_capable || udev->speed < USB_SPEED_SUPER)
310 return;
312 hub = usb_hub_to_struct_hub(udev->parent);
313 /* It doesn't take time to transition the roothub into U0, since it
314 * doesn't have an upstream link.
316 if (!hub)
317 return;
319 udev_u1_del = udev->bos->ss_cap->bU1devExitLat;
320 udev_u2_del = le16_to_cpu(udev->bos->ss_cap->bU2DevExitLat);
321 hub_u1_del = udev->parent->bos->ss_cap->bU1devExitLat;
322 hub_u2_del = le16_to_cpu(udev->parent->bos->ss_cap->bU2DevExitLat);
324 usb_set_lpm_mel(udev, &udev->u1_params, udev_u1_del,
325 hub, &udev->parent->u1_params, hub_u1_del);
327 usb_set_lpm_mel(udev, &udev->u2_params, udev_u2_del,
328 hub, &udev->parent->u2_params, hub_u2_del);
331 * Appendix C, section C.2.2.2, says that there is a slight delay from
332 * when the parent hub notices the downstream port is trying to
333 * transition to U0 to when the hub initiates a U0 transition on its
334 * upstream port. The section says the delays are tPort2PortU1EL and
335 * tPort2PortU2EL, but it doesn't define what they are.
337 * The hub chapter, sections 10.4.2.4 and 10.4.2.5 seem to be talking
338 * about the same delays. Use the maximum delay calculations from those
339 * sections. For U1, it's tHubPort2PortExitLat, which is 1us max. For
340 * U2, it's tHubPort2PortExitLat + U2DevExitLat - U1DevExitLat. I
341 * assume the device exit latencies they are talking about are the hub
342 * exit latencies.
344 * What do we do if the U2 exit latency is less than the U1 exit
345 * latency? It's possible, although not likely...
347 port_to_port_delay = 1;
349 usb_set_lpm_pel(udev, &udev->u1_params, udev_u1_del,
350 hub, &udev->parent->u1_params, hub_u1_del,
351 port_to_port_delay);
353 if (hub_u2_del > hub_u1_del)
354 port_to_port_delay = 1 + hub_u2_del - hub_u1_del;
355 else
356 port_to_port_delay = 1 + hub_u1_del;
358 usb_set_lpm_pel(udev, &udev->u2_params, udev_u2_del,
359 hub, &udev->parent->u2_params, hub_u2_del,
360 port_to_port_delay);
362 /* Now that we've got PEL, calculate SEL. */
363 usb_set_lpm_sel(udev, &udev->u1_params);
364 usb_set_lpm_sel(udev, &udev->u2_params);
367 /* USB 2.0 spec Section 11.24.4.5 */
368 static int get_hub_descriptor(struct usb_device *hdev,
369 struct usb_hub_descriptor *desc)
371 int i, ret, size;
372 unsigned dtype;
374 if (hub_is_superspeed(hdev)) {
375 dtype = USB_DT_SS_HUB;
376 size = USB_DT_SS_HUB_SIZE;
377 } else {
378 dtype = USB_DT_HUB;
379 size = sizeof(struct usb_hub_descriptor);
382 for (i = 0; i < 3; i++) {
383 ret = usb_control_msg(hdev, usb_rcvctrlpipe(hdev, 0),
384 USB_REQ_GET_DESCRIPTOR, USB_DIR_IN | USB_RT_HUB,
385 dtype << 8, 0, desc, size,
386 USB_CTRL_GET_TIMEOUT);
387 if (hub_is_superspeed(hdev)) {
388 if (ret == size)
389 return ret;
390 } else if (ret >= USB_DT_HUB_NONVAR_SIZE + 2) {
391 /* Make sure we have the DeviceRemovable field. */
392 size = USB_DT_HUB_NONVAR_SIZE + desc->bNbrPorts / 8 + 1;
393 if (ret < size)
394 return -EMSGSIZE;
395 return ret;
398 return -EINVAL;
402 * USB 2.0 spec Section 11.24.2.1
404 static int clear_hub_feature(struct usb_device *hdev, int feature)
406 return usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0),
407 USB_REQ_CLEAR_FEATURE, USB_RT_HUB, feature, 0, NULL, 0, 1000);
411 * USB 2.0 spec Section 11.24.2.2
413 int usb_clear_port_feature(struct usb_device *hdev, int port1, int feature)
415 return usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0),
416 USB_REQ_CLEAR_FEATURE, USB_RT_PORT, feature, port1,
417 NULL, 0, 1000);
421 * USB 2.0 spec Section 11.24.2.13
423 static int set_port_feature(struct usb_device *hdev, int port1, int feature)
425 return usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0),
426 USB_REQ_SET_FEATURE, USB_RT_PORT, feature, port1,
427 NULL, 0, 1000);
430 static char *to_led_name(int selector)
432 switch (selector) {
433 case HUB_LED_AMBER:
434 return "amber";
435 case HUB_LED_GREEN:
436 return "green";
437 case HUB_LED_OFF:
438 return "off";
439 case HUB_LED_AUTO:
440 return "auto";
441 default:
442 return "??";
447 * USB 2.0 spec Section 11.24.2.7.1.10 and table 11-7
448 * for info about using port indicators
450 static void set_port_led(struct usb_hub *hub, int port1, int selector)
452 struct usb_port *port_dev = hub->ports[port1 - 1];
453 int status;
455 status = set_port_feature(hub->hdev, (selector << 8) | port1,
456 USB_PORT_FEAT_INDICATOR);
457 dev_dbg(&port_dev->dev, "indicator %s status %d\n",
458 to_led_name(selector), status);
461 #define LED_CYCLE_PERIOD ((2*HZ)/3)
463 static void led_work(struct work_struct *work)
465 struct usb_hub *hub =
466 container_of(work, struct usb_hub, leds.work);
467 struct usb_device *hdev = hub->hdev;
468 unsigned i;
469 unsigned changed = 0;
470 int cursor = -1;
472 if (hdev->state != USB_STATE_CONFIGURED || hub->quiescing)
473 return;
475 for (i = 0; i < hdev->maxchild; i++) {
476 unsigned selector, mode;
478 /* 30%-50% duty cycle */
480 switch (hub->indicator[i]) {
481 /* cycle marker */
482 case INDICATOR_CYCLE:
483 cursor = i;
484 selector = HUB_LED_AUTO;
485 mode = INDICATOR_AUTO;
486 break;
487 /* blinking green = sw attention */
488 case INDICATOR_GREEN_BLINK:
489 selector = HUB_LED_GREEN;
490 mode = INDICATOR_GREEN_BLINK_OFF;
491 break;
492 case INDICATOR_GREEN_BLINK_OFF:
493 selector = HUB_LED_OFF;
494 mode = INDICATOR_GREEN_BLINK;
495 break;
496 /* blinking amber = hw attention */
497 case INDICATOR_AMBER_BLINK:
498 selector = HUB_LED_AMBER;
499 mode = INDICATOR_AMBER_BLINK_OFF;
500 break;
501 case INDICATOR_AMBER_BLINK_OFF:
502 selector = HUB_LED_OFF;
503 mode = INDICATOR_AMBER_BLINK;
504 break;
505 /* blink green/amber = reserved */
506 case INDICATOR_ALT_BLINK:
507 selector = HUB_LED_GREEN;
508 mode = INDICATOR_ALT_BLINK_OFF;
509 break;
510 case INDICATOR_ALT_BLINK_OFF:
511 selector = HUB_LED_AMBER;
512 mode = INDICATOR_ALT_BLINK;
513 break;
514 default:
515 continue;
517 if (selector != HUB_LED_AUTO)
518 changed = 1;
519 set_port_led(hub, i + 1, selector);
520 hub->indicator[i] = mode;
522 if (!changed && blinkenlights) {
523 cursor++;
524 cursor %= hdev->maxchild;
525 set_port_led(hub, cursor + 1, HUB_LED_GREEN);
526 hub->indicator[cursor] = INDICATOR_CYCLE;
527 changed++;
529 if (changed)
530 queue_delayed_work(system_power_efficient_wq,
531 &hub->leds, LED_CYCLE_PERIOD);
534 /* use a short timeout for hub/port status fetches */
535 #define USB_STS_TIMEOUT 1000
536 #define USB_STS_RETRIES 5
539 * USB 2.0 spec Section 11.24.2.6
541 static int get_hub_status(struct usb_device *hdev,
542 struct usb_hub_status *data)
544 int i, status = -ETIMEDOUT;
546 for (i = 0; i < USB_STS_RETRIES &&
547 (status == -ETIMEDOUT || status == -EPIPE); i++) {
548 status = usb_control_msg(hdev, usb_rcvctrlpipe(hdev, 0),
549 USB_REQ_GET_STATUS, USB_DIR_IN | USB_RT_HUB, 0, 0,
550 data, sizeof(*data), USB_STS_TIMEOUT);
552 return status;
556 * USB 2.0 spec Section 11.24.2.7
557 * USB 3.1 takes into use the wValue and wLength fields, spec Section 10.16.2.6
559 static int get_port_status(struct usb_device *hdev, int port1,
560 void *data, u16 value, u16 length)
562 int i, status = -ETIMEDOUT;
564 for (i = 0; i < USB_STS_RETRIES &&
565 (status == -ETIMEDOUT || status == -EPIPE); i++) {
566 status = usb_control_msg(hdev, usb_rcvctrlpipe(hdev, 0),
567 USB_REQ_GET_STATUS, USB_DIR_IN | USB_RT_PORT, value,
568 port1, data, length, USB_STS_TIMEOUT);
570 return status;
573 static int hub_ext_port_status(struct usb_hub *hub, int port1, int type,
574 u16 *status, u16 *change, u32 *ext_status)
576 int ret;
577 int len = 4;
579 if (type != HUB_PORT_STATUS)
580 len = 8;
582 mutex_lock(&hub->status_mutex);
583 ret = get_port_status(hub->hdev, port1, &hub->status->port, type, len);
584 if (ret < len) {
585 if (ret != -ENODEV)
586 dev_err(hub->intfdev,
587 "%s failed (err = %d)\n", __func__, ret);
588 if (ret >= 0)
589 ret = -EIO;
590 } else {
591 *status = le16_to_cpu(hub->status->port.wPortStatus);
592 *change = le16_to_cpu(hub->status->port.wPortChange);
593 if (type != HUB_PORT_STATUS && ext_status)
594 *ext_status = le32_to_cpu(
595 hub->status->port.dwExtPortStatus);
596 ret = 0;
598 mutex_unlock(&hub->status_mutex);
599 return ret;
602 static int hub_port_status(struct usb_hub *hub, int port1,
603 u16 *status, u16 *change)
605 return hub_ext_port_status(hub, port1, HUB_PORT_STATUS,
606 status, change, NULL);
609 static void kick_hub_wq(struct usb_hub *hub)
611 struct usb_interface *intf;
613 if (hub->disconnected || work_pending(&hub->events))
614 return;
617 * Suppress autosuspend until the event is proceed.
619 * Be careful and make sure that the symmetric operation is
620 * always called. We are here only when there is no pending
621 * work for this hub. Therefore put the interface either when
622 * the new work is called or when it is canceled.
624 intf = to_usb_interface(hub->intfdev);
625 usb_autopm_get_interface_no_resume(intf);
626 kref_get(&hub->kref);
628 if (queue_work(hub_wq, &hub->events))
629 return;
631 /* the work has already been scheduled */
632 usb_autopm_put_interface_async(intf);
633 kref_put(&hub->kref, hub_release);
636 void usb_kick_hub_wq(struct usb_device *hdev)
638 struct usb_hub *hub = usb_hub_to_struct_hub(hdev);
640 if (hub)
641 kick_hub_wq(hub);
645 * Let the USB core know that a USB 3.0 device has sent a Function Wake Device
646 * Notification, which indicates it had initiated remote wakeup.
648 * USB 3.0 hubs do not report the port link state change from U3 to U0 when the
649 * device initiates resume, so the USB core will not receive notice of the
650 * resume through the normal hub interrupt URB.
652 void usb_wakeup_notification(struct usb_device *hdev,
653 unsigned int portnum)
655 struct usb_hub *hub;
656 struct usb_port *port_dev;
658 if (!hdev)
659 return;
661 hub = usb_hub_to_struct_hub(hdev);
662 if (hub) {
663 port_dev = hub->ports[portnum - 1];
664 if (port_dev && port_dev->child)
665 pm_wakeup_event(&port_dev->child->dev, 0);
667 set_bit(portnum, hub->wakeup_bits);
668 kick_hub_wq(hub);
671 EXPORT_SYMBOL_GPL(usb_wakeup_notification);
673 /* completion function, fires on port status changes and various faults */
674 static void hub_irq(struct urb *urb)
676 struct usb_hub *hub = urb->context;
677 int status = urb->status;
678 unsigned i;
679 unsigned long bits;
681 switch (status) {
682 case -ENOENT: /* synchronous unlink */
683 case -ECONNRESET: /* async unlink */
684 case -ESHUTDOWN: /* hardware going away */
685 return;
687 default: /* presumably an error */
688 /* Cause a hub reset after 10 consecutive errors */
689 dev_dbg(hub->intfdev, "transfer --> %d\n", status);
690 if ((++hub->nerrors < 10) || hub->error)
691 goto resubmit;
692 hub->error = status;
693 /* FALL THROUGH */
695 /* let hub_wq handle things */
696 case 0: /* we got data: port status changed */
697 bits = 0;
698 for (i = 0; i < urb->actual_length; ++i)
699 bits |= ((unsigned long) ((*hub->buffer)[i]))
700 << (i*8);
701 hub->event_bits[0] = bits;
702 break;
705 hub->nerrors = 0;
707 /* Something happened, let hub_wq figure it out */
708 kick_hub_wq(hub);
710 resubmit:
711 if (hub->quiescing)
712 return;
714 status = usb_submit_urb(hub->urb, GFP_ATOMIC);
715 if (status != 0 && status != -ENODEV && status != -EPERM)
716 dev_err(hub->intfdev, "resubmit --> %d\n", status);
719 /* USB 2.0 spec Section 11.24.2.3 */
720 static inline int
721 hub_clear_tt_buffer(struct usb_device *hdev, u16 devinfo, u16 tt)
723 /* Need to clear both directions for control ep */
724 if (((devinfo >> 11) & USB_ENDPOINT_XFERTYPE_MASK) ==
725 USB_ENDPOINT_XFER_CONTROL) {
726 int status = usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0),
727 HUB_CLEAR_TT_BUFFER, USB_RT_PORT,
728 devinfo ^ 0x8000, tt, NULL, 0, 1000);
729 if (status)
730 return status;
732 return usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0),
733 HUB_CLEAR_TT_BUFFER, USB_RT_PORT, devinfo,
734 tt, NULL, 0, 1000);
738 * enumeration blocks hub_wq for a long time. we use keventd instead, since
739 * long blocking there is the exception, not the rule. accordingly, HCDs
740 * talking to TTs must queue control transfers (not just bulk and iso), so
741 * both can talk to the same hub concurrently.
743 static void hub_tt_work(struct work_struct *work)
745 struct usb_hub *hub =
746 container_of(work, struct usb_hub, tt.clear_work);
747 unsigned long flags;
749 spin_lock_irqsave(&hub->tt.lock, flags);
750 while (!list_empty(&hub->tt.clear_list)) {
751 struct list_head *next;
752 struct usb_tt_clear *clear;
753 struct usb_device *hdev = hub->hdev;
754 const struct hc_driver *drv;
755 int status;
757 next = hub->tt.clear_list.next;
758 clear = list_entry(next, struct usb_tt_clear, clear_list);
759 list_del(&clear->clear_list);
761 /* drop lock so HCD can concurrently report other TT errors */
762 spin_unlock_irqrestore(&hub->tt.lock, flags);
763 status = hub_clear_tt_buffer(hdev, clear->devinfo, clear->tt);
764 if (status && status != -ENODEV)
765 dev_err(&hdev->dev,
766 "clear tt %d (%04x) error %d\n",
767 clear->tt, clear->devinfo, status);
769 /* Tell the HCD, even if the operation failed */
770 drv = clear->hcd->driver;
771 if (drv->clear_tt_buffer_complete)
772 (drv->clear_tt_buffer_complete)(clear->hcd, clear->ep);
774 kfree(clear);
775 spin_lock_irqsave(&hub->tt.lock, flags);
777 spin_unlock_irqrestore(&hub->tt.lock, flags);
781 * usb_hub_set_port_power - control hub port's power state
782 * @hdev: USB device belonging to the usb hub
783 * @hub: target hub
784 * @port1: port index
785 * @set: expected status
787 * call this function to control port's power via setting or
788 * clearing the port's PORT_POWER feature.
790 * Return: 0 if successful. A negative error code otherwise.
792 int usb_hub_set_port_power(struct usb_device *hdev, struct usb_hub *hub,
793 int port1, bool set)
795 int ret;
797 if (set)
798 ret = set_port_feature(hdev, port1, USB_PORT_FEAT_POWER);
799 else
800 ret = usb_clear_port_feature(hdev, port1, USB_PORT_FEAT_POWER);
802 if (ret)
803 return ret;
805 if (set)
806 set_bit(port1, hub->power_bits);
807 else
808 clear_bit(port1, hub->power_bits);
809 return 0;
813 * usb_hub_clear_tt_buffer - clear control/bulk TT state in high speed hub
814 * @urb: an URB associated with the failed or incomplete split transaction
816 * High speed HCDs use this to tell the hub driver that some split control or
817 * bulk transaction failed in a way that requires clearing internal state of
818 * a transaction translator. This is normally detected (and reported) from
819 * interrupt context.
821 * It may not be possible for that hub to handle additional full (or low)
822 * speed transactions until that state is fully cleared out.
824 * Return: 0 if successful. A negative error code otherwise.
826 int usb_hub_clear_tt_buffer(struct urb *urb)
828 struct usb_device *udev = urb->dev;
829 int pipe = urb->pipe;
830 struct usb_tt *tt = udev->tt;
831 unsigned long flags;
832 struct usb_tt_clear *clear;
834 /* we've got to cope with an arbitrary number of pending TT clears,
835 * since each TT has "at least two" buffers that can need it (and
836 * there can be many TTs per hub). even if they're uncommon.
838 clear = kmalloc(sizeof *clear, GFP_ATOMIC);
839 if (clear == NULL) {
840 dev_err(&udev->dev, "can't save CLEAR_TT_BUFFER state\n");
841 /* FIXME recover somehow ... RESET_TT? */
842 return -ENOMEM;
845 /* info that CLEAR_TT_BUFFER needs */
846 clear->tt = tt->multi ? udev->ttport : 1;
847 clear->devinfo = usb_pipeendpoint (pipe);
848 clear->devinfo |= udev->devnum << 4;
849 clear->devinfo |= usb_pipecontrol(pipe)
850 ? (USB_ENDPOINT_XFER_CONTROL << 11)
851 : (USB_ENDPOINT_XFER_BULK << 11);
852 if (usb_pipein(pipe))
853 clear->devinfo |= 1 << 15;
855 /* info for completion callback */
856 clear->hcd = bus_to_hcd(udev->bus);
857 clear->ep = urb->ep;
859 /* tell keventd to clear state for this TT */
860 spin_lock_irqsave(&tt->lock, flags);
861 list_add_tail(&clear->clear_list, &tt->clear_list);
862 schedule_work(&tt->clear_work);
863 spin_unlock_irqrestore(&tt->lock, flags);
864 return 0;
866 EXPORT_SYMBOL_GPL(usb_hub_clear_tt_buffer);
868 static void hub_power_on(struct usb_hub *hub, bool do_delay)
870 int port1;
872 /* Enable power on each port. Some hubs have reserved values
873 * of LPSM (> 2) in their descriptors, even though they are
874 * USB 2.0 hubs. Some hubs do not implement port-power switching
875 * but only emulate it. In all cases, the ports won't work
876 * unless we send these messages to the hub.
878 if (hub_is_port_power_switchable(hub))
879 dev_dbg(hub->intfdev, "enabling power on all ports\n");
880 else
881 dev_dbg(hub->intfdev, "trying to enable port power on "
882 "non-switchable hub\n");
883 for (port1 = 1; port1 <= hub->hdev->maxchild; port1++)
884 if (test_bit(port1, hub->power_bits))
885 set_port_feature(hub->hdev, port1, USB_PORT_FEAT_POWER);
886 else
887 usb_clear_port_feature(hub->hdev, port1,
888 USB_PORT_FEAT_POWER);
889 if (do_delay)
890 msleep(hub_power_on_good_delay(hub));
893 static int hub_hub_status(struct usb_hub *hub,
894 u16 *status, u16 *change)
896 int ret;
898 mutex_lock(&hub->status_mutex);
899 ret = get_hub_status(hub->hdev, &hub->status->hub);
900 if (ret < 0) {
901 if (ret != -ENODEV)
902 dev_err(hub->intfdev,
903 "%s failed (err = %d)\n", __func__, ret);
904 } else {
905 *status = le16_to_cpu(hub->status->hub.wHubStatus);
906 *change = le16_to_cpu(hub->status->hub.wHubChange);
907 ret = 0;
909 mutex_unlock(&hub->status_mutex);
910 return ret;
913 static int hub_set_port_link_state(struct usb_hub *hub, int port1,
914 unsigned int link_status)
916 return set_port_feature(hub->hdev,
917 port1 | (link_status << 3),
918 USB_PORT_FEAT_LINK_STATE);
922 * Disable a port and mark a logical connect-change event, so that some
923 * time later hub_wq will disconnect() any existing usb_device on the port
924 * and will re-enumerate if there actually is a device attached.
926 static void hub_port_logical_disconnect(struct usb_hub *hub, int port1)
928 dev_dbg(&hub->ports[port1 - 1]->dev, "logical disconnect\n");
929 hub_port_disable(hub, port1, 1);
931 /* FIXME let caller ask to power down the port:
932 * - some devices won't enumerate without a VBUS power cycle
933 * - SRP saves power that way
934 * - ... new call, TBD ...
935 * That's easy if this hub can switch power per-port, and
936 * hub_wq reactivates the port later (timer, SRP, etc).
937 * Powerdown must be optional, because of reset/DFU.
940 set_bit(port1, hub->change_bits);
941 kick_hub_wq(hub);
945 * usb_remove_device - disable a device's port on its parent hub
946 * @udev: device to be disabled and removed
947 * Context: @udev locked, must be able to sleep.
949 * After @udev's port has been disabled, hub_wq is notified and it will
950 * see that the device has been disconnected. When the device is
951 * physically unplugged and something is plugged in, the events will
952 * be received and processed normally.
954 * Return: 0 if successful. A negative error code otherwise.
956 int usb_remove_device(struct usb_device *udev)
958 struct usb_hub *hub;
959 struct usb_interface *intf;
961 if (!udev->parent) /* Can't remove a root hub */
962 return -EINVAL;
963 hub = usb_hub_to_struct_hub(udev->parent);
964 intf = to_usb_interface(hub->intfdev);
966 usb_autopm_get_interface(intf);
967 set_bit(udev->portnum, hub->removed_bits);
968 hub_port_logical_disconnect(hub, udev->portnum);
969 usb_autopm_put_interface(intf);
970 return 0;
973 enum hub_activation_type {
974 HUB_INIT, HUB_INIT2, HUB_INIT3, /* INITs must come first */
975 HUB_POST_RESET, HUB_RESUME, HUB_RESET_RESUME,
978 static void hub_init_func2(struct work_struct *ws);
979 static void hub_init_func3(struct work_struct *ws);
981 static void hub_activate(struct usb_hub *hub, enum hub_activation_type type)
983 struct usb_device *hdev = hub->hdev;
984 struct usb_hcd *hcd;
985 int ret;
986 int port1;
987 int status;
988 bool need_debounce_delay = false;
989 unsigned delay;
991 /* Continue a partial initialization */
992 if (type == HUB_INIT2 || type == HUB_INIT3) {
993 device_lock(&hdev->dev);
995 /* Was the hub disconnected while we were waiting? */
996 if (hub->disconnected)
997 goto disconnected;
998 if (type == HUB_INIT2)
999 goto init2;
1000 goto init3;
1002 kref_get(&hub->kref);
1004 /* The superspeed hub except for root hub has to use Hub Depth
1005 * value as an offset into the route string to locate the bits
1006 * it uses to determine the downstream port number. So hub driver
1007 * should send a set hub depth request to superspeed hub after
1008 * the superspeed hub is set configuration in initialization or
1009 * reset procedure.
1011 * After a resume, port power should still be on.
1012 * For any other type of activation, turn it on.
1014 if (type != HUB_RESUME) {
1015 if (hdev->parent && hub_is_superspeed(hdev)) {
1016 ret = usb_control_msg(hdev, usb_sndctrlpipe(hdev, 0),
1017 HUB_SET_DEPTH, USB_RT_HUB,
1018 hdev->level - 1, 0, NULL, 0,
1019 USB_CTRL_SET_TIMEOUT);
1020 if (ret < 0)
1021 dev_err(hub->intfdev,
1022 "set hub depth failed\n");
1025 /* Speed up system boot by using a delayed_work for the
1026 * hub's initial power-up delays. This is pretty awkward
1027 * and the implementation looks like a home-brewed sort of
1028 * setjmp/longjmp, but it saves at least 100 ms for each
1029 * root hub (assuming usbcore is compiled into the kernel
1030 * rather than as a module). It adds up.
1032 * This can't be done for HUB_RESUME or HUB_RESET_RESUME
1033 * because for those activation types the ports have to be
1034 * operational when we return. In theory this could be done
1035 * for HUB_POST_RESET, but it's easier not to.
1037 if (type == HUB_INIT) {
1038 delay = hub_power_on_good_delay(hub);
1040 hub_power_on(hub, false);
1041 INIT_DELAYED_WORK(&hub->init_work, hub_init_func2);
1042 queue_delayed_work(system_power_efficient_wq,
1043 &hub->init_work,
1044 msecs_to_jiffies(delay));
1046 /* Suppress autosuspend until init is done */
1047 usb_autopm_get_interface_no_resume(
1048 to_usb_interface(hub->intfdev));
1049 return; /* Continues at init2: below */
1050 } else if (type == HUB_RESET_RESUME) {
1051 /* The internal host controller state for the hub device
1052 * may be gone after a host power loss on system resume.
1053 * Update the device's info so the HW knows it's a hub.
1055 hcd = bus_to_hcd(hdev->bus);
1056 if (hcd->driver->update_hub_device) {
1057 ret = hcd->driver->update_hub_device(hcd, hdev,
1058 &hub->tt, GFP_NOIO);
1059 if (ret < 0) {
1060 dev_err(hub->intfdev,
1061 "Host not accepting hub info update\n");
1062 dev_err(hub->intfdev,
1063 "LS/FS devices and hubs may not work under this hub\n");
1066 hub_power_on(hub, true);
1067 } else {
1068 hub_power_on(hub, true);
1071 init2:
1074 * Check each port and set hub->change_bits to let hub_wq know
1075 * which ports need attention.
1077 for (port1 = 1; port1 <= hdev->maxchild; ++port1) {
1078 struct usb_port *port_dev = hub->ports[port1 - 1];
1079 struct usb_device *udev = port_dev->child;
1080 u16 portstatus, portchange;
1082 portstatus = portchange = 0;
1083 status = hub_port_status(hub, port1, &portstatus, &portchange);
1084 if (status)
1085 goto abort;
1087 if (udev || (portstatus & USB_PORT_STAT_CONNECTION))
1088 dev_dbg(&port_dev->dev, "status %04x change %04x\n",
1089 portstatus, portchange);
1092 * After anything other than HUB_RESUME (i.e., initialization
1093 * or any sort of reset), every port should be disabled.
1094 * Unconnected ports should likewise be disabled (paranoia),
1095 * and so should ports for which we have no usb_device.
1097 if ((portstatus & USB_PORT_STAT_ENABLE) && (
1098 type != HUB_RESUME ||
1099 !(portstatus & USB_PORT_STAT_CONNECTION) ||
1100 !udev ||
1101 udev->state == USB_STATE_NOTATTACHED)) {
1103 * USB3 protocol ports will automatically transition
1104 * to Enabled state when detect an USB3.0 device attach.
1105 * Do not disable USB3 protocol ports, just pretend
1106 * power was lost
1108 portstatus &= ~USB_PORT_STAT_ENABLE;
1109 if (!hub_is_superspeed(hdev))
1110 usb_clear_port_feature(hdev, port1,
1111 USB_PORT_FEAT_ENABLE);
1114 /* Clear status-change flags; we'll debounce later */
1115 if (portchange & USB_PORT_STAT_C_CONNECTION) {
1116 need_debounce_delay = true;
1117 usb_clear_port_feature(hub->hdev, port1,
1118 USB_PORT_FEAT_C_CONNECTION);
1120 if (portchange & USB_PORT_STAT_C_ENABLE) {
1121 need_debounce_delay = true;
1122 usb_clear_port_feature(hub->hdev, port1,
1123 USB_PORT_FEAT_C_ENABLE);
1125 if (portchange & USB_PORT_STAT_C_RESET) {
1126 need_debounce_delay = true;
1127 usb_clear_port_feature(hub->hdev, port1,
1128 USB_PORT_FEAT_C_RESET);
1130 if ((portchange & USB_PORT_STAT_C_BH_RESET) &&
1131 hub_is_superspeed(hub->hdev)) {
1132 need_debounce_delay = true;
1133 usb_clear_port_feature(hub->hdev, port1,
1134 USB_PORT_FEAT_C_BH_PORT_RESET);
1136 /* We can forget about a "removed" device when there's a
1137 * physical disconnect or the connect status changes.
1139 if (!(portstatus & USB_PORT_STAT_CONNECTION) ||
1140 (portchange & USB_PORT_STAT_C_CONNECTION))
1141 clear_bit(port1, hub->removed_bits);
1143 if (!udev || udev->state == USB_STATE_NOTATTACHED) {
1144 /* Tell hub_wq to disconnect the device or
1145 * check for a new connection
1147 if (udev || (portstatus & USB_PORT_STAT_CONNECTION) ||
1148 (portstatus & USB_PORT_STAT_OVERCURRENT))
1149 set_bit(port1, hub->change_bits);
1151 } else if (portstatus & USB_PORT_STAT_ENABLE) {
1152 bool port_resumed = (portstatus &
1153 USB_PORT_STAT_LINK_STATE) ==
1154 USB_SS_PORT_LS_U0;
1155 /* The power session apparently survived the resume.
1156 * If there was an overcurrent or suspend change
1157 * (i.e., remote wakeup request), have hub_wq
1158 * take care of it. Look at the port link state
1159 * for USB 3.0 hubs, since they don't have a suspend
1160 * change bit, and they don't set the port link change
1161 * bit on device-initiated resume.
1163 if (portchange || (hub_is_superspeed(hub->hdev) &&
1164 port_resumed))
1165 set_bit(port1, hub->change_bits);
1167 } else if (udev->persist_enabled) {
1168 #ifdef CONFIG_PM
1169 udev->reset_resume = 1;
1170 #endif
1171 /* Don't set the change_bits when the device
1172 * was powered off.
1174 if (test_bit(port1, hub->power_bits))
1175 set_bit(port1, hub->change_bits);
1177 } else {
1178 /* The power session is gone; tell hub_wq */
1179 usb_set_device_state(udev, USB_STATE_NOTATTACHED);
1180 set_bit(port1, hub->change_bits);
1184 /* If no port-status-change flags were set, we don't need any
1185 * debouncing. If flags were set we can try to debounce the
1186 * ports all at once right now, instead of letting hub_wq do them
1187 * one at a time later on.
1189 * If any port-status changes do occur during this delay, hub_wq
1190 * will see them later and handle them normally.
1192 if (need_debounce_delay) {
1193 delay = HUB_DEBOUNCE_STABLE;
1195 /* Don't do a long sleep inside a workqueue routine */
1196 if (type == HUB_INIT2) {
1197 INIT_DELAYED_WORK(&hub->init_work, hub_init_func3);
1198 queue_delayed_work(system_power_efficient_wq,
1199 &hub->init_work,
1200 msecs_to_jiffies(delay));
1201 device_unlock(&hdev->dev);
1202 return; /* Continues at init3: below */
1203 } else {
1204 msleep(delay);
1207 init3:
1208 hub->quiescing = 0;
1210 status = usb_submit_urb(hub->urb, GFP_NOIO);
1211 if (status < 0)
1212 dev_err(hub->intfdev, "activate --> %d\n", status);
1213 if (hub->has_indicators && blinkenlights)
1214 queue_delayed_work(system_power_efficient_wq,
1215 &hub->leds, LED_CYCLE_PERIOD);
1217 /* Scan all ports that need attention */
1218 kick_hub_wq(hub);
1219 abort:
1220 if (type == HUB_INIT2 || type == HUB_INIT3) {
1221 /* Allow autosuspend if it was suppressed */
1222 disconnected:
1223 usb_autopm_put_interface_async(to_usb_interface(hub->intfdev));
1224 device_unlock(&hdev->dev);
1227 kref_put(&hub->kref, hub_release);
1230 /* Implement the continuations for the delays above */
1231 static void hub_init_func2(struct work_struct *ws)
1233 struct usb_hub *hub = container_of(ws, struct usb_hub, init_work.work);
1235 hub_activate(hub, HUB_INIT2);
1238 static void hub_init_func3(struct work_struct *ws)
1240 struct usb_hub *hub = container_of(ws, struct usb_hub, init_work.work);
1242 hub_activate(hub, HUB_INIT3);
1245 enum hub_quiescing_type {
1246 HUB_DISCONNECT, HUB_PRE_RESET, HUB_SUSPEND
1249 static void hub_quiesce(struct usb_hub *hub, enum hub_quiescing_type type)
1251 struct usb_device *hdev = hub->hdev;
1252 int i;
1254 /* hub_wq and related activity won't re-trigger */
1255 hub->quiescing = 1;
1257 if (type != HUB_SUSPEND) {
1258 /* Disconnect all the children */
1259 for (i = 0; i < hdev->maxchild; ++i) {
1260 if (hub->ports[i]->child)
1261 usb_disconnect(&hub->ports[i]->child);
1265 /* Stop hub_wq and related activity */
1266 usb_kill_urb(hub->urb);
1267 if (hub->has_indicators)
1268 cancel_delayed_work_sync(&hub->leds);
1269 if (hub->tt.hub)
1270 flush_work(&hub->tt.clear_work);
1273 static void hub_pm_barrier_for_all_ports(struct usb_hub *hub)
1275 int i;
1277 for (i = 0; i < hub->hdev->maxchild; ++i)
1278 pm_runtime_barrier(&hub->ports[i]->dev);
1281 /* caller has locked the hub device */
1282 static int hub_pre_reset(struct usb_interface *intf)
1284 struct usb_hub *hub = usb_get_intfdata(intf);
1286 hub_quiesce(hub, HUB_PRE_RESET);
1287 hub->in_reset = 1;
1288 hub_pm_barrier_for_all_ports(hub);
1289 return 0;
1292 /* caller has locked the hub device */
1293 static int hub_post_reset(struct usb_interface *intf)
1295 struct usb_hub *hub = usb_get_intfdata(intf);
1297 hub->in_reset = 0;
1298 hub_pm_barrier_for_all_ports(hub);
1299 hub_activate(hub, HUB_POST_RESET);
1300 return 0;
1303 static int hub_configure(struct usb_hub *hub,
1304 struct usb_endpoint_descriptor *endpoint)
1306 struct usb_hcd *hcd;
1307 struct usb_device *hdev = hub->hdev;
1308 struct device *hub_dev = hub->intfdev;
1309 u16 hubstatus, hubchange;
1310 u16 wHubCharacteristics;
1311 unsigned int pipe;
1312 int maxp, ret, i;
1313 char *message = "out of memory";
1314 unsigned unit_load;
1315 unsigned full_load;
1316 unsigned maxchild;
1318 hub->buffer = kmalloc(sizeof(*hub->buffer), GFP_KERNEL);
1319 if (!hub->buffer) {
1320 ret = -ENOMEM;
1321 goto fail;
1324 hub->status = kmalloc(sizeof(*hub->status), GFP_KERNEL);
1325 if (!hub->status) {
1326 ret = -ENOMEM;
1327 goto fail;
1329 mutex_init(&hub->status_mutex);
1331 hub->descriptor = kzalloc(sizeof(*hub->descriptor), GFP_KERNEL);
1332 if (!hub->descriptor) {
1333 ret = -ENOMEM;
1334 goto fail;
1337 /* Request the entire hub descriptor.
1338 * hub->descriptor can handle USB_MAXCHILDREN ports,
1339 * but a (non-SS) hub can/will return fewer bytes here.
1341 ret = get_hub_descriptor(hdev, hub->descriptor);
1342 if (ret < 0) {
1343 message = "can't read hub descriptor";
1344 goto fail;
1347 maxchild = USB_MAXCHILDREN;
1348 if (hub_is_superspeed(hdev))
1349 maxchild = min_t(unsigned, maxchild, USB_SS_MAXPORTS);
1351 if (hub->descriptor->bNbrPorts > maxchild) {
1352 message = "hub has too many ports!";
1353 ret = -ENODEV;
1354 goto fail;
1355 } else if (hub->descriptor->bNbrPorts == 0) {
1356 message = "hub doesn't have any ports!";
1357 ret = -ENODEV;
1358 goto fail;
1362 * Accumulate wHubDelay + 40ns for every hub in the tree of devices.
1363 * The resulting value will be used for SetIsochDelay() request.
1365 if (hub_is_superspeed(hdev) || hub_is_superspeedplus(hdev)) {
1366 u32 delay = __le16_to_cpu(hub->descriptor->u.ss.wHubDelay);
1368 if (hdev->parent)
1369 delay += hdev->parent->hub_delay;
1371 delay += USB_TP_TRANSMISSION_DELAY;
1372 hdev->hub_delay = min_t(u32, delay, USB_TP_TRANSMISSION_DELAY_MAX);
1375 maxchild = hub->descriptor->bNbrPorts;
1376 dev_info(hub_dev, "%d port%s detected\n", maxchild,
1377 (maxchild == 1) ? "" : "s");
1379 hub->ports = kzalloc(maxchild * sizeof(struct usb_port *), GFP_KERNEL);
1380 if (!hub->ports) {
1381 ret = -ENOMEM;
1382 goto fail;
1385 wHubCharacteristics = le16_to_cpu(hub->descriptor->wHubCharacteristics);
1386 if (hub_is_superspeed(hdev)) {
1387 unit_load = 150;
1388 full_load = 900;
1389 } else {
1390 unit_load = 100;
1391 full_load = 500;
1394 /* FIXME for USB 3.0, skip for now */
1395 if ((wHubCharacteristics & HUB_CHAR_COMPOUND) &&
1396 !(hub_is_superspeed(hdev))) {
1397 char portstr[USB_MAXCHILDREN + 1];
1399 for (i = 0; i < maxchild; i++)
1400 portstr[i] = hub->descriptor->u.hs.DeviceRemovable
1401 [((i + 1) / 8)] & (1 << ((i + 1) % 8))
1402 ? 'F' : 'R';
1403 portstr[maxchild] = 0;
1404 dev_dbg(hub_dev, "compound device; port removable status: %s\n", portstr);
1405 } else
1406 dev_dbg(hub_dev, "standalone hub\n");
1408 switch (wHubCharacteristics & HUB_CHAR_LPSM) {
1409 case HUB_CHAR_COMMON_LPSM:
1410 dev_dbg(hub_dev, "ganged power switching\n");
1411 break;
1412 case HUB_CHAR_INDV_PORT_LPSM:
1413 dev_dbg(hub_dev, "individual port power switching\n");
1414 break;
1415 case HUB_CHAR_NO_LPSM:
1416 case HUB_CHAR_LPSM:
1417 dev_dbg(hub_dev, "no power switching (usb 1.0)\n");
1418 break;
1421 switch (wHubCharacteristics & HUB_CHAR_OCPM) {
1422 case HUB_CHAR_COMMON_OCPM:
1423 dev_dbg(hub_dev, "global over-current protection\n");
1424 break;
1425 case HUB_CHAR_INDV_PORT_OCPM:
1426 dev_dbg(hub_dev, "individual port over-current protection\n");
1427 break;
1428 case HUB_CHAR_NO_OCPM:
1429 case HUB_CHAR_OCPM:
1430 dev_dbg(hub_dev, "no over-current protection\n");
1431 break;
1434 spin_lock_init(&hub->tt.lock);
1435 INIT_LIST_HEAD(&hub->tt.clear_list);
1436 INIT_WORK(&hub->tt.clear_work, hub_tt_work);
1437 switch (hdev->descriptor.bDeviceProtocol) {
1438 case USB_HUB_PR_FS:
1439 break;
1440 case USB_HUB_PR_HS_SINGLE_TT:
1441 dev_dbg(hub_dev, "Single TT\n");
1442 hub->tt.hub = hdev;
1443 break;
1444 case USB_HUB_PR_HS_MULTI_TT:
1445 ret = usb_set_interface(hdev, 0, 1);
1446 if (ret == 0) {
1447 dev_dbg(hub_dev, "TT per port\n");
1448 hub->tt.multi = 1;
1449 } else
1450 dev_err(hub_dev, "Using single TT (err %d)\n",
1451 ret);
1452 hub->tt.hub = hdev;
1453 break;
1454 case USB_HUB_PR_SS:
1455 /* USB 3.0 hubs don't have a TT */
1456 break;
1457 default:
1458 dev_dbg(hub_dev, "Unrecognized hub protocol %d\n",
1459 hdev->descriptor.bDeviceProtocol);
1460 break;
1463 /* Note 8 FS bit times == (8 bits / 12000000 bps) ~= 666ns */
1464 switch (wHubCharacteristics & HUB_CHAR_TTTT) {
1465 case HUB_TTTT_8_BITS:
1466 if (hdev->descriptor.bDeviceProtocol != 0) {
1467 hub->tt.think_time = 666;
1468 dev_dbg(hub_dev, "TT requires at most %d "
1469 "FS bit times (%d ns)\n",
1470 8, hub->tt.think_time);
1472 break;
1473 case HUB_TTTT_16_BITS:
1474 hub->tt.think_time = 666 * 2;
1475 dev_dbg(hub_dev, "TT requires at most %d "
1476 "FS bit times (%d ns)\n",
1477 16, hub->tt.think_time);
1478 break;
1479 case HUB_TTTT_24_BITS:
1480 hub->tt.think_time = 666 * 3;
1481 dev_dbg(hub_dev, "TT requires at most %d "
1482 "FS bit times (%d ns)\n",
1483 24, hub->tt.think_time);
1484 break;
1485 case HUB_TTTT_32_BITS:
1486 hub->tt.think_time = 666 * 4;
1487 dev_dbg(hub_dev, "TT requires at most %d "
1488 "FS bit times (%d ns)\n",
1489 32, hub->tt.think_time);
1490 break;
1493 /* probe() zeroes hub->indicator[] */
1494 if (wHubCharacteristics & HUB_CHAR_PORTIND) {
1495 hub->has_indicators = 1;
1496 dev_dbg(hub_dev, "Port indicators are supported\n");
1499 dev_dbg(hub_dev, "power on to power good time: %dms\n",
1500 hub->descriptor->bPwrOn2PwrGood * 2);
1502 /* power budgeting mostly matters with bus-powered hubs,
1503 * and battery-powered root hubs (may provide just 8 mA).
1505 ret = usb_get_std_status(hdev, USB_RECIP_DEVICE, 0, &hubstatus);
1506 if (ret) {
1507 message = "can't get hub status";
1508 goto fail;
1510 hcd = bus_to_hcd(hdev->bus);
1511 if (hdev == hdev->bus->root_hub) {
1512 if (hcd->power_budget > 0)
1513 hdev->bus_mA = hcd->power_budget;
1514 else
1515 hdev->bus_mA = full_load * maxchild;
1516 if (hdev->bus_mA >= full_load)
1517 hub->mA_per_port = full_load;
1518 else {
1519 hub->mA_per_port = hdev->bus_mA;
1520 hub->limited_power = 1;
1522 } else if ((hubstatus & (1 << USB_DEVICE_SELF_POWERED)) == 0) {
1523 int remaining = hdev->bus_mA -
1524 hub->descriptor->bHubContrCurrent;
1526 dev_dbg(hub_dev, "hub controller current requirement: %dmA\n",
1527 hub->descriptor->bHubContrCurrent);
1528 hub->limited_power = 1;
1530 if (remaining < maxchild * unit_load)
1531 dev_warn(hub_dev,
1532 "insufficient power available "
1533 "to use all downstream ports\n");
1534 hub->mA_per_port = unit_load; /* 7.2.1 */
1536 } else { /* Self-powered external hub */
1537 /* FIXME: What about battery-powered external hubs that
1538 * provide less current per port? */
1539 hub->mA_per_port = full_load;
1541 if (hub->mA_per_port < full_load)
1542 dev_dbg(hub_dev, "%umA bus power budget for each child\n",
1543 hub->mA_per_port);
1545 ret = hub_hub_status(hub, &hubstatus, &hubchange);
1546 if (ret < 0) {
1547 message = "can't get hub status";
1548 goto fail;
1551 /* local power status reports aren't always correct */
1552 if (hdev->actconfig->desc.bmAttributes & USB_CONFIG_ATT_SELFPOWER)
1553 dev_dbg(hub_dev, "local power source is %s\n",
1554 (hubstatus & HUB_STATUS_LOCAL_POWER)
1555 ? "lost (inactive)" : "good");
1557 if ((wHubCharacteristics & HUB_CHAR_OCPM) == 0)
1558 dev_dbg(hub_dev, "%sover-current condition exists\n",
1559 (hubstatus & HUB_STATUS_OVERCURRENT) ? "" : "no ");
1561 /* set up the interrupt endpoint
1562 * We use the EP's maxpacket size instead of (PORTS+1+7)/8
1563 * bytes as USB2.0[11.12.3] says because some hubs are known
1564 * to send more data (and thus cause overflow). For root hubs,
1565 * maxpktsize is defined in hcd.c's fake endpoint descriptors
1566 * to be big enough for at least USB_MAXCHILDREN ports. */
1567 pipe = usb_rcvintpipe(hdev, endpoint->bEndpointAddress);
1568 maxp = usb_maxpacket(hdev, pipe, usb_pipeout(pipe));
1570 if (maxp > sizeof(*hub->buffer))
1571 maxp = sizeof(*hub->buffer);
1573 hub->urb = usb_alloc_urb(0, GFP_KERNEL);
1574 if (!hub->urb) {
1575 ret = -ENOMEM;
1576 goto fail;
1579 usb_fill_int_urb(hub->urb, hdev, pipe, *hub->buffer, maxp, hub_irq,
1580 hub, endpoint->bInterval);
1582 /* maybe cycle the hub leds */
1583 if (hub->has_indicators && blinkenlights)
1584 hub->indicator[0] = INDICATOR_CYCLE;
1586 mutex_lock(&usb_port_peer_mutex);
1587 for (i = 0; i < maxchild; i++) {
1588 ret = usb_hub_create_port_device(hub, i + 1);
1589 if (ret < 0) {
1590 dev_err(hub->intfdev,
1591 "couldn't create port%d device.\n", i + 1);
1592 break;
1595 hdev->maxchild = i;
1596 for (i = 0; i < hdev->maxchild; i++) {
1597 struct usb_port *port_dev = hub->ports[i];
1599 pm_runtime_put(&port_dev->dev);
1602 mutex_unlock(&usb_port_peer_mutex);
1603 if (ret < 0)
1604 goto fail;
1606 /* Update the HCD's internal representation of this hub before hub_wq
1607 * starts getting port status changes for devices under the hub.
1609 if (hcd->driver->update_hub_device) {
1610 ret = hcd->driver->update_hub_device(hcd, hdev,
1611 &hub->tt, GFP_KERNEL);
1612 if (ret < 0) {
1613 message = "can't update HCD hub info";
1614 goto fail;
1618 usb_hub_adjust_deviceremovable(hdev, hub->descriptor);
1620 hub_activate(hub, HUB_INIT);
1621 return 0;
1623 fail:
1624 dev_err(hub_dev, "config failed, %s (err %d)\n",
1625 message, ret);
1626 /* hub_disconnect() frees urb and descriptor */
1627 return ret;
1630 static void hub_release(struct kref *kref)
1632 struct usb_hub *hub = container_of(kref, struct usb_hub, kref);
1634 usb_put_dev(hub->hdev);
1635 usb_put_intf(to_usb_interface(hub->intfdev));
1636 kfree(hub);
1639 static unsigned highspeed_hubs;
1641 static void hub_disconnect(struct usb_interface *intf)
1643 struct usb_hub *hub = usb_get_intfdata(intf);
1644 struct usb_device *hdev = interface_to_usbdev(intf);
1645 int port1;
1648 * Stop adding new hub events. We do not want to block here and thus
1649 * will not try to remove any pending work item.
1651 hub->disconnected = 1;
1653 /* Disconnect all children and quiesce the hub */
1654 hub->error = 0;
1655 hub_quiesce(hub, HUB_DISCONNECT);
1657 mutex_lock(&usb_port_peer_mutex);
1659 /* Avoid races with recursively_mark_NOTATTACHED() */
1660 spin_lock_irq(&device_state_lock);
1661 port1 = hdev->maxchild;
1662 hdev->maxchild = 0;
1663 usb_set_intfdata(intf, NULL);
1664 spin_unlock_irq(&device_state_lock);
1666 for (; port1 > 0; --port1)
1667 usb_hub_remove_port_device(hub, port1);
1669 mutex_unlock(&usb_port_peer_mutex);
1671 if (hub->hdev->speed == USB_SPEED_HIGH)
1672 highspeed_hubs--;
1674 usb_free_urb(hub->urb);
1675 kfree(hub->ports);
1676 kfree(hub->descriptor);
1677 kfree(hub->status);
1678 kfree(hub->buffer);
1680 pm_suspend_ignore_children(&intf->dev, false);
1681 kref_put(&hub->kref, hub_release);
1684 static bool hub_descriptor_is_sane(struct usb_host_interface *desc)
1686 /* Some hubs have a subclass of 1, which AFAICT according to the */
1687 /* specs is not defined, but it works */
1688 if (desc->desc.bInterfaceSubClass != 0 &&
1689 desc->desc.bInterfaceSubClass != 1)
1690 return false;
1692 /* Multiple endpoints? What kind of mutant ninja-hub is this? */
1693 if (desc->desc.bNumEndpoints != 1)
1694 return false;
1696 /* If the first endpoint is not interrupt IN, we'd better punt! */
1697 if (!usb_endpoint_is_int_in(&desc->endpoint[0].desc))
1698 return false;
1700 return true;
1703 static int hub_probe(struct usb_interface *intf, const struct usb_device_id *id)
1705 struct usb_host_interface *desc;
1706 struct usb_device *hdev;
1707 struct usb_hub *hub;
1709 desc = intf->cur_altsetting;
1710 hdev = interface_to_usbdev(intf);
1713 * Set default autosuspend delay as 0 to speedup bus suspend,
1714 * based on the below considerations:
1716 * - Unlike other drivers, the hub driver does not rely on the
1717 * autosuspend delay to provide enough time to handle a wakeup
1718 * event, and the submitted status URB is just to check future
1719 * change on hub downstream ports, so it is safe to do it.
1721 * - The patch might cause one or more auto supend/resume for
1722 * below very rare devices when they are plugged into hub
1723 * first time:
1725 * devices having trouble initializing, and disconnect
1726 * themselves from the bus and then reconnect a second
1727 * or so later
1729 * devices just for downloading firmware, and disconnects
1730 * themselves after completing it
1732 * For these quite rare devices, their drivers may change the
1733 * autosuspend delay of their parent hub in the probe() to one
1734 * appropriate value to avoid the subtle problem if someone
1735 * does care it.
1737 * - The patch may cause one or more auto suspend/resume on
1738 * hub during running 'lsusb', but it is probably too
1739 * infrequent to worry about.
1741 * - Change autosuspend delay of hub can avoid unnecessary auto
1742 * suspend timer for hub, also may decrease power consumption
1743 * of USB bus.
1745 * - If user has indicated to prevent autosuspend by passing
1746 * usbcore.autosuspend = -1 then keep autosuspend disabled.
1748 #ifdef CONFIG_PM
1749 if (hdev->dev.power.autosuspend_delay >= 0)
1750 pm_runtime_set_autosuspend_delay(&hdev->dev, 0);
1751 #endif
1754 * Hubs have proper suspend/resume support, except for root hubs
1755 * where the controller driver doesn't have bus_suspend and
1756 * bus_resume methods.
1758 if (hdev->parent) { /* normal device */
1759 usb_enable_autosuspend(hdev);
1760 } else { /* root hub */
1761 const struct hc_driver *drv = bus_to_hcd(hdev->bus)->driver;
1763 if (drv->bus_suspend && drv->bus_resume)
1764 usb_enable_autosuspend(hdev);
1767 if (hdev->level == MAX_TOPO_LEVEL) {
1768 dev_err(&intf->dev,
1769 "Unsupported bus topology: hub nested too deep\n");
1770 return -E2BIG;
1773 #ifdef CONFIG_USB_OTG_BLACKLIST_HUB
1774 if (hdev->parent) {
1775 dev_warn(&intf->dev, "ignoring external hub\n");
1776 return -ENODEV;
1778 #endif
1780 if (!hub_descriptor_is_sane(desc)) {
1781 dev_err(&intf->dev, "bad descriptor, ignoring hub\n");
1782 return -EIO;
1785 /* We found a hub */
1786 dev_info(&intf->dev, "USB hub found\n");
1788 hub = kzalloc(sizeof(*hub), GFP_KERNEL);
1789 if (!hub)
1790 return -ENOMEM;
1792 kref_init(&hub->kref);
1793 hub->intfdev = &intf->dev;
1794 hub->hdev = hdev;
1795 INIT_DELAYED_WORK(&hub->leds, led_work);
1796 INIT_DELAYED_WORK(&hub->init_work, NULL);
1797 INIT_WORK(&hub->events, hub_event);
1798 usb_get_intf(intf);
1799 usb_get_dev(hdev);
1801 usb_set_intfdata(intf, hub);
1802 intf->needs_remote_wakeup = 1;
1803 pm_suspend_ignore_children(&intf->dev, true);
1805 if (hdev->speed == USB_SPEED_HIGH)
1806 highspeed_hubs++;
1808 if (id->driver_info & HUB_QUIRK_CHECK_PORT_AUTOSUSPEND)
1809 hub->quirk_check_port_auto_suspend = 1;
1811 if (hub_configure(hub, &desc->endpoint[0].desc) >= 0)
1812 return 0;
1814 hub_disconnect(intf);
1815 return -ENODEV;
1818 static int
1819 hub_ioctl(struct usb_interface *intf, unsigned int code, void *user_data)
1821 struct usb_device *hdev = interface_to_usbdev(intf);
1822 struct usb_hub *hub = usb_hub_to_struct_hub(hdev);
1824 /* assert ifno == 0 (part of hub spec) */
1825 switch (code) {
1826 case USBDEVFS_HUB_PORTINFO: {
1827 struct usbdevfs_hub_portinfo *info = user_data;
1828 int i;
1830 spin_lock_irq(&device_state_lock);
1831 if (hdev->devnum <= 0)
1832 info->nports = 0;
1833 else {
1834 info->nports = hdev->maxchild;
1835 for (i = 0; i < info->nports; i++) {
1836 if (hub->ports[i]->child == NULL)
1837 info->port[i] = 0;
1838 else
1839 info->port[i] =
1840 hub->ports[i]->child->devnum;
1843 spin_unlock_irq(&device_state_lock);
1845 return info->nports + 1;
1848 default:
1849 return -ENOSYS;
1854 * Allow user programs to claim ports on a hub. When a device is attached
1855 * to one of these "claimed" ports, the program will "own" the device.
1857 static int find_port_owner(struct usb_device *hdev, unsigned port1,
1858 struct usb_dev_state ***ppowner)
1860 struct usb_hub *hub = usb_hub_to_struct_hub(hdev);
1862 if (hdev->state == USB_STATE_NOTATTACHED)
1863 return -ENODEV;
1864 if (port1 == 0 || port1 > hdev->maxchild)
1865 return -EINVAL;
1867 /* Devices not managed by the hub driver
1868 * will always have maxchild equal to 0.
1870 *ppowner = &(hub->ports[port1 - 1]->port_owner);
1871 return 0;
1874 /* In the following three functions, the caller must hold hdev's lock */
1875 int usb_hub_claim_port(struct usb_device *hdev, unsigned port1,
1876 struct usb_dev_state *owner)
1878 int rc;
1879 struct usb_dev_state **powner;
1881 rc = find_port_owner(hdev, port1, &powner);
1882 if (rc)
1883 return rc;
1884 if (*powner)
1885 return -EBUSY;
1886 *powner = owner;
1887 return rc;
1889 EXPORT_SYMBOL_GPL(usb_hub_claim_port);
1891 int usb_hub_release_port(struct usb_device *hdev, unsigned port1,
1892 struct usb_dev_state *owner)
1894 int rc;
1895 struct usb_dev_state **powner;
1897 rc = find_port_owner(hdev, port1, &powner);
1898 if (rc)
1899 return rc;
1900 if (*powner != owner)
1901 return -ENOENT;
1902 *powner = NULL;
1903 return rc;
1905 EXPORT_SYMBOL_GPL(usb_hub_release_port);
1907 void usb_hub_release_all_ports(struct usb_device *hdev, struct usb_dev_state *owner)
1909 struct usb_hub *hub = usb_hub_to_struct_hub(hdev);
1910 int n;
1912 for (n = 0; n < hdev->maxchild; n++) {
1913 if (hub->ports[n]->port_owner == owner)
1914 hub->ports[n]->port_owner = NULL;
1919 /* The caller must hold udev's lock */
1920 bool usb_device_is_owned(struct usb_device *udev)
1922 struct usb_hub *hub;
1924 if (udev->state == USB_STATE_NOTATTACHED || !udev->parent)
1925 return false;
1926 hub = usb_hub_to_struct_hub(udev->parent);
1927 return !!hub->ports[udev->portnum - 1]->port_owner;
1930 static void recursively_mark_NOTATTACHED(struct usb_device *udev)
1932 struct usb_hub *hub = usb_hub_to_struct_hub(udev);
1933 int i;
1935 for (i = 0; i < udev->maxchild; ++i) {
1936 if (hub->ports[i]->child)
1937 recursively_mark_NOTATTACHED(hub->ports[i]->child);
1939 if (udev->state == USB_STATE_SUSPENDED)
1940 udev->active_duration -= jiffies;
1941 udev->state = USB_STATE_NOTATTACHED;
1945 * usb_set_device_state - change a device's current state (usbcore, hcds)
1946 * @udev: pointer to device whose state should be changed
1947 * @new_state: new state value to be stored
1949 * udev->state is _not_ fully protected by the device lock. Although
1950 * most transitions are made only while holding the lock, the state can
1951 * can change to USB_STATE_NOTATTACHED at almost any time. This
1952 * is so that devices can be marked as disconnected as soon as possible,
1953 * without having to wait for any semaphores to be released. As a result,
1954 * all changes to any device's state must be protected by the
1955 * device_state_lock spinlock.
1957 * Once a device has been added to the device tree, all changes to its state
1958 * should be made using this routine. The state should _not_ be set directly.
1960 * If udev->state is already USB_STATE_NOTATTACHED then no change is made.
1961 * Otherwise udev->state is set to new_state, and if new_state is
1962 * USB_STATE_NOTATTACHED then all of udev's descendants' states are also set
1963 * to USB_STATE_NOTATTACHED.
1965 void usb_set_device_state(struct usb_device *udev,
1966 enum usb_device_state new_state)
1968 unsigned long flags;
1969 int wakeup = -1;
1971 spin_lock_irqsave(&device_state_lock, flags);
1972 if (udev->state == USB_STATE_NOTATTACHED)
1973 ; /* do nothing */
1974 else if (new_state != USB_STATE_NOTATTACHED) {
1976 /* root hub wakeup capabilities are managed out-of-band
1977 * and may involve silicon errata ... ignore them here.
1979 if (udev->parent) {
1980 if (udev->state == USB_STATE_SUSPENDED
1981 || new_state == USB_STATE_SUSPENDED)
1982 ; /* No change to wakeup settings */
1983 else if (new_state == USB_STATE_CONFIGURED)
1984 wakeup = (udev->quirks &
1985 USB_QUIRK_IGNORE_REMOTE_WAKEUP) ? 0 :
1986 udev->actconfig->desc.bmAttributes &
1987 USB_CONFIG_ATT_WAKEUP;
1988 else
1989 wakeup = 0;
1991 if (udev->state == USB_STATE_SUSPENDED &&
1992 new_state != USB_STATE_SUSPENDED)
1993 udev->active_duration -= jiffies;
1994 else if (new_state == USB_STATE_SUSPENDED &&
1995 udev->state != USB_STATE_SUSPENDED)
1996 udev->active_duration += jiffies;
1997 udev->state = new_state;
1998 } else
1999 recursively_mark_NOTATTACHED(udev);
2000 spin_unlock_irqrestore(&device_state_lock, flags);
2001 if (wakeup >= 0)
2002 device_set_wakeup_capable(&udev->dev, wakeup);
2004 EXPORT_SYMBOL_GPL(usb_set_device_state);
2007 * Choose a device number.
2009 * Device numbers are used as filenames in usbfs. On USB-1.1 and
2010 * USB-2.0 buses they are also used as device addresses, however on
2011 * USB-3.0 buses the address is assigned by the controller hardware
2012 * and it usually is not the same as the device number.
2014 * WUSB devices are simple: they have no hubs behind, so the mapping
2015 * device <-> virtual port number becomes 1:1. Why? to simplify the
2016 * life of the device connection logic in
2017 * drivers/usb/wusbcore/devconnect.c. When we do the initial secret
2018 * handshake we need to assign a temporary address in the unauthorized
2019 * space. For simplicity we use the first virtual port number found to
2020 * be free [drivers/usb/wusbcore/devconnect.c:wusbhc_devconnect_ack()]
2021 * and that becomes it's address [X < 128] or its unauthorized address
2022 * [X | 0x80].
2024 * We add 1 as an offset to the one-based USB-stack port number
2025 * (zero-based wusb virtual port index) for two reasons: (a) dev addr
2026 * 0 is reserved by USB for default address; (b) Linux's USB stack
2027 * uses always #1 for the root hub of the controller. So USB stack's
2028 * port #1, which is wusb virtual-port #0 has address #2.
2030 * Devices connected under xHCI are not as simple. The host controller
2031 * supports virtualization, so the hardware assigns device addresses and
2032 * the HCD must setup data structures before issuing a set address
2033 * command to the hardware.
2035 static void choose_devnum(struct usb_device *udev)
2037 int devnum;
2038 struct usb_bus *bus = udev->bus;
2040 /* be safe when more hub events are proceed in parallel */
2041 mutex_lock(&bus->devnum_next_mutex);
2042 if (udev->wusb) {
2043 devnum = udev->portnum + 1;
2044 BUG_ON(test_bit(devnum, bus->devmap.devicemap));
2045 } else {
2046 /* Try to allocate the next devnum beginning at
2047 * bus->devnum_next. */
2048 devnum = find_next_zero_bit(bus->devmap.devicemap, 128,
2049 bus->devnum_next);
2050 if (devnum >= 128)
2051 devnum = find_next_zero_bit(bus->devmap.devicemap,
2052 128, 1);
2053 bus->devnum_next = (devnum >= 127 ? 1 : devnum + 1);
2055 if (devnum < 128) {
2056 set_bit(devnum, bus->devmap.devicemap);
2057 udev->devnum = devnum;
2059 mutex_unlock(&bus->devnum_next_mutex);
2062 static void release_devnum(struct usb_device *udev)
2064 if (udev->devnum > 0) {
2065 clear_bit(udev->devnum, udev->bus->devmap.devicemap);
2066 udev->devnum = -1;
2070 static void update_devnum(struct usb_device *udev, int devnum)
2072 /* The address for a WUSB device is managed by wusbcore. */
2073 if (!udev->wusb)
2074 udev->devnum = devnum;
2077 static void hub_free_dev(struct usb_device *udev)
2079 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
2081 /* Root hubs aren't real devices, so don't free HCD resources */
2082 if (hcd->driver->free_dev && udev->parent)
2083 hcd->driver->free_dev(hcd, udev);
2086 static void hub_disconnect_children(struct usb_device *udev)
2088 struct usb_hub *hub = usb_hub_to_struct_hub(udev);
2089 int i;
2091 /* Free up all the children before we remove this device */
2092 for (i = 0; i < udev->maxchild; i++) {
2093 if (hub->ports[i]->child)
2094 usb_disconnect(&hub->ports[i]->child);
2099 * usb_disconnect - disconnect a device (usbcore-internal)
2100 * @pdev: pointer to device being disconnected
2101 * Context: !in_interrupt ()
2103 * Something got disconnected. Get rid of it and all of its children.
2105 * If *pdev is a normal device then the parent hub must already be locked.
2106 * If *pdev is a root hub then the caller must hold the usb_bus_idr_lock,
2107 * which protects the set of root hubs as well as the list of buses.
2109 * Only hub drivers (including virtual root hub drivers for host
2110 * controllers) should ever call this.
2112 * This call is synchronous, and may not be used in an interrupt context.
2114 void usb_disconnect(struct usb_device **pdev)
2116 struct usb_port *port_dev = NULL;
2117 struct usb_device *udev = *pdev;
2118 struct usb_hub *hub = NULL;
2119 int port1 = 1;
2121 /* mark the device as inactive, so any further urb submissions for
2122 * this device (and any of its children) will fail immediately.
2123 * this quiesces everything except pending urbs.
2125 usb_set_device_state(udev, USB_STATE_NOTATTACHED);
2126 dev_info(&udev->dev, "USB disconnect, device number %d\n",
2127 udev->devnum);
2130 * Ensure that the pm runtime code knows that the USB device
2131 * is in the process of being disconnected.
2133 pm_runtime_barrier(&udev->dev);
2135 usb_lock_device(udev);
2137 hub_disconnect_children(udev);
2139 /* deallocate hcd/hardware state ... nuking all pending urbs and
2140 * cleaning up all state associated with the current configuration
2141 * so that the hardware is now fully quiesced.
2143 dev_dbg(&udev->dev, "unregistering device\n");
2144 usb_disable_device(udev, 0);
2145 usb_hcd_synchronize_unlinks(udev);
2147 if (udev->parent) {
2148 port1 = udev->portnum;
2149 hub = usb_hub_to_struct_hub(udev->parent);
2150 port_dev = hub->ports[port1 - 1];
2152 sysfs_remove_link(&udev->dev.kobj, "port");
2153 sysfs_remove_link(&port_dev->dev.kobj, "device");
2156 * As usb_port_runtime_resume() de-references udev, make
2157 * sure no resumes occur during removal
2159 if (!test_and_set_bit(port1, hub->child_usage_bits))
2160 pm_runtime_get_sync(&port_dev->dev);
2163 usb_remove_ep_devs(&udev->ep0);
2164 usb_unlock_device(udev);
2166 /* Unregister the device. The device driver is responsible
2167 * for de-configuring the device and invoking the remove-device
2168 * notifier chain (used by usbfs and possibly others).
2170 device_del(&udev->dev);
2172 /* Free the device number and delete the parent's children[]
2173 * (or root_hub) pointer.
2175 release_devnum(udev);
2177 /* Avoid races with recursively_mark_NOTATTACHED() */
2178 spin_lock_irq(&device_state_lock);
2179 *pdev = NULL;
2180 spin_unlock_irq(&device_state_lock);
2182 if (port_dev && test_and_clear_bit(port1, hub->child_usage_bits))
2183 pm_runtime_put(&port_dev->dev);
2185 hub_free_dev(udev);
2187 put_device(&udev->dev);
2190 #ifdef CONFIG_USB_ANNOUNCE_NEW_DEVICES
2191 static void show_string(struct usb_device *udev, char *id, char *string)
2193 if (!string)
2194 return;
2195 dev_info(&udev->dev, "%s: %s\n", id, string);
2198 static void announce_device(struct usb_device *udev)
2200 dev_info(&udev->dev, "New USB device found, idVendor=%04x, idProduct=%04x\n",
2201 le16_to_cpu(udev->descriptor.idVendor),
2202 le16_to_cpu(udev->descriptor.idProduct));
2203 dev_info(&udev->dev,
2204 "New USB device strings: Mfr=%d, Product=%d, SerialNumber=%d\n",
2205 udev->descriptor.iManufacturer,
2206 udev->descriptor.iProduct,
2207 udev->descriptor.iSerialNumber);
2208 show_string(udev, "Product", udev->product);
2209 show_string(udev, "Manufacturer", udev->manufacturer);
2210 show_string(udev, "SerialNumber", udev->serial);
2212 #else
2213 static inline void announce_device(struct usb_device *udev) { }
2214 #endif
2218 * usb_enumerate_device_otg - FIXME (usbcore-internal)
2219 * @udev: newly addressed device (in ADDRESS state)
2221 * Finish enumeration for On-The-Go devices
2223 * Return: 0 if successful. A negative error code otherwise.
2225 static int usb_enumerate_device_otg(struct usb_device *udev)
2227 int err = 0;
2229 #ifdef CONFIG_USB_OTG
2231 * OTG-aware devices on OTG-capable root hubs may be able to use SRP,
2232 * to wake us after we've powered off VBUS; and HNP, switching roles
2233 * "host" to "peripheral". The OTG descriptor helps figure this out.
2235 if (!udev->bus->is_b_host
2236 && udev->config
2237 && udev->parent == udev->bus->root_hub) {
2238 struct usb_otg_descriptor *desc = NULL;
2239 struct usb_bus *bus = udev->bus;
2240 unsigned port1 = udev->portnum;
2242 /* descriptor may appear anywhere in config */
2243 err = __usb_get_extra_descriptor(udev->rawdescriptors[0],
2244 le16_to_cpu(udev->config[0].desc.wTotalLength),
2245 USB_DT_OTG, (void **) &desc);
2246 if (err || !(desc->bmAttributes & USB_OTG_HNP))
2247 return 0;
2249 dev_info(&udev->dev, "Dual-Role OTG device on %sHNP port\n",
2250 (port1 == bus->otg_port) ? "" : "non-");
2252 /* enable HNP before suspend, it's simpler */
2253 if (port1 == bus->otg_port) {
2254 bus->b_hnp_enable = 1;
2255 err = usb_control_msg(udev,
2256 usb_sndctrlpipe(udev, 0),
2257 USB_REQ_SET_FEATURE, 0,
2258 USB_DEVICE_B_HNP_ENABLE,
2259 0, NULL, 0,
2260 USB_CTRL_SET_TIMEOUT);
2261 if (err < 0) {
2263 * OTG MESSAGE: report errors here,
2264 * customize to match your product.
2266 dev_err(&udev->dev, "can't set HNP mode: %d\n",
2267 err);
2268 bus->b_hnp_enable = 0;
2270 } else if (desc->bLength == sizeof
2271 (struct usb_otg_descriptor)) {
2272 /* Set a_alt_hnp_support for legacy otg device */
2273 err = usb_control_msg(udev,
2274 usb_sndctrlpipe(udev, 0),
2275 USB_REQ_SET_FEATURE, 0,
2276 USB_DEVICE_A_ALT_HNP_SUPPORT,
2277 0, NULL, 0,
2278 USB_CTRL_SET_TIMEOUT);
2279 if (err < 0)
2280 dev_err(&udev->dev,
2281 "set a_alt_hnp_support failed: %d\n",
2282 err);
2285 #endif
2286 return err;
2291 * usb_enumerate_device - Read device configs/intfs/otg (usbcore-internal)
2292 * @udev: newly addressed device (in ADDRESS state)
2294 * This is only called by usb_new_device() and usb_authorize_device()
2295 * and FIXME -- all comments that apply to them apply here wrt to
2296 * environment.
2298 * If the device is WUSB and not authorized, we don't attempt to read
2299 * the string descriptors, as they will be errored out by the device
2300 * until it has been authorized.
2302 * Return: 0 if successful. A negative error code otherwise.
2304 static int usb_enumerate_device(struct usb_device *udev)
2306 int err;
2307 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
2309 if (udev->config == NULL) {
2310 err = usb_get_configuration(udev);
2311 if (err < 0) {
2312 if (err != -ENODEV)
2313 dev_err(&udev->dev, "can't read configurations, error %d\n",
2314 err);
2315 return err;
2319 /* read the standard strings and cache them if present */
2320 udev->product = usb_cache_string(udev, udev->descriptor.iProduct);
2321 udev->manufacturer = usb_cache_string(udev,
2322 udev->descriptor.iManufacturer);
2323 udev->serial = usb_cache_string(udev, udev->descriptor.iSerialNumber);
2325 err = usb_enumerate_device_otg(udev);
2326 if (err < 0)
2327 return err;
2329 if (IS_ENABLED(CONFIG_USB_OTG_WHITELIST) && hcd->tpl_support &&
2330 !is_targeted(udev)) {
2331 /* Maybe it can talk to us, though we can't talk to it.
2332 * (Includes HNP test device.)
2334 if (IS_ENABLED(CONFIG_USB_OTG) && (udev->bus->b_hnp_enable
2335 || udev->bus->is_b_host)) {
2336 err = usb_port_suspend(udev, PMSG_AUTO_SUSPEND);
2337 if (err < 0)
2338 dev_dbg(&udev->dev, "HNP fail, %d\n", err);
2340 return -ENOTSUPP;
2343 usb_detect_interface_quirks(udev);
2345 return 0;
2348 static void set_usb_port_removable(struct usb_device *udev)
2350 struct usb_device *hdev = udev->parent;
2351 struct usb_hub *hub;
2352 u8 port = udev->portnum;
2353 u16 wHubCharacteristics;
2354 bool removable = true;
2356 if (!hdev)
2357 return;
2359 hub = usb_hub_to_struct_hub(udev->parent);
2362 * If the platform firmware has provided information about a port,
2363 * use that to determine whether it's removable.
2365 switch (hub->ports[udev->portnum - 1]->connect_type) {
2366 case USB_PORT_CONNECT_TYPE_HOT_PLUG:
2367 udev->removable = USB_DEVICE_REMOVABLE;
2368 return;
2369 case USB_PORT_CONNECT_TYPE_HARD_WIRED:
2370 case USB_PORT_NOT_USED:
2371 udev->removable = USB_DEVICE_FIXED;
2372 return;
2373 default:
2374 break;
2378 * Otherwise, check whether the hub knows whether a port is removable
2379 * or not
2381 wHubCharacteristics = le16_to_cpu(hub->descriptor->wHubCharacteristics);
2383 if (!(wHubCharacteristics & HUB_CHAR_COMPOUND))
2384 return;
2386 if (hub_is_superspeed(hdev)) {
2387 if (le16_to_cpu(hub->descriptor->u.ss.DeviceRemovable)
2388 & (1 << port))
2389 removable = false;
2390 } else {
2391 if (hub->descriptor->u.hs.DeviceRemovable[port / 8] & (1 << (port % 8)))
2392 removable = false;
2395 if (removable)
2396 udev->removable = USB_DEVICE_REMOVABLE;
2397 else
2398 udev->removable = USB_DEVICE_FIXED;
2403 * usb_new_device - perform initial device setup (usbcore-internal)
2404 * @udev: newly addressed device (in ADDRESS state)
2406 * This is called with devices which have been detected but not fully
2407 * enumerated. The device descriptor is available, but not descriptors
2408 * for any device configuration. The caller must have locked either
2409 * the parent hub (if udev is a normal device) or else the
2410 * usb_bus_idr_lock (if udev is a root hub). The parent's pointer to
2411 * udev has already been installed, but udev is not yet visible through
2412 * sysfs or other filesystem code.
2414 * This call is synchronous, and may not be used in an interrupt context.
2416 * Only the hub driver or root-hub registrar should ever call this.
2418 * Return: Whether the device is configured properly or not. Zero if the
2419 * interface was registered with the driver core; else a negative errno
2420 * value.
2423 int usb_new_device(struct usb_device *udev)
2425 int err;
2427 if (udev->parent) {
2428 /* Initialize non-root-hub device wakeup to disabled;
2429 * device (un)configuration controls wakeup capable
2430 * sysfs power/wakeup controls wakeup enabled/disabled
2432 device_init_wakeup(&udev->dev, 0);
2435 /* Tell the runtime-PM framework the device is active */
2436 pm_runtime_set_active(&udev->dev);
2437 pm_runtime_get_noresume(&udev->dev);
2438 pm_runtime_use_autosuspend(&udev->dev);
2439 pm_runtime_enable(&udev->dev);
2441 /* By default, forbid autosuspend for all devices. It will be
2442 * allowed for hubs during binding.
2444 usb_disable_autosuspend(udev);
2446 err = usb_enumerate_device(udev); /* Read descriptors */
2447 if (err < 0)
2448 goto fail;
2449 dev_dbg(&udev->dev, "udev %d, busnum %d, minor = %d\n",
2450 udev->devnum, udev->bus->busnum,
2451 (((udev->bus->busnum-1) * 128) + (udev->devnum-1)));
2452 /* export the usbdev device-node for libusb */
2453 udev->dev.devt = MKDEV(USB_DEVICE_MAJOR,
2454 (((udev->bus->busnum-1) * 128) + (udev->devnum-1)));
2456 /* Tell the world! */
2457 announce_device(udev);
2459 if (udev->serial)
2460 add_device_randomness(udev->serial, strlen(udev->serial));
2461 if (udev->product)
2462 add_device_randomness(udev->product, strlen(udev->product));
2463 if (udev->manufacturer)
2464 add_device_randomness(udev->manufacturer,
2465 strlen(udev->manufacturer));
2467 device_enable_async_suspend(&udev->dev);
2469 /* check whether the hub or firmware marks this port as non-removable */
2470 if (udev->parent)
2471 set_usb_port_removable(udev);
2473 /* Register the device. The device driver is responsible
2474 * for configuring the device and invoking the add-device
2475 * notifier chain (used by usbfs and possibly others).
2477 err = device_add(&udev->dev);
2478 if (err) {
2479 dev_err(&udev->dev, "can't device_add, error %d\n", err);
2480 goto fail;
2483 /* Create link files between child device and usb port device. */
2484 if (udev->parent) {
2485 struct usb_hub *hub = usb_hub_to_struct_hub(udev->parent);
2486 int port1 = udev->portnum;
2487 struct usb_port *port_dev = hub->ports[port1 - 1];
2489 err = sysfs_create_link(&udev->dev.kobj,
2490 &port_dev->dev.kobj, "port");
2491 if (err)
2492 goto fail;
2494 err = sysfs_create_link(&port_dev->dev.kobj,
2495 &udev->dev.kobj, "device");
2496 if (err) {
2497 sysfs_remove_link(&udev->dev.kobj, "port");
2498 goto fail;
2501 if (!test_and_set_bit(port1, hub->child_usage_bits))
2502 pm_runtime_get_sync(&port_dev->dev);
2505 (void) usb_create_ep_devs(&udev->dev, &udev->ep0, udev);
2506 usb_mark_last_busy(udev);
2507 pm_runtime_put_sync_autosuspend(&udev->dev);
2508 return err;
2510 fail:
2511 usb_set_device_state(udev, USB_STATE_NOTATTACHED);
2512 pm_runtime_disable(&udev->dev);
2513 pm_runtime_set_suspended(&udev->dev);
2514 return err;
2519 * usb_deauthorize_device - deauthorize a device (usbcore-internal)
2520 * @usb_dev: USB device
2522 * Move the USB device to a very basic state where interfaces are disabled
2523 * and the device is in fact unconfigured and unusable.
2525 * We share a lock (that we have) with device_del(), so we need to
2526 * defer its call.
2528 * Return: 0.
2530 int usb_deauthorize_device(struct usb_device *usb_dev)
2532 usb_lock_device(usb_dev);
2533 if (usb_dev->authorized == 0)
2534 goto out_unauthorized;
2536 usb_dev->authorized = 0;
2537 usb_set_configuration(usb_dev, -1);
2539 out_unauthorized:
2540 usb_unlock_device(usb_dev);
2541 return 0;
2545 int usb_authorize_device(struct usb_device *usb_dev)
2547 int result = 0, c;
2549 usb_lock_device(usb_dev);
2550 if (usb_dev->authorized == 1)
2551 goto out_authorized;
2553 result = usb_autoresume_device(usb_dev);
2554 if (result < 0) {
2555 dev_err(&usb_dev->dev,
2556 "can't autoresume for authorization: %d\n", result);
2557 goto error_autoresume;
2560 if (usb_dev->wusb) {
2561 result = usb_get_device_descriptor(usb_dev, sizeof(usb_dev->descriptor));
2562 if (result < 0) {
2563 dev_err(&usb_dev->dev, "can't re-read device descriptor for "
2564 "authorization: %d\n", result);
2565 goto error_device_descriptor;
2569 usb_dev->authorized = 1;
2570 /* Choose and set the configuration. This registers the interfaces
2571 * with the driver core and lets interface drivers bind to them.
2573 c = usb_choose_configuration(usb_dev);
2574 if (c >= 0) {
2575 result = usb_set_configuration(usb_dev, c);
2576 if (result) {
2577 dev_err(&usb_dev->dev,
2578 "can't set config #%d, error %d\n", c, result);
2579 /* This need not be fatal. The user can try to
2580 * set other configurations. */
2583 dev_info(&usb_dev->dev, "authorized to connect\n");
2585 error_device_descriptor:
2586 usb_autosuspend_device(usb_dev);
2587 error_autoresume:
2588 out_authorized:
2589 usb_unlock_device(usb_dev); /* complements locktree */
2590 return result;
2594 * Return 1 if port speed is SuperSpeedPlus, 0 otherwise
2595 * check it from the link protocol field of the current speed ID attribute.
2596 * current speed ID is got from ext port status request. Sublink speed attribute
2597 * table is returned with the hub BOS SSP device capability descriptor
2599 static int port_speed_is_ssp(struct usb_device *hdev, int speed_id)
2601 int ssa_count;
2602 u32 ss_attr;
2603 int i;
2604 struct usb_ssp_cap_descriptor *ssp_cap = hdev->bos->ssp_cap;
2606 if (!ssp_cap)
2607 return 0;
2609 ssa_count = le32_to_cpu(ssp_cap->bmAttributes) &
2610 USB_SSP_SUBLINK_SPEED_ATTRIBS;
2612 for (i = 0; i <= ssa_count; i++) {
2613 ss_attr = le32_to_cpu(ssp_cap->bmSublinkSpeedAttr[i]);
2614 if (speed_id == (ss_attr & USB_SSP_SUBLINK_SPEED_SSID))
2615 return !!(ss_attr & USB_SSP_SUBLINK_SPEED_LP);
2617 return 0;
2620 /* Returns 1 if @hub is a WUSB root hub, 0 otherwise */
2621 static unsigned hub_is_wusb(struct usb_hub *hub)
2623 struct usb_hcd *hcd;
2624 if (hub->hdev->parent != NULL) /* not a root hub? */
2625 return 0;
2626 hcd = bus_to_hcd(hub->hdev->bus);
2627 return hcd->wireless;
2631 #define PORT_RESET_TRIES 5
2632 #define SET_ADDRESS_TRIES 2
2633 #define GET_DESCRIPTOR_TRIES 2
2634 #define SET_CONFIG_TRIES (2 * (use_both_schemes + 1))
2635 #define USE_NEW_SCHEME(i) ((i) / 2 == (int)old_scheme_first)
2637 #define HUB_ROOT_RESET_TIME 60 /* times are in msec */
2638 #define HUB_SHORT_RESET_TIME 10
2639 #define HUB_BH_RESET_TIME 50
2640 #define HUB_LONG_RESET_TIME 200
2641 #define HUB_RESET_TIMEOUT 800
2644 * "New scheme" enumeration causes an extra state transition to be
2645 * exposed to an xhci host and causes USB3 devices to receive control
2646 * commands in the default state. This has been seen to cause
2647 * enumeration failures, so disable this enumeration scheme for USB3
2648 * devices.
2650 static bool use_new_scheme(struct usb_device *udev, int retry)
2652 if (udev->speed >= USB_SPEED_SUPER)
2653 return false;
2655 return USE_NEW_SCHEME(retry);
2658 /* Is a USB 3.0 port in the Inactive or Compliance Mode state?
2659 * Port worm reset is required to recover
2661 static bool hub_port_warm_reset_required(struct usb_hub *hub, int port1,
2662 u16 portstatus)
2664 u16 link_state;
2666 if (!hub_is_superspeed(hub->hdev))
2667 return false;
2669 if (test_bit(port1, hub->warm_reset_bits))
2670 return true;
2672 link_state = portstatus & USB_PORT_STAT_LINK_STATE;
2673 return link_state == USB_SS_PORT_LS_SS_INACTIVE
2674 || link_state == USB_SS_PORT_LS_COMP_MOD;
2677 static int hub_port_wait_reset(struct usb_hub *hub, int port1,
2678 struct usb_device *udev, unsigned int delay, bool warm)
2680 int delay_time, ret;
2681 u16 portstatus;
2682 u16 portchange;
2683 u32 ext_portstatus = 0;
2685 for (delay_time = 0;
2686 delay_time < HUB_RESET_TIMEOUT;
2687 delay_time += delay) {
2688 /* wait to give the device a chance to reset */
2689 msleep(delay);
2691 /* read and decode port status */
2692 if (hub_is_superspeedplus(hub->hdev))
2693 ret = hub_ext_port_status(hub, port1,
2694 HUB_EXT_PORT_STATUS,
2695 &portstatus, &portchange,
2696 &ext_portstatus);
2697 else
2698 ret = hub_port_status(hub, port1, &portstatus,
2699 &portchange);
2700 if (ret < 0)
2701 return ret;
2704 * The port state is unknown until the reset completes.
2706 * On top of that, some chips may require additional time
2707 * to re-establish a connection after the reset is complete,
2708 * so also wait for the connection to be re-established.
2710 if (!(portstatus & USB_PORT_STAT_RESET) &&
2711 (portstatus & USB_PORT_STAT_CONNECTION))
2712 break;
2714 /* switch to the long delay after two short delay failures */
2715 if (delay_time >= 2 * HUB_SHORT_RESET_TIME)
2716 delay = HUB_LONG_RESET_TIME;
2718 dev_dbg(&hub->ports[port1 - 1]->dev,
2719 "not %sreset yet, waiting %dms\n",
2720 warm ? "warm " : "", delay);
2723 if ((portstatus & USB_PORT_STAT_RESET))
2724 return -EBUSY;
2726 if (hub_port_warm_reset_required(hub, port1, portstatus))
2727 return -ENOTCONN;
2729 /* Device went away? */
2730 if (!(portstatus & USB_PORT_STAT_CONNECTION))
2731 return -ENOTCONN;
2733 /* Retry if connect change is set but status is still connected.
2734 * A USB 3.0 connection may bounce if multiple warm resets were issued,
2735 * but the device may have successfully re-connected. Ignore it.
2737 if (!hub_is_superspeed(hub->hdev) &&
2738 (portchange & USB_PORT_STAT_C_CONNECTION)) {
2739 usb_clear_port_feature(hub->hdev, port1,
2740 USB_PORT_FEAT_C_CONNECTION);
2741 return -EAGAIN;
2744 if (!(portstatus & USB_PORT_STAT_ENABLE))
2745 return -EBUSY;
2747 if (!udev)
2748 return 0;
2750 if (hub_is_wusb(hub))
2751 udev->speed = USB_SPEED_WIRELESS;
2752 else if (hub_is_superspeedplus(hub->hdev) &&
2753 port_speed_is_ssp(hub->hdev, ext_portstatus &
2754 USB_EXT_PORT_STAT_RX_SPEED_ID))
2755 udev->speed = USB_SPEED_SUPER_PLUS;
2756 else if (hub_is_superspeed(hub->hdev))
2757 udev->speed = USB_SPEED_SUPER;
2758 else if (portstatus & USB_PORT_STAT_HIGH_SPEED)
2759 udev->speed = USB_SPEED_HIGH;
2760 else if (portstatus & USB_PORT_STAT_LOW_SPEED)
2761 udev->speed = USB_SPEED_LOW;
2762 else
2763 udev->speed = USB_SPEED_FULL;
2764 return 0;
2767 /* Handle port reset and port warm(BH) reset (for USB3 protocol ports) */
2768 static int hub_port_reset(struct usb_hub *hub, int port1,
2769 struct usb_device *udev, unsigned int delay, bool warm)
2771 int i, status;
2772 u16 portchange, portstatus;
2773 struct usb_port *port_dev = hub->ports[port1 - 1];
2775 if (!hub_is_superspeed(hub->hdev)) {
2776 if (warm) {
2777 dev_err(hub->intfdev, "only USB3 hub support "
2778 "warm reset\n");
2779 return -EINVAL;
2781 /* Block EHCI CF initialization during the port reset.
2782 * Some companion controllers don't like it when they mix.
2784 down_read(&ehci_cf_port_reset_rwsem);
2785 } else if (!warm) {
2787 * If the caller hasn't explicitly requested a warm reset,
2788 * double check and see if one is needed.
2790 if (hub_port_status(hub, port1, &portstatus, &portchange) == 0)
2791 if (hub_port_warm_reset_required(hub, port1,
2792 portstatus))
2793 warm = true;
2795 clear_bit(port1, hub->warm_reset_bits);
2797 /* Reset the port */
2798 for (i = 0; i < PORT_RESET_TRIES; i++) {
2799 status = set_port_feature(hub->hdev, port1, (warm ?
2800 USB_PORT_FEAT_BH_PORT_RESET :
2801 USB_PORT_FEAT_RESET));
2802 if (status == -ENODEV) {
2803 ; /* The hub is gone */
2804 } else if (status) {
2805 dev_err(&port_dev->dev,
2806 "cannot %sreset (err = %d)\n",
2807 warm ? "warm " : "", status);
2808 } else {
2809 status = hub_port_wait_reset(hub, port1, udev, delay,
2810 warm);
2811 if (status && status != -ENOTCONN && status != -ENODEV)
2812 dev_dbg(hub->intfdev,
2813 "port_wait_reset: err = %d\n",
2814 status);
2817 /* Check for disconnect or reset */
2818 if (status == 0 || status == -ENOTCONN || status == -ENODEV) {
2819 usb_clear_port_feature(hub->hdev, port1,
2820 USB_PORT_FEAT_C_RESET);
2822 if (!hub_is_superspeed(hub->hdev))
2823 goto done;
2825 usb_clear_port_feature(hub->hdev, port1,
2826 USB_PORT_FEAT_C_BH_PORT_RESET);
2827 usb_clear_port_feature(hub->hdev, port1,
2828 USB_PORT_FEAT_C_PORT_LINK_STATE);
2829 usb_clear_port_feature(hub->hdev, port1,
2830 USB_PORT_FEAT_C_CONNECTION);
2833 * If a USB 3.0 device migrates from reset to an error
2834 * state, re-issue the warm reset.
2836 if (hub_port_status(hub, port1,
2837 &portstatus, &portchange) < 0)
2838 goto done;
2840 if (!hub_port_warm_reset_required(hub, port1,
2841 portstatus))
2842 goto done;
2845 * If the port is in SS.Inactive or Compliance Mode, the
2846 * hot or warm reset failed. Try another warm reset.
2848 if (!warm) {
2849 dev_dbg(&port_dev->dev,
2850 "hot reset failed, warm reset\n");
2851 warm = true;
2855 dev_dbg(&port_dev->dev,
2856 "not enabled, trying %sreset again...\n",
2857 warm ? "warm " : "");
2858 delay = HUB_LONG_RESET_TIME;
2861 dev_err(&port_dev->dev, "Cannot enable. Maybe the USB cable is bad?\n");
2863 done:
2864 if (status == 0) {
2865 /* TRSTRCY = 10 ms; plus some extra */
2866 msleep(10 + 40);
2867 if (udev) {
2868 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
2870 update_devnum(udev, 0);
2871 /* The xHC may think the device is already reset,
2872 * so ignore the status.
2874 if (hcd->driver->reset_device)
2875 hcd->driver->reset_device(hcd, udev);
2877 usb_set_device_state(udev, USB_STATE_DEFAULT);
2879 } else {
2880 if (udev)
2881 usb_set_device_state(udev, USB_STATE_NOTATTACHED);
2884 if (!hub_is_superspeed(hub->hdev))
2885 up_read(&ehci_cf_port_reset_rwsem);
2887 return status;
2890 /* Check if a port is power on */
2891 static int port_is_power_on(struct usb_hub *hub, unsigned portstatus)
2893 int ret = 0;
2895 if (hub_is_superspeed(hub->hdev)) {
2896 if (portstatus & USB_SS_PORT_STAT_POWER)
2897 ret = 1;
2898 } else {
2899 if (portstatus & USB_PORT_STAT_POWER)
2900 ret = 1;
2903 return ret;
2906 static void usb_lock_port(struct usb_port *port_dev)
2907 __acquires(&port_dev->status_lock)
2909 mutex_lock(&port_dev->status_lock);
2910 __acquire(&port_dev->status_lock);
2913 static void usb_unlock_port(struct usb_port *port_dev)
2914 __releases(&port_dev->status_lock)
2916 mutex_unlock(&port_dev->status_lock);
2917 __release(&port_dev->status_lock);
2920 #ifdef CONFIG_PM
2922 /* Check if a port is suspended(USB2.0 port) or in U3 state(USB3.0 port) */
2923 static int port_is_suspended(struct usb_hub *hub, unsigned portstatus)
2925 int ret = 0;
2927 if (hub_is_superspeed(hub->hdev)) {
2928 if ((portstatus & USB_PORT_STAT_LINK_STATE)
2929 == USB_SS_PORT_LS_U3)
2930 ret = 1;
2931 } else {
2932 if (portstatus & USB_PORT_STAT_SUSPEND)
2933 ret = 1;
2936 return ret;
2939 /* Determine whether the device on a port is ready for a normal resume,
2940 * is ready for a reset-resume, or should be disconnected.
2942 static int check_port_resume_type(struct usb_device *udev,
2943 struct usb_hub *hub, int port1,
2944 int status, u16 portchange, u16 portstatus)
2946 struct usb_port *port_dev = hub->ports[port1 - 1];
2947 int retries = 3;
2949 retry:
2950 /* Is a warm reset needed to recover the connection? */
2951 if (status == 0 && udev->reset_resume
2952 && hub_port_warm_reset_required(hub, port1, portstatus)) {
2953 /* pass */;
2955 /* Is the device still present? */
2956 else if (status || port_is_suspended(hub, portstatus) ||
2957 !port_is_power_on(hub, portstatus)) {
2958 if (status >= 0)
2959 status = -ENODEV;
2960 } else if (!(portstatus & USB_PORT_STAT_CONNECTION)) {
2961 if (retries--) {
2962 usleep_range(200, 300);
2963 status = hub_port_status(hub, port1, &portstatus,
2964 &portchange);
2965 goto retry;
2967 status = -ENODEV;
2970 /* Can't do a normal resume if the port isn't enabled,
2971 * so try a reset-resume instead.
2973 else if (!(portstatus & USB_PORT_STAT_ENABLE) && !udev->reset_resume) {
2974 if (udev->persist_enabled)
2975 udev->reset_resume = 1;
2976 else
2977 status = -ENODEV;
2980 if (status) {
2981 dev_dbg(&port_dev->dev, "status %04x.%04x after resume, %d\n",
2982 portchange, portstatus, status);
2983 } else if (udev->reset_resume) {
2985 /* Late port handoff can set status-change bits */
2986 if (portchange & USB_PORT_STAT_C_CONNECTION)
2987 usb_clear_port_feature(hub->hdev, port1,
2988 USB_PORT_FEAT_C_CONNECTION);
2989 if (portchange & USB_PORT_STAT_C_ENABLE)
2990 usb_clear_port_feature(hub->hdev, port1,
2991 USB_PORT_FEAT_C_ENABLE);
2994 return status;
2997 int usb_disable_ltm(struct usb_device *udev)
2999 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
3001 /* Check if the roothub and device supports LTM. */
3002 if (!usb_device_supports_ltm(hcd->self.root_hub) ||
3003 !usb_device_supports_ltm(udev))
3004 return 0;
3006 /* Clear Feature LTM Enable can only be sent if the device is
3007 * configured.
3009 if (!udev->actconfig)
3010 return 0;
3012 return usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3013 USB_REQ_CLEAR_FEATURE, USB_RECIP_DEVICE,
3014 USB_DEVICE_LTM_ENABLE, 0, NULL, 0,
3015 USB_CTRL_SET_TIMEOUT);
3017 EXPORT_SYMBOL_GPL(usb_disable_ltm);
3019 void usb_enable_ltm(struct usb_device *udev)
3021 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
3023 /* Check if the roothub and device supports LTM. */
3024 if (!usb_device_supports_ltm(hcd->self.root_hub) ||
3025 !usb_device_supports_ltm(udev))
3026 return;
3028 /* Set Feature LTM Enable can only be sent if the device is
3029 * configured.
3031 if (!udev->actconfig)
3032 return;
3034 usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3035 USB_REQ_SET_FEATURE, USB_RECIP_DEVICE,
3036 USB_DEVICE_LTM_ENABLE, 0, NULL, 0,
3037 USB_CTRL_SET_TIMEOUT);
3039 EXPORT_SYMBOL_GPL(usb_enable_ltm);
3042 * usb_enable_remote_wakeup - enable remote wakeup for a device
3043 * @udev: target device
3045 * For USB-2 devices: Set the device's remote wakeup feature.
3047 * For USB-3 devices: Assume there's only one function on the device and
3048 * enable remote wake for the first interface. FIXME if the interface
3049 * association descriptor shows there's more than one function.
3051 static int usb_enable_remote_wakeup(struct usb_device *udev)
3053 if (udev->speed < USB_SPEED_SUPER)
3054 return usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3055 USB_REQ_SET_FEATURE, USB_RECIP_DEVICE,
3056 USB_DEVICE_REMOTE_WAKEUP, 0, NULL, 0,
3057 USB_CTRL_SET_TIMEOUT);
3058 else
3059 return usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3060 USB_REQ_SET_FEATURE, USB_RECIP_INTERFACE,
3061 USB_INTRF_FUNC_SUSPEND,
3062 USB_INTRF_FUNC_SUSPEND_RW |
3063 USB_INTRF_FUNC_SUSPEND_LP,
3064 NULL, 0, USB_CTRL_SET_TIMEOUT);
3068 * usb_disable_remote_wakeup - disable remote wakeup for a device
3069 * @udev: target device
3071 * For USB-2 devices: Clear the device's remote wakeup feature.
3073 * For USB-3 devices: Assume there's only one function on the device and
3074 * disable remote wake for the first interface. FIXME if the interface
3075 * association descriptor shows there's more than one function.
3077 static int usb_disable_remote_wakeup(struct usb_device *udev)
3079 if (udev->speed < USB_SPEED_SUPER)
3080 return usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3081 USB_REQ_CLEAR_FEATURE, USB_RECIP_DEVICE,
3082 USB_DEVICE_REMOTE_WAKEUP, 0, NULL, 0,
3083 USB_CTRL_SET_TIMEOUT);
3084 else
3085 return usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3086 USB_REQ_SET_FEATURE, USB_RECIP_INTERFACE,
3087 USB_INTRF_FUNC_SUSPEND, 0, NULL, 0,
3088 USB_CTRL_SET_TIMEOUT);
3091 /* Count of wakeup-enabled devices at or below udev */
3092 static unsigned wakeup_enabled_descendants(struct usb_device *udev)
3094 struct usb_hub *hub = usb_hub_to_struct_hub(udev);
3096 return udev->do_remote_wakeup +
3097 (hub ? hub->wakeup_enabled_descendants : 0);
3101 * usb_port_suspend - suspend a usb device's upstream port
3102 * @udev: device that's no longer in active use, not a root hub
3103 * Context: must be able to sleep; device not locked; pm locks held
3105 * Suspends a USB device that isn't in active use, conserving power.
3106 * Devices may wake out of a suspend, if anything important happens,
3107 * using the remote wakeup mechanism. They may also be taken out of
3108 * suspend by the host, using usb_port_resume(). It's also routine
3109 * to disconnect devices while they are suspended.
3111 * This only affects the USB hardware for a device; its interfaces
3112 * (and, for hubs, child devices) must already have been suspended.
3114 * Selective port suspend reduces power; most suspended devices draw
3115 * less than 500 uA. It's also used in OTG, along with remote wakeup.
3116 * All devices below the suspended port are also suspended.
3118 * Devices leave suspend state when the host wakes them up. Some devices
3119 * also support "remote wakeup", where the device can activate the USB
3120 * tree above them to deliver data, such as a keypress or packet. In
3121 * some cases, this wakes the USB host.
3123 * Suspending OTG devices may trigger HNP, if that's been enabled
3124 * between a pair of dual-role devices. That will change roles, such
3125 * as from A-Host to A-Peripheral or from B-Host back to B-Peripheral.
3127 * Devices on USB hub ports have only one "suspend" state, corresponding
3128 * to ACPI D2, "may cause the device to lose some context".
3129 * State transitions include:
3131 * - suspend, resume ... when the VBUS power link stays live
3132 * - suspend, disconnect ... VBUS lost
3134 * Once VBUS drop breaks the circuit, the port it's using has to go through
3135 * normal re-enumeration procedures, starting with enabling VBUS power.
3136 * Other than re-initializing the hub (plug/unplug, except for root hubs),
3137 * Linux (2.6) currently has NO mechanisms to initiate that: no hub_wq
3138 * timer, no SRP, no requests through sysfs.
3140 * If Runtime PM isn't enabled or used, non-SuperSpeed devices may not get
3141 * suspended until their bus goes into global suspend (i.e., the root
3142 * hub is suspended). Nevertheless, we change @udev->state to
3143 * USB_STATE_SUSPENDED as this is the device's "logical" state. The actual
3144 * upstream port setting is stored in @udev->port_is_suspended.
3146 * Returns 0 on success, else negative errno.
3148 int usb_port_suspend(struct usb_device *udev, pm_message_t msg)
3150 struct usb_hub *hub = usb_hub_to_struct_hub(udev->parent);
3151 struct usb_port *port_dev = hub->ports[udev->portnum - 1];
3152 int port1 = udev->portnum;
3153 int status;
3154 bool really_suspend = true;
3156 usb_lock_port(port_dev);
3158 /* enable remote wakeup when appropriate; this lets the device
3159 * wake up the upstream hub (including maybe the root hub).
3161 * NOTE: OTG devices may issue remote wakeup (or SRP) even when
3162 * we don't explicitly enable it here.
3164 if (udev->do_remote_wakeup) {
3165 status = usb_enable_remote_wakeup(udev);
3166 if (status) {
3167 dev_dbg(&udev->dev, "won't remote wakeup, status %d\n",
3168 status);
3169 /* bail if autosuspend is requested */
3170 if (PMSG_IS_AUTO(msg))
3171 goto err_wakeup;
3175 /* disable USB2 hardware LPM */
3176 if (udev->usb2_hw_lpm_enabled == 1)
3177 usb_set_usb2_hardware_lpm(udev, 0);
3179 if (usb_disable_ltm(udev)) {
3180 dev_err(&udev->dev, "Failed to disable LTM before suspend\n");
3181 status = -ENOMEM;
3182 if (PMSG_IS_AUTO(msg))
3183 goto err_ltm;
3186 /* see 7.1.7.6 */
3187 if (hub_is_superspeed(hub->hdev))
3188 status = hub_set_port_link_state(hub, port1, USB_SS_PORT_LS_U3);
3191 * For system suspend, we do not need to enable the suspend feature
3192 * on individual USB-2 ports. The devices will automatically go
3193 * into suspend a few ms after the root hub stops sending packets.
3194 * The USB 2.0 spec calls this "global suspend".
3196 * However, many USB hubs have a bug: They don't relay wakeup requests
3197 * from a downstream port if the port's suspend feature isn't on.
3198 * Therefore we will turn on the suspend feature if udev or any of its
3199 * descendants is enabled for remote wakeup.
3201 else if (PMSG_IS_AUTO(msg) || wakeup_enabled_descendants(udev) > 0)
3202 status = set_port_feature(hub->hdev, port1,
3203 USB_PORT_FEAT_SUSPEND);
3204 else {
3205 really_suspend = false;
3206 status = 0;
3208 if (status) {
3209 dev_dbg(&port_dev->dev, "can't suspend, status %d\n", status);
3211 /* Try to enable USB3 LTM again */
3212 usb_enable_ltm(udev);
3213 err_ltm:
3214 /* Try to enable USB2 hardware LPM again */
3215 if (udev->usb2_hw_lpm_capable == 1)
3216 usb_set_usb2_hardware_lpm(udev, 1);
3218 if (udev->do_remote_wakeup)
3219 (void) usb_disable_remote_wakeup(udev);
3220 err_wakeup:
3222 /* System sleep transitions should never fail */
3223 if (!PMSG_IS_AUTO(msg))
3224 status = 0;
3225 } else {
3226 dev_dbg(&udev->dev, "usb %ssuspend, wakeup %d\n",
3227 (PMSG_IS_AUTO(msg) ? "auto-" : ""),
3228 udev->do_remote_wakeup);
3229 if (really_suspend) {
3230 udev->port_is_suspended = 1;
3232 /* device has up to 10 msec to fully suspend */
3233 msleep(10);
3235 usb_set_device_state(udev, USB_STATE_SUSPENDED);
3238 if (status == 0 && !udev->do_remote_wakeup && udev->persist_enabled
3239 && test_and_clear_bit(port1, hub->child_usage_bits))
3240 pm_runtime_put_sync(&port_dev->dev);
3242 usb_mark_last_busy(hub->hdev);
3244 usb_unlock_port(port_dev);
3245 return status;
3249 * If the USB "suspend" state is in use (rather than "global suspend"),
3250 * many devices will be individually taken out of suspend state using
3251 * special "resume" signaling. This routine kicks in shortly after
3252 * hardware resume signaling is finished, either because of selective
3253 * resume (by host) or remote wakeup (by device) ... now see what changed
3254 * in the tree that's rooted at this device.
3256 * If @udev->reset_resume is set then the device is reset before the
3257 * status check is done.
3259 static int finish_port_resume(struct usb_device *udev)
3261 int status = 0;
3262 u16 devstatus = 0;
3264 /* caller owns the udev device lock */
3265 dev_dbg(&udev->dev, "%s\n",
3266 udev->reset_resume ? "finish reset-resume" : "finish resume");
3268 /* usb ch9 identifies four variants of SUSPENDED, based on what
3269 * state the device resumes to. Linux currently won't see the
3270 * first two on the host side; they'd be inside hub_port_init()
3271 * during many timeouts, but hub_wq can't suspend until later.
3273 usb_set_device_state(udev, udev->actconfig
3274 ? USB_STATE_CONFIGURED
3275 : USB_STATE_ADDRESS);
3277 /* 10.5.4.5 says not to reset a suspended port if the attached
3278 * device is enabled for remote wakeup. Hence the reset
3279 * operation is carried out here, after the port has been
3280 * resumed.
3282 if (udev->reset_resume) {
3284 * If the device morphs or switches modes when it is reset,
3285 * we don't want to perform a reset-resume. We'll fail the
3286 * resume, which will cause a logical disconnect, and then
3287 * the device will be rediscovered.
3289 retry_reset_resume:
3290 if (udev->quirks & USB_QUIRK_RESET)
3291 status = -ENODEV;
3292 else
3293 status = usb_reset_and_verify_device(udev);
3296 /* 10.5.4.5 says be sure devices in the tree are still there.
3297 * For now let's assume the device didn't go crazy on resume,
3298 * and device drivers will know about any resume quirks.
3300 if (status == 0) {
3301 devstatus = 0;
3302 status = usb_get_std_status(udev, USB_RECIP_DEVICE, 0, &devstatus);
3304 /* If a normal resume failed, try doing a reset-resume */
3305 if (status && !udev->reset_resume && udev->persist_enabled) {
3306 dev_dbg(&udev->dev, "retry with reset-resume\n");
3307 udev->reset_resume = 1;
3308 goto retry_reset_resume;
3312 if (status) {
3313 dev_dbg(&udev->dev, "gone after usb resume? status %d\n",
3314 status);
3316 * There are a few quirky devices which violate the standard
3317 * by claiming to have remote wakeup enabled after a reset,
3318 * which crash if the feature is cleared, hence check for
3319 * udev->reset_resume
3321 } else if (udev->actconfig && !udev->reset_resume) {
3322 if (udev->speed < USB_SPEED_SUPER) {
3323 if (devstatus & (1 << USB_DEVICE_REMOTE_WAKEUP))
3324 status = usb_disable_remote_wakeup(udev);
3325 } else {
3326 status = usb_get_std_status(udev, USB_RECIP_INTERFACE, 0,
3327 &devstatus);
3328 if (!status && devstatus & (USB_INTRF_STAT_FUNC_RW_CAP
3329 | USB_INTRF_STAT_FUNC_RW))
3330 status = usb_disable_remote_wakeup(udev);
3333 if (status)
3334 dev_dbg(&udev->dev,
3335 "disable remote wakeup, status %d\n",
3336 status);
3337 status = 0;
3339 return status;
3343 * There are some SS USB devices which take longer time for link training.
3344 * XHCI specs 4.19.4 says that when Link training is successful, port
3345 * sets CCS bit to 1. So if SW reads port status before successful link
3346 * training, then it will not find device to be present.
3347 * USB Analyzer log with such buggy devices show that in some cases
3348 * device switch on the RX termination after long delay of host enabling
3349 * the VBUS. In few other cases it has been seen that device fails to
3350 * negotiate link training in first attempt. It has been
3351 * reported till now that few devices take as long as 2000 ms to train
3352 * the link after host enabling its VBUS and termination. Following
3353 * routine implements a 2000 ms timeout for link training. If in a case
3354 * link trains before timeout, loop will exit earlier.
3356 * There are also some 2.0 hard drive based devices and 3.0 thumb
3357 * drives that, when plugged into a 2.0 only port, take a long
3358 * time to set CCS after VBUS enable.
3360 * FIXME: If a device was connected before suspend, but was removed
3361 * while system was asleep, then the loop in the following routine will
3362 * only exit at timeout.
3364 * This routine should only be called when persist is enabled.
3366 static int wait_for_connected(struct usb_device *udev,
3367 struct usb_hub *hub, int *port1,
3368 u16 *portchange, u16 *portstatus)
3370 int status = 0, delay_ms = 0;
3372 while (delay_ms < 2000) {
3373 if (status || *portstatus & USB_PORT_STAT_CONNECTION)
3374 break;
3375 msleep(20);
3376 delay_ms += 20;
3377 status = hub_port_status(hub, *port1, portstatus, portchange);
3379 dev_dbg(&udev->dev, "Waited %dms for CONNECT\n", delay_ms);
3380 return status;
3384 * usb_port_resume - re-activate a suspended usb device's upstream port
3385 * @udev: device to re-activate, not a root hub
3386 * Context: must be able to sleep; device not locked; pm locks held
3388 * This will re-activate the suspended device, increasing power usage
3389 * while letting drivers communicate again with its endpoints.
3390 * USB resume explicitly guarantees that the power session between
3391 * the host and the device is the same as it was when the device
3392 * suspended.
3394 * If @udev->reset_resume is set then this routine won't check that the
3395 * port is still enabled. Furthermore, finish_port_resume() above will
3396 * reset @udev. The end result is that a broken power session can be
3397 * recovered and @udev will appear to persist across a loss of VBUS power.
3399 * For example, if a host controller doesn't maintain VBUS suspend current
3400 * during a system sleep or is reset when the system wakes up, all the USB
3401 * power sessions below it will be broken. This is especially troublesome
3402 * for mass-storage devices containing mounted filesystems, since the
3403 * device will appear to have disconnected and all the memory mappings
3404 * to it will be lost. Using the USB_PERSIST facility, the device can be
3405 * made to appear as if it had not disconnected.
3407 * This facility can be dangerous. Although usb_reset_and_verify_device() makes
3408 * every effort to insure that the same device is present after the
3409 * reset as before, it cannot provide a 100% guarantee. Furthermore it's
3410 * quite possible for a device to remain unaltered but its media to be
3411 * changed. If the user replaces a flash memory card while the system is
3412 * asleep, he will have only himself to blame when the filesystem on the
3413 * new card is corrupted and the system crashes.
3415 * Returns 0 on success, else negative errno.
3417 int usb_port_resume(struct usb_device *udev, pm_message_t msg)
3419 struct usb_hub *hub = usb_hub_to_struct_hub(udev->parent);
3420 struct usb_port *port_dev = hub->ports[udev->portnum - 1];
3421 int port1 = udev->portnum;
3422 int status;
3423 u16 portchange, portstatus;
3425 if (!test_and_set_bit(port1, hub->child_usage_bits)) {
3426 status = pm_runtime_get_sync(&port_dev->dev);
3427 if (status < 0) {
3428 dev_dbg(&udev->dev, "can't resume usb port, status %d\n",
3429 status);
3430 return status;
3434 usb_lock_port(port_dev);
3436 /* Skip the initial Clear-Suspend step for a remote wakeup */
3437 status = hub_port_status(hub, port1, &portstatus, &portchange);
3438 if (status == 0 && !port_is_suspended(hub, portstatus)) {
3439 if (portchange & USB_PORT_STAT_C_SUSPEND)
3440 pm_wakeup_event(&udev->dev, 0);
3441 goto SuspendCleared;
3444 /* see 7.1.7.7; affects power usage, but not budgeting */
3445 if (hub_is_superspeed(hub->hdev))
3446 status = hub_set_port_link_state(hub, port1, USB_SS_PORT_LS_U0);
3447 else
3448 status = usb_clear_port_feature(hub->hdev,
3449 port1, USB_PORT_FEAT_SUSPEND);
3450 if (status) {
3451 dev_dbg(&port_dev->dev, "can't resume, status %d\n", status);
3452 } else {
3453 /* drive resume for USB_RESUME_TIMEOUT msec */
3454 dev_dbg(&udev->dev, "usb %sresume\n",
3455 (PMSG_IS_AUTO(msg) ? "auto-" : ""));
3456 msleep(USB_RESUME_TIMEOUT);
3458 /* Virtual root hubs can trigger on GET_PORT_STATUS to
3459 * stop resume signaling. Then finish the resume
3460 * sequence.
3462 status = hub_port_status(hub, port1, &portstatus, &portchange);
3464 /* TRSMRCY = 10 msec */
3465 msleep(10);
3468 SuspendCleared:
3469 if (status == 0) {
3470 udev->port_is_suspended = 0;
3471 if (hub_is_superspeed(hub->hdev)) {
3472 if (portchange & USB_PORT_STAT_C_LINK_STATE)
3473 usb_clear_port_feature(hub->hdev, port1,
3474 USB_PORT_FEAT_C_PORT_LINK_STATE);
3475 } else {
3476 if (portchange & USB_PORT_STAT_C_SUSPEND)
3477 usb_clear_port_feature(hub->hdev, port1,
3478 USB_PORT_FEAT_C_SUSPEND);
3482 if (udev->persist_enabled)
3483 status = wait_for_connected(udev, hub, &port1, &portchange,
3484 &portstatus);
3486 status = check_port_resume_type(udev,
3487 hub, port1, status, portchange, portstatus);
3488 if (status == 0)
3489 status = finish_port_resume(udev);
3490 if (status < 0) {
3491 dev_dbg(&udev->dev, "can't resume, status %d\n", status);
3492 hub_port_logical_disconnect(hub, port1);
3493 } else {
3494 /* Try to enable USB2 hardware LPM */
3495 if (udev->usb2_hw_lpm_capable == 1)
3496 usb_set_usb2_hardware_lpm(udev, 1);
3498 /* Try to enable USB3 LTM */
3499 usb_enable_ltm(udev);
3502 usb_unlock_port(port_dev);
3504 return status;
3507 int usb_remote_wakeup(struct usb_device *udev)
3509 int status = 0;
3511 usb_lock_device(udev);
3512 if (udev->state == USB_STATE_SUSPENDED) {
3513 dev_dbg(&udev->dev, "usb %sresume\n", "wakeup-");
3514 status = usb_autoresume_device(udev);
3515 if (status == 0) {
3516 /* Let the drivers do their thing, then... */
3517 usb_autosuspend_device(udev);
3520 usb_unlock_device(udev);
3521 return status;
3524 /* Returns 1 if there was a remote wakeup and a connect status change. */
3525 static int hub_handle_remote_wakeup(struct usb_hub *hub, unsigned int port,
3526 u16 portstatus, u16 portchange)
3527 __must_hold(&port_dev->status_lock)
3529 struct usb_port *port_dev = hub->ports[port - 1];
3530 struct usb_device *hdev;
3531 struct usb_device *udev;
3532 int connect_change = 0;
3533 int ret;
3535 hdev = hub->hdev;
3536 udev = port_dev->child;
3537 if (!hub_is_superspeed(hdev)) {
3538 if (!(portchange & USB_PORT_STAT_C_SUSPEND))
3539 return 0;
3540 usb_clear_port_feature(hdev, port, USB_PORT_FEAT_C_SUSPEND);
3541 } else {
3542 if (!udev || udev->state != USB_STATE_SUSPENDED ||
3543 (portstatus & USB_PORT_STAT_LINK_STATE) !=
3544 USB_SS_PORT_LS_U0)
3545 return 0;
3548 if (udev) {
3549 /* TRSMRCY = 10 msec */
3550 msleep(10);
3552 usb_unlock_port(port_dev);
3553 ret = usb_remote_wakeup(udev);
3554 usb_lock_port(port_dev);
3555 if (ret < 0)
3556 connect_change = 1;
3557 } else {
3558 ret = -ENODEV;
3559 hub_port_disable(hub, port, 1);
3561 dev_dbg(&port_dev->dev, "resume, status %d\n", ret);
3562 return connect_change;
3565 static int check_ports_changed(struct usb_hub *hub)
3567 int port1;
3569 for (port1 = 1; port1 <= hub->hdev->maxchild; ++port1) {
3570 u16 portstatus, portchange;
3571 int status;
3573 status = hub_port_status(hub, port1, &portstatus, &portchange);
3574 if (!status && portchange)
3575 return 1;
3577 return 0;
3580 static int hub_suspend(struct usb_interface *intf, pm_message_t msg)
3582 struct usb_hub *hub = usb_get_intfdata(intf);
3583 struct usb_device *hdev = hub->hdev;
3584 unsigned port1;
3585 int status;
3588 * Warn if children aren't already suspended.
3589 * Also, add up the number of wakeup-enabled descendants.
3591 hub->wakeup_enabled_descendants = 0;
3592 for (port1 = 1; port1 <= hdev->maxchild; port1++) {
3593 struct usb_port *port_dev = hub->ports[port1 - 1];
3594 struct usb_device *udev = port_dev->child;
3596 if (udev && udev->can_submit) {
3597 dev_warn(&port_dev->dev, "device %s not suspended yet\n",
3598 dev_name(&udev->dev));
3599 if (PMSG_IS_AUTO(msg))
3600 return -EBUSY;
3602 if (udev)
3603 hub->wakeup_enabled_descendants +=
3604 wakeup_enabled_descendants(udev);
3607 if (hdev->do_remote_wakeup && hub->quirk_check_port_auto_suspend) {
3608 /* check if there are changes pending on hub ports */
3609 if (check_ports_changed(hub)) {
3610 if (PMSG_IS_AUTO(msg))
3611 return -EBUSY;
3612 pm_wakeup_event(&hdev->dev, 2000);
3616 if (hub_is_superspeed(hdev) && hdev->do_remote_wakeup) {
3617 /* Enable hub to send remote wakeup for all ports. */
3618 for (port1 = 1; port1 <= hdev->maxchild; port1++) {
3619 status = set_port_feature(hdev,
3620 port1 |
3621 USB_PORT_FEAT_REMOTE_WAKE_CONNECT |
3622 USB_PORT_FEAT_REMOTE_WAKE_DISCONNECT |
3623 USB_PORT_FEAT_REMOTE_WAKE_OVER_CURRENT,
3624 USB_PORT_FEAT_REMOTE_WAKE_MASK);
3628 dev_dbg(&intf->dev, "%s\n", __func__);
3630 /* stop hub_wq and related activity */
3631 hub_quiesce(hub, HUB_SUSPEND);
3632 return 0;
3635 static int hub_resume(struct usb_interface *intf)
3637 struct usb_hub *hub = usb_get_intfdata(intf);
3639 dev_dbg(&intf->dev, "%s\n", __func__);
3640 hub_activate(hub, HUB_RESUME);
3641 return 0;
3644 static int hub_reset_resume(struct usb_interface *intf)
3646 struct usb_hub *hub = usb_get_intfdata(intf);
3648 dev_dbg(&intf->dev, "%s\n", __func__);
3649 hub_activate(hub, HUB_RESET_RESUME);
3650 return 0;
3654 * usb_root_hub_lost_power - called by HCD if the root hub lost Vbus power
3655 * @rhdev: struct usb_device for the root hub
3657 * The USB host controller driver calls this function when its root hub
3658 * is resumed and Vbus power has been interrupted or the controller
3659 * has been reset. The routine marks @rhdev as having lost power.
3660 * When the hub driver is resumed it will take notice and carry out
3661 * power-session recovery for all the "USB-PERSIST"-enabled child devices;
3662 * the others will be disconnected.
3664 void usb_root_hub_lost_power(struct usb_device *rhdev)
3666 dev_warn(&rhdev->dev, "root hub lost power or was reset\n");
3667 rhdev->reset_resume = 1;
3669 EXPORT_SYMBOL_GPL(usb_root_hub_lost_power);
3671 static const char * const usb3_lpm_names[] = {
3672 "U0",
3673 "U1",
3674 "U2",
3675 "U3",
3679 * Send a Set SEL control transfer to the device, prior to enabling
3680 * device-initiated U1 or U2. This lets the device know the exit latencies from
3681 * the time the device initiates a U1 or U2 exit, to the time it will receive a
3682 * packet from the host.
3684 * This function will fail if the SEL or PEL values for udev are greater than
3685 * the maximum allowed values for the link state to be enabled.
3687 static int usb_req_set_sel(struct usb_device *udev, enum usb3_link_state state)
3689 struct usb_set_sel_req *sel_values;
3690 unsigned long long u1_sel;
3691 unsigned long long u1_pel;
3692 unsigned long long u2_sel;
3693 unsigned long long u2_pel;
3694 int ret;
3696 if (udev->state != USB_STATE_CONFIGURED)
3697 return 0;
3699 /* Convert SEL and PEL stored in ns to us */
3700 u1_sel = DIV_ROUND_UP(udev->u1_params.sel, 1000);
3701 u1_pel = DIV_ROUND_UP(udev->u1_params.pel, 1000);
3702 u2_sel = DIV_ROUND_UP(udev->u2_params.sel, 1000);
3703 u2_pel = DIV_ROUND_UP(udev->u2_params.pel, 1000);
3706 * Make sure that the calculated SEL and PEL values for the link
3707 * state we're enabling aren't bigger than the max SEL/PEL
3708 * value that will fit in the SET SEL control transfer.
3709 * Otherwise the device would get an incorrect idea of the exit
3710 * latency for the link state, and could start a device-initiated
3711 * U1/U2 when the exit latencies are too high.
3713 if ((state == USB3_LPM_U1 &&
3714 (u1_sel > USB3_LPM_MAX_U1_SEL_PEL ||
3715 u1_pel > USB3_LPM_MAX_U1_SEL_PEL)) ||
3716 (state == USB3_LPM_U2 &&
3717 (u2_sel > USB3_LPM_MAX_U2_SEL_PEL ||
3718 u2_pel > USB3_LPM_MAX_U2_SEL_PEL))) {
3719 dev_dbg(&udev->dev, "Device-initiated %s disabled due to long SEL %llu us or PEL %llu us\n",
3720 usb3_lpm_names[state], u1_sel, u1_pel);
3721 return -EINVAL;
3725 * If we're enabling device-initiated LPM for one link state,
3726 * but the other link state has a too high SEL or PEL value,
3727 * just set those values to the max in the Set SEL request.
3729 if (u1_sel > USB3_LPM_MAX_U1_SEL_PEL)
3730 u1_sel = USB3_LPM_MAX_U1_SEL_PEL;
3732 if (u1_pel > USB3_LPM_MAX_U1_SEL_PEL)
3733 u1_pel = USB3_LPM_MAX_U1_SEL_PEL;
3735 if (u2_sel > USB3_LPM_MAX_U2_SEL_PEL)
3736 u2_sel = USB3_LPM_MAX_U2_SEL_PEL;
3738 if (u2_pel > USB3_LPM_MAX_U2_SEL_PEL)
3739 u2_pel = USB3_LPM_MAX_U2_SEL_PEL;
3742 * usb_enable_lpm() can be called as part of a failed device reset,
3743 * which may be initiated by an error path of a mass storage driver.
3744 * Therefore, use GFP_NOIO.
3746 sel_values = kmalloc(sizeof *(sel_values), GFP_NOIO);
3747 if (!sel_values)
3748 return -ENOMEM;
3750 sel_values->u1_sel = u1_sel;
3751 sel_values->u1_pel = u1_pel;
3752 sel_values->u2_sel = cpu_to_le16(u2_sel);
3753 sel_values->u2_pel = cpu_to_le16(u2_pel);
3755 ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3756 USB_REQ_SET_SEL,
3757 USB_RECIP_DEVICE,
3758 0, 0,
3759 sel_values, sizeof *(sel_values),
3760 USB_CTRL_SET_TIMEOUT);
3761 kfree(sel_values);
3762 return ret;
3766 * Enable or disable device-initiated U1 or U2 transitions.
3768 static int usb_set_device_initiated_lpm(struct usb_device *udev,
3769 enum usb3_link_state state, bool enable)
3771 int ret;
3772 int feature;
3774 switch (state) {
3775 case USB3_LPM_U1:
3776 feature = USB_DEVICE_U1_ENABLE;
3777 break;
3778 case USB3_LPM_U2:
3779 feature = USB_DEVICE_U2_ENABLE;
3780 break;
3781 default:
3782 dev_warn(&udev->dev, "%s: Can't %s non-U1 or U2 state.\n",
3783 __func__, enable ? "enable" : "disable");
3784 return -EINVAL;
3787 if (udev->state != USB_STATE_CONFIGURED) {
3788 dev_dbg(&udev->dev, "%s: Can't %s %s state "
3789 "for unconfigured device.\n",
3790 __func__, enable ? "enable" : "disable",
3791 usb3_lpm_names[state]);
3792 return 0;
3795 if (enable) {
3797 * Now send the control transfer to enable device-initiated LPM
3798 * for either U1 or U2.
3800 ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3801 USB_REQ_SET_FEATURE,
3802 USB_RECIP_DEVICE,
3803 feature,
3804 0, NULL, 0,
3805 USB_CTRL_SET_TIMEOUT);
3806 } else {
3807 ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
3808 USB_REQ_CLEAR_FEATURE,
3809 USB_RECIP_DEVICE,
3810 feature,
3811 0, NULL, 0,
3812 USB_CTRL_SET_TIMEOUT);
3814 if (ret < 0) {
3815 dev_warn(&udev->dev, "%s of device-initiated %s failed.\n",
3816 enable ? "Enable" : "Disable",
3817 usb3_lpm_names[state]);
3818 return -EBUSY;
3820 return 0;
3823 static int usb_set_lpm_timeout(struct usb_device *udev,
3824 enum usb3_link_state state, int timeout)
3826 int ret;
3827 int feature;
3829 switch (state) {
3830 case USB3_LPM_U1:
3831 feature = USB_PORT_FEAT_U1_TIMEOUT;
3832 break;
3833 case USB3_LPM_U2:
3834 feature = USB_PORT_FEAT_U2_TIMEOUT;
3835 break;
3836 default:
3837 dev_warn(&udev->dev, "%s: Can't set timeout for non-U1 or U2 state.\n",
3838 __func__);
3839 return -EINVAL;
3842 if (state == USB3_LPM_U1 && timeout > USB3_LPM_U1_MAX_TIMEOUT &&
3843 timeout != USB3_LPM_DEVICE_INITIATED) {
3844 dev_warn(&udev->dev, "Failed to set %s timeout to 0x%x, "
3845 "which is a reserved value.\n",
3846 usb3_lpm_names[state], timeout);
3847 return -EINVAL;
3850 ret = set_port_feature(udev->parent,
3851 USB_PORT_LPM_TIMEOUT(timeout) | udev->portnum,
3852 feature);
3853 if (ret < 0) {
3854 dev_warn(&udev->dev, "Failed to set %s timeout to 0x%x,"
3855 "error code %i\n", usb3_lpm_names[state],
3856 timeout, ret);
3857 return -EBUSY;
3859 if (state == USB3_LPM_U1)
3860 udev->u1_params.timeout = timeout;
3861 else
3862 udev->u2_params.timeout = timeout;
3863 return 0;
3867 * Enable the hub-initiated U1/U2 idle timeouts, and enable device-initiated
3868 * U1/U2 entry.
3870 * We will attempt to enable U1 or U2, but there are no guarantees that the
3871 * control transfers to set the hub timeout or enable device-initiated U1/U2
3872 * will be successful.
3874 * If we cannot set the parent hub U1/U2 timeout, we attempt to let the xHCI
3875 * driver know about it. If that call fails, it should be harmless, and just
3876 * take up more slightly more bus bandwidth for unnecessary U1/U2 exit latency.
3878 static void usb_enable_link_state(struct usb_hcd *hcd, struct usb_device *udev,
3879 enum usb3_link_state state)
3881 int timeout, ret;
3882 __u8 u1_mel = udev->bos->ss_cap->bU1devExitLat;
3883 __le16 u2_mel = udev->bos->ss_cap->bU2DevExitLat;
3885 /* If the device says it doesn't have *any* exit latency to come out of
3886 * U1 or U2, it's probably lying. Assume it doesn't implement that link
3887 * state.
3889 if ((state == USB3_LPM_U1 && u1_mel == 0) ||
3890 (state == USB3_LPM_U2 && u2_mel == 0))
3891 return;
3894 * First, let the device know about the exit latencies
3895 * associated with the link state we're about to enable.
3897 ret = usb_req_set_sel(udev, state);
3898 if (ret < 0) {
3899 dev_warn(&udev->dev, "Set SEL for device-initiated %s failed.\n",
3900 usb3_lpm_names[state]);
3901 return;
3904 /* We allow the host controller to set the U1/U2 timeout internally
3905 * first, so that it can change its schedule to account for the
3906 * additional latency to send data to a device in a lower power
3907 * link state.
3909 timeout = hcd->driver->enable_usb3_lpm_timeout(hcd, udev, state);
3911 /* xHCI host controller doesn't want to enable this LPM state. */
3912 if (timeout == 0)
3913 return;
3915 if (timeout < 0) {
3916 dev_warn(&udev->dev, "Could not enable %s link state, "
3917 "xHCI error %i.\n", usb3_lpm_names[state],
3918 timeout);
3919 return;
3922 if (usb_set_lpm_timeout(udev, state, timeout)) {
3923 /* If we can't set the parent hub U1/U2 timeout,
3924 * device-initiated LPM won't be allowed either, so let the xHCI
3925 * host know that this link state won't be enabled.
3927 hcd->driver->disable_usb3_lpm_timeout(hcd, udev, state);
3928 } else {
3929 /* Only a configured device will accept the Set Feature
3930 * U1/U2_ENABLE
3932 if (udev->actconfig)
3933 usb_set_device_initiated_lpm(udev, state, true);
3935 /* As soon as usb_set_lpm_timeout(timeout) returns 0, the
3936 * hub-initiated LPM is enabled. Thus, LPM is enabled no
3937 * matter the result of usb_set_device_initiated_lpm().
3938 * The only difference is whether device is able to initiate
3939 * LPM.
3941 if (state == USB3_LPM_U1)
3942 udev->usb3_lpm_u1_enabled = 1;
3943 else if (state == USB3_LPM_U2)
3944 udev->usb3_lpm_u2_enabled = 1;
3949 * Disable the hub-initiated U1/U2 idle timeouts, and disable device-initiated
3950 * U1/U2 entry.
3952 * If this function returns -EBUSY, the parent hub will still allow U1/U2 entry.
3953 * If zero is returned, the parent will not allow the link to go into U1/U2.
3955 * If zero is returned, device-initiated U1/U2 entry may still be enabled, but
3956 * it won't have an effect on the bus link state because the parent hub will
3957 * still disallow device-initiated U1/U2 entry.
3959 * If zero is returned, the xHCI host controller may still think U1/U2 entry is
3960 * possible. The result will be slightly more bus bandwidth will be taken up
3961 * (to account for U1/U2 exit latency), but it should be harmless.
3963 static int usb_disable_link_state(struct usb_hcd *hcd, struct usb_device *udev,
3964 enum usb3_link_state state)
3966 switch (state) {
3967 case USB3_LPM_U1:
3968 case USB3_LPM_U2:
3969 break;
3970 default:
3971 dev_warn(&udev->dev, "%s: Can't disable non-U1 or U2 state.\n",
3972 __func__);
3973 return -EINVAL;
3976 if (usb_set_lpm_timeout(udev, state, 0))
3977 return -EBUSY;
3979 usb_set_device_initiated_lpm(udev, state, false);
3981 if (hcd->driver->disable_usb3_lpm_timeout(hcd, udev, state))
3982 dev_warn(&udev->dev, "Could not disable xHCI %s timeout, "
3983 "bus schedule bandwidth may be impacted.\n",
3984 usb3_lpm_names[state]);
3986 /* As soon as usb_set_lpm_timeout(0) return 0, hub initiated LPM
3987 * is disabled. Hub will disallows link to enter U1/U2 as well,
3988 * even device is initiating LPM. Hence LPM is disabled if hub LPM
3989 * timeout set to 0, no matter device-initiated LPM is disabled or
3990 * not.
3992 if (state == USB3_LPM_U1)
3993 udev->usb3_lpm_u1_enabled = 0;
3994 else if (state == USB3_LPM_U2)
3995 udev->usb3_lpm_u2_enabled = 0;
3997 return 0;
4001 * Disable hub-initiated and device-initiated U1 and U2 entry.
4002 * Caller must own the bandwidth_mutex.
4004 * This will call usb_enable_lpm() on failure, which will decrement
4005 * lpm_disable_count, and will re-enable LPM if lpm_disable_count reaches zero.
4007 int usb_disable_lpm(struct usb_device *udev)
4009 struct usb_hcd *hcd;
4011 if (!udev || !udev->parent ||
4012 udev->speed < USB_SPEED_SUPER ||
4013 !udev->lpm_capable ||
4014 udev->state < USB_STATE_DEFAULT)
4015 return 0;
4017 hcd = bus_to_hcd(udev->bus);
4018 if (!hcd || !hcd->driver->disable_usb3_lpm_timeout)
4019 return 0;
4021 udev->lpm_disable_count++;
4022 if ((udev->u1_params.timeout == 0 && udev->u2_params.timeout == 0))
4023 return 0;
4025 /* If LPM is enabled, attempt to disable it. */
4026 if (usb_disable_link_state(hcd, udev, USB3_LPM_U1))
4027 goto enable_lpm;
4028 if (usb_disable_link_state(hcd, udev, USB3_LPM_U2))
4029 goto enable_lpm;
4031 return 0;
4033 enable_lpm:
4034 usb_enable_lpm(udev);
4035 return -EBUSY;
4037 EXPORT_SYMBOL_GPL(usb_disable_lpm);
4039 /* Grab the bandwidth_mutex before calling usb_disable_lpm() */
4040 int usb_unlocked_disable_lpm(struct usb_device *udev)
4042 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
4043 int ret;
4045 if (!hcd)
4046 return -EINVAL;
4048 mutex_lock(hcd->bandwidth_mutex);
4049 ret = usb_disable_lpm(udev);
4050 mutex_unlock(hcd->bandwidth_mutex);
4052 return ret;
4054 EXPORT_SYMBOL_GPL(usb_unlocked_disable_lpm);
4057 * Attempt to enable device-initiated and hub-initiated U1 and U2 entry. The
4058 * xHCI host policy may prevent U1 or U2 from being enabled.
4060 * Other callers may have disabled link PM, so U1 and U2 entry will be disabled
4061 * until the lpm_disable_count drops to zero. Caller must own the
4062 * bandwidth_mutex.
4064 void usb_enable_lpm(struct usb_device *udev)
4066 struct usb_hcd *hcd;
4067 struct usb_hub *hub;
4068 struct usb_port *port_dev;
4070 if (!udev || !udev->parent ||
4071 udev->speed < USB_SPEED_SUPER ||
4072 !udev->lpm_capable ||
4073 udev->state < USB_STATE_DEFAULT)
4074 return;
4076 udev->lpm_disable_count--;
4077 hcd = bus_to_hcd(udev->bus);
4078 /* Double check that we can both enable and disable LPM.
4079 * Device must be configured to accept set feature U1/U2 timeout.
4081 if (!hcd || !hcd->driver->enable_usb3_lpm_timeout ||
4082 !hcd->driver->disable_usb3_lpm_timeout)
4083 return;
4085 if (udev->lpm_disable_count > 0)
4086 return;
4088 hub = usb_hub_to_struct_hub(udev->parent);
4089 if (!hub)
4090 return;
4092 port_dev = hub->ports[udev->portnum - 1];
4094 if (port_dev->usb3_lpm_u1_permit)
4095 usb_enable_link_state(hcd, udev, USB3_LPM_U1);
4097 if (port_dev->usb3_lpm_u2_permit)
4098 usb_enable_link_state(hcd, udev, USB3_LPM_U2);
4100 EXPORT_SYMBOL_GPL(usb_enable_lpm);
4102 /* Grab the bandwidth_mutex before calling usb_enable_lpm() */
4103 void usb_unlocked_enable_lpm(struct usb_device *udev)
4105 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
4107 if (!hcd)
4108 return;
4110 mutex_lock(hcd->bandwidth_mutex);
4111 usb_enable_lpm(udev);
4112 mutex_unlock(hcd->bandwidth_mutex);
4114 EXPORT_SYMBOL_GPL(usb_unlocked_enable_lpm);
4116 /* usb3 devices use U3 for disabled, make sure remote wakeup is disabled */
4117 static void hub_usb3_port_prepare_disable(struct usb_hub *hub,
4118 struct usb_port *port_dev)
4120 struct usb_device *udev = port_dev->child;
4121 int ret;
4123 if (udev && udev->port_is_suspended && udev->do_remote_wakeup) {
4124 ret = hub_set_port_link_state(hub, port_dev->portnum,
4125 USB_SS_PORT_LS_U0);
4126 if (!ret) {
4127 msleep(USB_RESUME_TIMEOUT);
4128 ret = usb_disable_remote_wakeup(udev);
4130 if (ret)
4131 dev_warn(&udev->dev,
4132 "Port disable: can't disable remote wake\n");
4133 udev->do_remote_wakeup = 0;
4137 #else /* CONFIG_PM */
4139 #define hub_suspend NULL
4140 #define hub_resume NULL
4141 #define hub_reset_resume NULL
4143 static inline void hub_usb3_port_prepare_disable(struct usb_hub *hub,
4144 struct usb_port *port_dev) { }
4146 int usb_disable_lpm(struct usb_device *udev)
4148 return 0;
4150 EXPORT_SYMBOL_GPL(usb_disable_lpm);
4152 void usb_enable_lpm(struct usb_device *udev) { }
4153 EXPORT_SYMBOL_GPL(usb_enable_lpm);
4155 int usb_unlocked_disable_lpm(struct usb_device *udev)
4157 return 0;
4159 EXPORT_SYMBOL_GPL(usb_unlocked_disable_lpm);
4161 void usb_unlocked_enable_lpm(struct usb_device *udev) { }
4162 EXPORT_SYMBOL_GPL(usb_unlocked_enable_lpm);
4164 int usb_disable_ltm(struct usb_device *udev)
4166 return 0;
4168 EXPORT_SYMBOL_GPL(usb_disable_ltm);
4170 void usb_enable_ltm(struct usb_device *udev) { }
4171 EXPORT_SYMBOL_GPL(usb_enable_ltm);
4173 static int hub_handle_remote_wakeup(struct usb_hub *hub, unsigned int port,
4174 u16 portstatus, u16 portchange)
4176 return 0;
4179 #endif /* CONFIG_PM */
4182 * USB-3 does not have a similar link state as USB-2 that will avoid negotiating
4183 * a connection with a plugged-in cable but will signal the host when the cable
4184 * is unplugged. Disable remote wake and set link state to U3 for USB-3 devices
4186 static int hub_port_disable(struct usb_hub *hub, int port1, int set_state)
4188 struct usb_port *port_dev = hub->ports[port1 - 1];
4189 struct usb_device *hdev = hub->hdev;
4190 int ret = 0;
4192 if (!hub->error) {
4193 if (hub_is_superspeed(hub->hdev)) {
4194 hub_usb3_port_prepare_disable(hub, port_dev);
4195 ret = hub_set_port_link_state(hub, port_dev->portnum,
4196 USB_SS_PORT_LS_U3);
4197 } else {
4198 ret = usb_clear_port_feature(hdev, port1,
4199 USB_PORT_FEAT_ENABLE);
4202 if (port_dev->child && set_state)
4203 usb_set_device_state(port_dev->child, USB_STATE_NOTATTACHED);
4204 if (ret && ret != -ENODEV)
4205 dev_err(&port_dev->dev, "cannot disable (err = %d)\n", ret);
4206 return ret;
4210 * usb_port_disable - disable a usb device's upstream port
4211 * @udev: device to disable
4212 * Context: @udev locked, must be able to sleep.
4214 * Disables a USB device that isn't in active use.
4216 int usb_port_disable(struct usb_device *udev)
4218 struct usb_hub *hub = usb_hub_to_struct_hub(udev->parent);
4220 return hub_port_disable(hub, udev->portnum, 0);
4223 /* USB 2.0 spec, 7.1.7.3 / fig 7-29:
4225 * Between connect detection and reset signaling there must be a delay
4226 * of 100ms at least for debounce and power-settling. The corresponding
4227 * timer shall restart whenever the downstream port detects a disconnect.
4229 * Apparently there are some bluetooth and irda-dongles and a number of
4230 * low-speed devices for which this debounce period may last over a second.
4231 * Not covered by the spec - but easy to deal with.
4233 * This implementation uses a 1500ms total debounce timeout; if the
4234 * connection isn't stable by then it returns -ETIMEDOUT. It checks
4235 * every 25ms for transient disconnects. When the port status has been
4236 * unchanged for 100ms it returns the port status.
4238 int hub_port_debounce(struct usb_hub *hub, int port1, bool must_be_connected)
4240 int ret;
4241 u16 portchange, portstatus;
4242 unsigned connection = 0xffff;
4243 int total_time, stable_time = 0;
4244 struct usb_port *port_dev = hub->ports[port1 - 1];
4246 for (total_time = 0; ; total_time += HUB_DEBOUNCE_STEP) {
4247 ret = hub_port_status(hub, port1, &portstatus, &portchange);
4248 if (ret < 0)
4249 return ret;
4251 if (!(portchange & USB_PORT_STAT_C_CONNECTION) &&
4252 (portstatus & USB_PORT_STAT_CONNECTION) == connection) {
4253 if (!must_be_connected ||
4254 (connection == USB_PORT_STAT_CONNECTION))
4255 stable_time += HUB_DEBOUNCE_STEP;
4256 if (stable_time >= HUB_DEBOUNCE_STABLE)
4257 break;
4258 } else {
4259 stable_time = 0;
4260 connection = portstatus & USB_PORT_STAT_CONNECTION;
4263 if (portchange & USB_PORT_STAT_C_CONNECTION) {
4264 usb_clear_port_feature(hub->hdev, port1,
4265 USB_PORT_FEAT_C_CONNECTION);
4268 if (total_time >= HUB_DEBOUNCE_TIMEOUT)
4269 break;
4270 msleep(HUB_DEBOUNCE_STEP);
4273 dev_dbg(&port_dev->dev, "debounce total %dms stable %dms status 0x%x\n",
4274 total_time, stable_time, portstatus);
4276 if (stable_time < HUB_DEBOUNCE_STABLE)
4277 return -ETIMEDOUT;
4278 return portstatus;
4281 void usb_ep0_reinit(struct usb_device *udev)
4283 usb_disable_endpoint(udev, 0 + USB_DIR_IN, true);
4284 usb_disable_endpoint(udev, 0 + USB_DIR_OUT, true);
4285 usb_enable_endpoint(udev, &udev->ep0, true);
4287 EXPORT_SYMBOL_GPL(usb_ep0_reinit);
4289 #define usb_sndaddr0pipe() (PIPE_CONTROL << 30)
4290 #define usb_rcvaddr0pipe() ((PIPE_CONTROL << 30) | USB_DIR_IN)
4292 static int hub_set_address(struct usb_device *udev, int devnum)
4294 int retval;
4295 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
4298 * The host controller will choose the device address,
4299 * instead of the core having chosen it earlier
4301 if (!hcd->driver->address_device && devnum <= 1)
4302 return -EINVAL;
4303 if (udev->state == USB_STATE_ADDRESS)
4304 return 0;
4305 if (udev->state != USB_STATE_DEFAULT)
4306 return -EINVAL;
4307 if (hcd->driver->address_device)
4308 retval = hcd->driver->address_device(hcd, udev);
4309 else
4310 retval = usb_control_msg(udev, usb_sndaddr0pipe(),
4311 USB_REQ_SET_ADDRESS, 0, devnum, 0,
4312 NULL, 0, USB_CTRL_SET_TIMEOUT);
4313 if (retval == 0) {
4314 update_devnum(udev, devnum);
4315 /* Device now using proper address. */
4316 usb_set_device_state(udev, USB_STATE_ADDRESS);
4317 usb_ep0_reinit(udev);
4319 return retval;
4323 * There are reports of USB 3.0 devices that say they support USB 2.0 Link PM
4324 * when they're plugged into a USB 2.0 port, but they don't work when LPM is
4325 * enabled.
4327 * Only enable USB 2.0 Link PM if the port is internal (hardwired), or the
4328 * device says it supports the new USB 2.0 Link PM errata by setting the BESL
4329 * support bit in the BOS descriptor.
4331 static void hub_set_initial_usb2_lpm_policy(struct usb_device *udev)
4333 struct usb_hub *hub = usb_hub_to_struct_hub(udev->parent);
4334 int connect_type = USB_PORT_CONNECT_TYPE_UNKNOWN;
4336 if (!udev->usb2_hw_lpm_capable || !udev->bos)
4337 return;
4339 if (hub)
4340 connect_type = hub->ports[udev->portnum - 1]->connect_type;
4342 if ((udev->bos->ext_cap->bmAttributes & cpu_to_le32(USB_BESL_SUPPORT)) ||
4343 connect_type == USB_PORT_CONNECT_TYPE_HARD_WIRED) {
4344 udev->usb2_hw_lpm_allowed = 1;
4345 usb_set_usb2_hardware_lpm(udev, 1);
4349 static int hub_enable_device(struct usb_device *udev)
4351 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
4353 if (!hcd->driver->enable_device)
4354 return 0;
4355 if (udev->state == USB_STATE_ADDRESS)
4356 return 0;
4357 if (udev->state != USB_STATE_DEFAULT)
4358 return -EINVAL;
4360 return hcd->driver->enable_device(hcd, udev);
4363 /* Reset device, (re)assign address, get device descriptor.
4364 * Device connection must be stable, no more debouncing needed.
4365 * Returns device in USB_STATE_ADDRESS, except on error.
4367 * If this is called for an already-existing device (as part of
4368 * usb_reset_and_verify_device), the caller must own the device lock and
4369 * the port lock. For a newly detected device that is not accessible
4370 * through any global pointers, it's not necessary to lock the device,
4371 * but it is still necessary to lock the port.
4373 static int
4374 hub_port_init(struct usb_hub *hub, struct usb_device *udev, int port1,
4375 int retry_counter)
4377 struct usb_device *hdev = hub->hdev;
4378 struct usb_hcd *hcd = bus_to_hcd(hdev->bus);
4379 int retries, operations, retval, i;
4380 unsigned delay = HUB_SHORT_RESET_TIME;
4381 enum usb_device_speed oldspeed = udev->speed;
4382 const char *speed;
4383 int devnum = udev->devnum;
4384 const char *driver_name;
4386 /* root hub ports have a slightly longer reset period
4387 * (from USB 2.0 spec, section 7.1.7.5)
4389 if (!hdev->parent) {
4390 delay = HUB_ROOT_RESET_TIME;
4391 if (port1 == hdev->bus->otg_port)
4392 hdev->bus->b_hnp_enable = 0;
4395 /* Some low speed devices have problems with the quick delay, so */
4396 /* be a bit pessimistic with those devices. RHbug #23670 */
4397 if (oldspeed == USB_SPEED_LOW)
4398 delay = HUB_LONG_RESET_TIME;
4400 mutex_lock(hcd->address0_mutex);
4402 /* Reset the device; full speed may morph to high speed */
4403 /* FIXME a USB 2.0 device may morph into SuperSpeed on reset. */
4404 retval = hub_port_reset(hub, port1, udev, delay, false);
4405 if (retval < 0) /* error or disconnect */
4406 goto fail;
4407 /* success, speed is known */
4409 retval = -ENODEV;
4411 /* Don't allow speed changes at reset, except usb 3.0 to faster */
4412 if (oldspeed != USB_SPEED_UNKNOWN && oldspeed != udev->speed &&
4413 !(oldspeed == USB_SPEED_SUPER && udev->speed > oldspeed)) {
4414 dev_dbg(&udev->dev, "device reset changed speed!\n");
4415 goto fail;
4417 oldspeed = udev->speed;
4419 /* USB 2.0 section 5.5.3 talks about ep0 maxpacket ...
4420 * it's fixed size except for full speed devices.
4421 * For Wireless USB devices, ep0 max packet is always 512 (tho
4422 * reported as 0xff in the device descriptor). WUSB1.0[4.8.1].
4424 switch (udev->speed) {
4425 case USB_SPEED_SUPER_PLUS:
4426 case USB_SPEED_SUPER:
4427 case USB_SPEED_WIRELESS: /* fixed at 512 */
4428 udev->ep0.desc.wMaxPacketSize = cpu_to_le16(512);
4429 break;
4430 case USB_SPEED_HIGH: /* fixed at 64 */
4431 udev->ep0.desc.wMaxPacketSize = cpu_to_le16(64);
4432 break;
4433 case USB_SPEED_FULL: /* 8, 16, 32, or 64 */
4434 /* to determine the ep0 maxpacket size, try to read
4435 * the device descriptor to get bMaxPacketSize0 and
4436 * then correct our initial guess.
4438 udev->ep0.desc.wMaxPacketSize = cpu_to_le16(64);
4439 break;
4440 case USB_SPEED_LOW: /* fixed at 8 */
4441 udev->ep0.desc.wMaxPacketSize = cpu_to_le16(8);
4442 break;
4443 default:
4444 goto fail;
4447 if (udev->speed == USB_SPEED_WIRELESS)
4448 speed = "variable speed Wireless";
4449 else
4450 speed = usb_speed_string(udev->speed);
4453 * The controller driver may be NULL if the controller device
4454 * is the middle device between platform device and roothub.
4455 * This middle device may not need a device driver due to
4456 * all hardware control can be at platform device driver, this
4457 * platform device is usually a dual-role USB controller device.
4459 if (udev->bus->controller->driver)
4460 driver_name = udev->bus->controller->driver->name;
4461 else
4462 driver_name = udev->bus->sysdev->driver->name;
4464 if (udev->speed < USB_SPEED_SUPER)
4465 dev_info(&udev->dev,
4466 "%s %s USB device number %d using %s\n",
4467 (udev->config) ? "reset" : "new", speed,
4468 devnum, driver_name);
4470 /* Set up TT records, if needed */
4471 if (hdev->tt) {
4472 udev->tt = hdev->tt;
4473 udev->ttport = hdev->ttport;
4474 } else if (udev->speed != USB_SPEED_HIGH
4475 && hdev->speed == USB_SPEED_HIGH) {
4476 if (!hub->tt.hub) {
4477 dev_err(&udev->dev, "parent hub has no TT\n");
4478 retval = -EINVAL;
4479 goto fail;
4481 udev->tt = &hub->tt;
4482 udev->ttport = port1;
4485 /* Why interleave GET_DESCRIPTOR and SET_ADDRESS this way?
4486 * Because device hardware and firmware is sometimes buggy in
4487 * this area, and this is how Linux has done it for ages.
4488 * Change it cautiously.
4490 * NOTE: If use_new_scheme() is true we will start by issuing
4491 * a 64-byte GET_DESCRIPTOR request. This is what Windows does,
4492 * so it may help with some non-standards-compliant devices.
4493 * Otherwise we start with SET_ADDRESS and then try to read the
4494 * first 8 bytes of the device descriptor to get the ep0 maxpacket
4495 * value.
4497 for (retries = 0; retries < GET_DESCRIPTOR_TRIES; (++retries, msleep(100))) {
4498 bool did_new_scheme = false;
4500 if (use_new_scheme(udev, retry_counter)) {
4501 struct usb_device_descriptor *buf;
4502 int r = 0;
4504 did_new_scheme = true;
4505 retval = hub_enable_device(udev);
4506 if (retval < 0) {
4507 dev_err(&udev->dev,
4508 "hub failed to enable device, error %d\n",
4509 retval);
4510 goto fail;
4513 #define GET_DESCRIPTOR_BUFSIZE 64
4514 buf = kmalloc(GET_DESCRIPTOR_BUFSIZE, GFP_NOIO);
4515 if (!buf) {
4516 retval = -ENOMEM;
4517 continue;
4520 /* Retry on all errors; some devices are flakey.
4521 * 255 is for WUSB devices, we actually need to use
4522 * 512 (WUSB1.0[4.8.1]).
4524 for (operations = 0; operations < 3; ++operations) {
4525 buf->bMaxPacketSize0 = 0;
4526 r = usb_control_msg(udev, usb_rcvaddr0pipe(),
4527 USB_REQ_GET_DESCRIPTOR, USB_DIR_IN,
4528 USB_DT_DEVICE << 8, 0,
4529 buf, GET_DESCRIPTOR_BUFSIZE,
4530 initial_descriptor_timeout);
4531 switch (buf->bMaxPacketSize0) {
4532 case 8: case 16: case 32: case 64: case 255:
4533 if (buf->bDescriptorType ==
4534 USB_DT_DEVICE) {
4535 r = 0;
4536 break;
4538 /* FALL THROUGH */
4539 default:
4540 if (r == 0)
4541 r = -EPROTO;
4542 break;
4545 * Some devices time out if they are powered on
4546 * when already connected. They need a second
4547 * reset. But only on the first attempt,
4548 * lest we get into a time out/reset loop
4550 if (r == 0 || (r == -ETIMEDOUT && retries == 0))
4551 break;
4553 udev->descriptor.bMaxPacketSize0 =
4554 buf->bMaxPacketSize0;
4555 kfree(buf);
4557 retval = hub_port_reset(hub, port1, udev, delay, false);
4558 if (retval < 0) /* error or disconnect */
4559 goto fail;
4560 if (oldspeed != udev->speed) {
4561 dev_dbg(&udev->dev,
4562 "device reset changed speed!\n");
4563 retval = -ENODEV;
4564 goto fail;
4566 if (r) {
4567 if (r != -ENODEV)
4568 dev_err(&udev->dev, "device descriptor read/64, error %d\n",
4570 retval = -EMSGSIZE;
4571 continue;
4573 #undef GET_DESCRIPTOR_BUFSIZE
4577 * If device is WUSB, we already assigned an
4578 * unauthorized address in the Connect Ack sequence;
4579 * authorization will assign the final address.
4581 if (udev->wusb == 0) {
4582 for (operations = 0; operations < SET_ADDRESS_TRIES; ++operations) {
4583 retval = hub_set_address(udev, devnum);
4584 if (retval >= 0)
4585 break;
4586 msleep(200);
4588 if (retval < 0) {
4589 if (retval != -ENODEV)
4590 dev_err(&udev->dev, "device not accepting address %d, error %d\n",
4591 devnum, retval);
4592 goto fail;
4594 if (udev->speed >= USB_SPEED_SUPER) {
4595 devnum = udev->devnum;
4596 dev_info(&udev->dev,
4597 "%s SuperSpeed%s USB device number %d using %s\n",
4598 (udev->config) ? "reset" : "new",
4599 (udev->speed == USB_SPEED_SUPER_PLUS) ? "Plus" : "",
4600 devnum, driver_name);
4603 /* cope with hardware quirkiness:
4604 * - let SET_ADDRESS settle, some device hardware wants it
4605 * - read ep0 maxpacket even for high and low speed,
4607 msleep(10);
4608 /* use_new_scheme() checks the speed which may have
4609 * changed since the initial look so we cache the result
4610 * in did_new_scheme
4612 if (did_new_scheme)
4613 break;
4616 retval = usb_get_device_descriptor(udev, 8);
4617 if (retval < 8) {
4618 if (retval != -ENODEV)
4619 dev_err(&udev->dev,
4620 "device descriptor read/8, error %d\n",
4621 retval);
4622 if (retval >= 0)
4623 retval = -EMSGSIZE;
4624 } else {
4625 u32 delay;
4627 retval = 0;
4629 delay = udev->parent->hub_delay;
4630 udev->hub_delay = min_t(u32, delay,
4631 USB_TP_TRANSMISSION_DELAY_MAX);
4632 retval = usb_set_isoch_delay(udev);
4633 if (retval) {
4634 dev_dbg(&udev->dev,
4635 "Failed set isoch delay, error %d\n",
4636 retval);
4637 retval = 0;
4639 break;
4642 if (retval)
4643 goto fail;
4646 * Some superspeed devices have finished the link training process
4647 * and attached to a superspeed hub port, but the device descriptor
4648 * got from those devices show they aren't superspeed devices. Warm
4649 * reset the port attached by the devices can fix them.
4651 if ((udev->speed >= USB_SPEED_SUPER) &&
4652 (le16_to_cpu(udev->descriptor.bcdUSB) < 0x0300)) {
4653 dev_err(&udev->dev, "got a wrong device descriptor, "
4654 "warm reset device\n");
4655 hub_port_reset(hub, port1, udev,
4656 HUB_BH_RESET_TIME, true);
4657 retval = -EINVAL;
4658 goto fail;
4661 if (udev->descriptor.bMaxPacketSize0 == 0xff ||
4662 udev->speed >= USB_SPEED_SUPER)
4663 i = 512;
4664 else
4665 i = udev->descriptor.bMaxPacketSize0;
4666 if (usb_endpoint_maxp(&udev->ep0.desc) != i) {
4667 if (udev->speed == USB_SPEED_LOW ||
4668 !(i == 8 || i == 16 || i == 32 || i == 64)) {
4669 dev_err(&udev->dev, "Invalid ep0 maxpacket: %d\n", i);
4670 retval = -EMSGSIZE;
4671 goto fail;
4673 if (udev->speed == USB_SPEED_FULL)
4674 dev_dbg(&udev->dev, "ep0 maxpacket = %d\n", i);
4675 else
4676 dev_warn(&udev->dev, "Using ep0 maxpacket: %d\n", i);
4677 udev->ep0.desc.wMaxPacketSize = cpu_to_le16(i);
4678 usb_ep0_reinit(udev);
4681 retval = usb_get_device_descriptor(udev, USB_DT_DEVICE_SIZE);
4682 if (retval < (signed)sizeof(udev->descriptor)) {
4683 if (retval != -ENODEV)
4684 dev_err(&udev->dev, "device descriptor read/all, error %d\n",
4685 retval);
4686 if (retval >= 0)
4687 retval = -ENOMSG;
4688 goto fail;
4691 usb_detect_quirks(udev);
4693 if (udev->wusb == 0 && le16_to_cpu(udev->descriptor.bcdUSB) >= 0x0201) {
4694 retval = usb_get_bos_descriptor(udev);
4695 if (!retval) {
4696 udev->lpm_capable = usb_device_supports_lpm(udev);
4697 usb_set_lpm_parameters(udev);
4701 retval = 0;
4702 /* notify HCD that we have a device connected and addressed */
4703 if (hcd->driver->update_device)
4704 hcd->driver->update_device(hcd, udev);
4705 hub_set_initial_usb2_lpm_policy(udev);
4706 fail:
4707 if (retval) {
4708 hub_port_disable(hub, port1, 0);
4709 update_devnum(udev, devnum); /* for disconnect processing */
4711 mutex_unlock(hcd->address0_mutex);
4712 return retval;
4715 static void
4716 check_highspeed(struct usb_hub *hub, struct usb_device *udev, int port1)
4718 struct usb_qualifier_descriptor *qual;
4719 int status;
4721 if (udev->quirks & USB_QUIRK_DEVICE_QUALIFIER)
4722 return;
4724 qual = kmalloc(sizeof *qual, GFP_KERNEL);
4725 if (qual == NULL)
4726 return;
4728 status = usb_get_descriptor(udev, USB_DT_DEVICE_QUALIFIER, 0,
4729 qual, sizeof *qual);
4730 if (status == sizeof *qual) {
4731 dev_info(&udev->dev, "not running at top speed; "
4732 "connect to a high speed hub\n");
4733 /* hub LEDs are probably harder to miss than syslog */
4734 if (hub->has_indicators) {
4735 hub->indicator[port1-1] = INDICATOR_GREEN_BLINK;
4736 queue_delayed_work(system_power_efficient_wq,
4737 &hub->leds, 0);
4740 kfree(qual);
4743 static unsigned
4744 hub_power_remaining(struct usb_hub *hub)
4746 struct usb_device *hdev = hub->hdev;
4747 int remaining;
4748 int port1;
4750 if (!hub->limited_power)
4751 return 0;
4753 remaining = hdev->bus_mA - hub->descriptor->bHubContrCurrent;
4754 for (port1 = 1; port1 <= hdev->maxchild; ++port1) {
4755 struct usb_port *port_dev = hub->ports[port1 - 1];
4756 struct usb_device *udev = port_dev->child;
4757 unsigned unit_load;
4758 int delta;
4760 if (!udev)
4761 continue;
4762 if (hub_is_superspeed(udev))
4763 unit_load = 150;
4764 else
4765 unit_load = 100;
4768 * Unconfigured devices may not use more than one unit load,
4769 * or 8mA for OTG ports
4771 if (udev->actconfig)
4772 delta = usb_get_max_power(udev, udev->actconfig);
4773 else if (port1 != udev->bus->otg_port || hdev->parent)
4774 delta = unit_load;
4775 else
4776 delta = 8;
4777 if (delta > hub->mA_per_port)
4778 dev_warn(&port_dev->dev, "%dmA is over %umA budget!\n",
4779 delta, hub->mA_per_port);
4780 remaining -= delta;
4782 if (remaining < 0) {
4783 dev_warn(hub->intfdev, "%dmA over power budget!\n",
4784 -remaining);
4785 remaining = 0;
4787 return remaining;
4790 static void hub_port_connect(struct usb_hub *hub, int port1, u16 portstatus,
4791 u16 portchange)
4793 int status = -ENODEV;
4794 int i;
4795 unsigned unit_load;
4796 struct usb_device *hdev = hub->hdev;
4797 struct usb_hcd *hcd = bus_to_hcd(hdev->bus);
4798 struct usb_port *port_dev = hub->ports[port1 - 1];
4799 struct usb_device *udev = port_dev->child;
4800 static int unreliable_port = -1;
4802 /* Disconnect any existing devices under this port */
4803 if (udev) {
4804 if (hcd->usb_phy && !hdev->parent)
4805 usb_phy_notify_disconnect(hcd->usb_phy, udev->speed);
4806 usb_disconnect(&port_dev->child);
4809 /* We can forget about a "removed" device when there's a physical
4810 * disconnect or the connect status changes.
4812 if (!(portstatus & USB_PORT_STAT_CONNECTION) ||
4813 (portchange & USB_PORT_STAT_C_CONNECTION))
4814 clear_bit(port1, hub->removed_bits);
4816 if (portchange & (USB_PORT_STAT_C_CONNECTION |
4817 USB_PORT_STAT_C_ENABLE)) {
4818 status = hub_port_debounce_be_stable(hub, port1);
4819 if (status < 0) {
4820 if (status != -ENODEV &&
4821 port1 != unreliable_port &&
4822 printk_ratelimit())
4823 dev_err(&port_dev->dev, "connect-debounce failed\n");
4824 portstatus &= ~USB_PORT_STAT_CONNECTION;
4825 unreliable_port = port1;
4826 } else {
4827 portstatus = status;
4831 /* Return now if debouncing failed or nothing is connected or
4832 * the device was "removed".
4834 if (!(portstatus & USB_PORT_STAT_CONNECTION) ||
4835 test_bit(port1, hub->removed_bits)) {
4838 * maybe switch power back on (e.g. root hub was reset)
4839 * but only if the port isn't owned by someone else.
4841 if (hub_is_port_power_switchable(hub)
4842 && !port_is_power_on(hub, portstatus)
4843 && !port_dev->port_owner)
4844 set_port_feature(hdev, port1, USB_PORT_FEAT_POWER);
4846 if (portstatus & USB_PORT_STAT_ENABLE)
4847 goto done;
4848 return;
4850 if (hub_is_superspeed(hub->hdev))
4851 unit_load = 150;
4852 else
4853 unit_load = 100;
4855 status = 0;
4856 for (i = 0; i < SET_CONFIG_TRIES; i++) {
4858 /* reallocate for each attempt, since references
4859 * to the previous one can escape in various ways
4861 udev = usb_alloc_dev(hdev, hdev->bus, port1);
4862 if (!udev) {
4863 dev_err(&port_dev->dev,
4864 "couldn't allocate usb_device\n");
4865 goto done;
4868 usb_set_device_state(udev, USB_STATE_POWERED);
4869 udev->bus_mA = hub->mA_per_port;
4870 udev->level = hdev->level + 1;
4871 udev->wusb = hub_is_wusb(hub);
4873 /* Devices connected to SuperSpeed hubs are USB 3.0 or later */
4874 if (hub_is_superspeed(hub->hdev))
4875 udev->speed = USB_SPEED_SUPER;
4876 else
4877 udev->speed = USB_SPEED_UNKNOWN;
4879 choose_devnum(udev);
4880 if (udev->devnum <= 0) {
4881 status = -ENOTCONN; /* Don't retry */
4882 goto loop;
4885 /* reset (non-USB 3.0 devices) and get descriptor */
4886 usb_lock_port(port_dev);
4887 status = hub_port_init(hub, udev, port1, i);
4888 usb_unlock_port(port_dev);
4889 if (status < 0)
4890 goto loop;
4892 if (udev->quirks & USB_QUIRK_DELAY_INIT)
4893 msleep(2000);
4895 /* consecutive bus-powered hubs aren't reliable; they can
4896 * violate the voltage drop budget. if the new child has
4897 * a "powered" LED, users should notice we didn't enable it
4898 * (without reading syslog), even without per-port LEDs
4899 * on the parent.
4901 if (udev->descriptor.bDeviceClass == USB_CLASS_HUB
4902 && udev->bus_mA <= unit_load) {
4903 u16 devstat;
4905 status = usb_get_std_status(udev, USB_RECIP_DEVICE, 0,
4906 &devstat);
4907 if (status) {
4908 dev_dbg(&udev->dev, "get status %d ?\n", status);
4909 goto loop_disable;
4911 if ((devstat & (1 << USB_DEVICE_SELF_POWERED)) == 0) {
4912 dev_err(&udev->dev,
4913 "can't connect bus-powered hub "
4914 "to this port\n");
4915 if (hub->has_indicators) {
4916 hub->indicator[port1-1] =
4917 INDICATOR_AMBER_BLINK;
4918 queue_delayed_work(
4919 system_power_efficient_wq,
4920 &hub->leds, 0);
4922 status = -ENOTCONN; /* Don't retry */
4923 goto loop_disable;
4927 /* check for devices running slower than they could */
4928 if (le16_to_cpu(udev->descriptor.bcdUSB) >= 0x0200
4929 && udev->speed == USB_SPEED_FULL
4930 && highspeed_hubs != 0)
4931 check_highspeed(hub, udev, port1);
4933 /* Store the parent's children[] pointer. At this point
4934 * udev becomes globally accessible, although presumably
4935 * no one will look at it until hdev is unlocked.
4937 status = 0;
4939 mutex_lock(&usb_port_peer_mutex);
4941 /* We mustn't add new devices if the parent hub has
4942 * been disconnected; we would race with the
4943 * recursively_mark_NOTATTACHED() routine.
4945 spin_lock_irq(&device_state_lock);
4946 if (hdev->state == USB_STATE_NOTATTACHED)
4947 status = -ENOTCONN;
4948 else
4949 port_dev->child = udev;
4950 spin_unlock_irq(&device_state_lock);
4951 mutex_unlock(&usb_port_peer_mutex);
4953 /* Run it through the hoops (find a driver, etc) */
4954 if (!status) {
4955 status = usb_new_device(udev);
4956 if (status) {
4957 mutex_lock(&usb_port_peer_mutex);
4958 spin_lock_irq(&device_state_lock);
4959 port_dev->child = NULL;
4960 spin_unlock_irq(&device_state_lock);
4961 mutex_unlock(&usb_port_peer_mutex);
4962 } else {
4963 if (hcd->usb_phy && !hdev->parent)
4964 usb_phy_notify_connect(hcd->usb_phy,
4965 udev->speed);
4969 if (status)
4970 goto loop_disable;
4972 status = hub_power_remaining(hub);
4973 if (status)
4974 dev_dbg(hub->intfdev, "%dmA power budget left\n", status);
4976 return;
4978 loop_disable:
4979 hub_port_disable(hub, port1, 1);
4980 loop:
4981 usb_ep0_reinit(udev);
4982 release_devnum(udev);
4983 hub_free_dev(udev);
4984 usb_put_dev(udev);
4985 if ((status == -ENOTCONN) || (status == -ENOTSUPP))
4986 break;
4988 /* When halfway through our retry count, power-cycle the port */
4989 if (i == (SET_CONFIG_TRIES / 2) - 1) {
4990 dev_info(&port_dev->dev, "attempt power cycle\n");
4991 usb_hub_set_port_power(hdev, hub, port1, false);
4992 msleep(2 * hub_power_on_good_delay(hub));
4993 usb_hub_set_port_power(hdev, hub, port1, true);
4994 msleep(hub_power_on_good_delay(hub));
4997 if (hub->hdev->parent ||
4998 !hcd->driver->port_handed_over ||
4999 !(hcd->driver->port_handed_over)(hcd, port1)) {
5000 if (status != -ENOTCONN && status != -ENODEV)
5001 dev_err(&port_dev->dev,
5002 "unable to enumerate USB device\n");
5005 done:
5006 hub_port_disable(hub, port1, 1);
5007 if (hcd->driver->relinquish_port && !hub->hdev->parent) {
5008 if (status != -ENOTCONN && status != -ENODEV)
5009 hcd->driver->relinquish_port(hcd, port1);
5013 /* Handle physical or logical connection change events.
5014 * This routine is called when:
5015 * a port connection-change occurs;
5016 * a port enable-change occurs (often caused by EMI);
5017 * usb_reset_and_verify_device() encounters changed descriptors (as from
5018 * a firmware download)
5019 * caller already locked the hub
5021 static void hub_port_connect_change(struct usb_hub *hub, int port1,
5022 u16 portstatus, u16 portchange)
5023 __must_hold(&port_dev->status_lock)
5025 struct usb_port *port_dev = hub->ports[port1 - 1];
5026 struct usb_device *udev = port_dev->child;
5027 int status = -ENODEV;
5029 dev_dbg(&port_dev->dev, "status %04x, change %04x, %s\n", portstatus,
5030 portchange, portspeed(hub, portstatus));
5032 if (hub->has_indicators) {
5033 set_port_led(hub, port1, HUB_LED_AUTO);
5034 hub->indicator[port1-1] = INDICATOR_AUTO;
5037 #ifdef CONFIG_USB_OTG
5038 /* during HNP, don't repeat the debounce */
5039 if (hub->hdev->bus->is_b_host)
5040 portchange &= ~(USB_PORT_STAT_C_CONNECTION |
5041 USB_PORT_STAT_C_ENABLE);
5042 #endif
5044 /* Try to resuscitate an existing device */
5045 if ((portstatus & USB_PORT_STAT_CONNECTION) && udev &&
5046 udev->state != USB_STATE_NOTATTACHED) {
5047 if (portstatus & USB_PORT_STAT_ENABLE) {
5048 status = 0; /* Nothing to do */
5049 #ifdef CONFIG_PM
5050 } else if (udev->state == USB_STATE_SUSPENDED &&
5051 udev->persist_enabled) {
5052 /* For a suspended device, treat this as a
5053 * remote wakeup event.
5055 usb_unlock_port(port_dev);
5056 status = usb_remote_wakeup(udev);
5057 usb_lock_port(port_dev);
5058 #endif
5059 } else {
5060 /* Don't resuscitate */;
5063 clear_bit(port1, hub->change_bits);
5065 /* successfully revalidated the connection */
5066 if (status == 0)
5067 return;
5069 usb_unlock_port(port_dev);
5070 hub_port_connect(hub, port1, portstatus, portchange);
5071 usb_lock_port(port_dev);
5074 static void port_event(struct usb_hub *hub, int port1)
5075 __must_hold(&port_dev->status_lock)
5077 int connect_change;
5078 struct usb_port *port_dev = hub->ports[port1 - 1];
5079 struct usb_device *udev = port_dev->child;
5080 struct usb_device *hdev = hub->hdev;
5081 u16 portstatus, portchange;
5083 connect_change = test_bit(port1, hub->change_bits);
5084 clear_bit(port1, hub->event_bits);
5085 clear_bit(port1, hub->wakeup_bits);
5087 if (hub_port_status(hub, port1, &portstatus, &portchange) < 0)
5088 return;
5090 if (portchange & USB_PORT_STAT_C_CONNECTION) {
5091 usb_clear_port_feature(hdev, port1, USB_PORT_FEAT_C_CONNECTION);
5092 connect_change = 1;
5095 if (portchange & USB_PORT_STAT_C_ENABLE) {
5096 if (!connect_change)
5097 dev_dbg(&port_dev->dev, "enable change, status %08x\n",
5098 portstatus);
5099 usb_clear_port_feature(hdev, port1, USB_PORT_FEAT_C_ENABLE);
5102 * EM interference sometimes causes badly shielded USB devices
5103 * to be shutdown by the hub, this hack enables them again.
5104 * Works at least with mouse driver.
5106 if (!(portstatus & USB_PORT_STAT_ENABLE)
5107 && !connect_change && udev) {
5108 dev_err(&port_dev->dev, "disabled by hub (EMI?), re-enabling...\n");
5109 connect_change = 1;
5113 if (portchange & USB_PORT_STAT_C_OVERCURRENT) {
5114 u16 status = 0, unused;
5116 dev_dbg(&port_dev->dev, "over-current change\n");
5117 usb_clear_port_feature(hdev, port1,
5118 USB_PORT_FEAT_C_OVER_CURRENT);
5119 msleep(100); /* Cool down */
5120 hub_power_on(hub, true);
5121 hub_port_status(hub, port1, &status, &unused);
5122 if (status & USB_PORT_STAT_OVERCURRENT)
5123 dev_err(&port_dev->dev, "over-current condition\n");
5126 if (portchange & USB_PORT_STAT_C_RESET) {
5127 dev_dbg(&port_dev->dev, "reset change\n");
5128 usb_clear_port_feature(hdev, port1, USB_PORT_FEAT_C_RESET);
5130 if ((portchange & USB_PORT_STAT_C_BH_RESET)
5131 && hub_is_superspeed(hdev)) {
5132 dev_dbg(&port_dev->dev, "warm reset change\n");
5133 usb_clear_port_feature(hdev, port1,
5134 USB_PORT_FEAT_C_BH_PORT_RESET);
5136 if (portchange & USB_PORT_STAT_C_LINK_STATE) {
5137 dev_dbg(&port_dev->dev, "link state change\n");
5138 usb_clear_port_feature(hdev, port1,
5139 USB_PORT_FEAT_C_PORT_LINK_STATE);
5141 if (portchange & USB_PORT_STAT_C_CONFIG_ERROR) {
5142 dev_warn(&port_dev->dev, "config error\n");
5143 usb_clear_port_feature(hdev, port1,
5144 USB_PORT_FEAT_C_PORT_CONFIG_ERROR);
5147 /* skip port actions that require the port to be powered on */
5148 if (!pm_runtime_active(&port_dev->dev))
5149 return;
5151 if (hub_handle_remote_wakeup(hub, port1, portstatus, portchange))
5152 connect_change = 1;
5155 * Warm reset a USB3 protocol port if it's in
5156 * SS.Inactive state.
5158 if (hub_port_warm_reset_required(hub, port1, portstatus)) {
5159 dev_dbg(&port_dev->dev, "do warm reset\n");
5160 if (!udev || !(portstatus & USB_PORT_STAT_CONNECTION)
5161 || udev->state == USB_STATE_NOTATTACHED) {
5162 if (hub_port_reset(hub, port1, NULL,
5163 HUB_BH_RESET_TIME, true) < 0)
5164 hub_port_disable(hub, port1, 1);
5165 } else {
5166 usb_unlock_port(port_dev);
5167 usb_lock_device(udev);
5168 usb_reset_device(udev);
5169 usb_unlock_device(udev);
5170 usb_lock_port(port_dev);
5171 connect_change = 0;
5175 if (connect_change)
5176 hub_port_connect_change(hub, port1, portstatus, portchange);
5179 static void hub_event(struct work_struct *work)
5181 struct usb_device *hdev;
5182 struct usb_interface *intf;
5183 struct usb_hub *hub;
5184 struct device *hub_dev;
5185 u16 hubstatus;
5186 u16 hubchange;
5187 int i, ret;
5189 hub = container_of(work, struct usb_hub, events);
5190 hdev = hub->hdev;
5191 hub_dev = hub->intfdev;
5192 intf = to_usb_interface(hub_dev);
5194 dev_dbg(hub_dev, "state %d ports %d chg %04x evt %04x\n",
5195 hdev->state, hdev->maxchild,
5196 /* NOTE: expects max 15 ports... */
5197 (u16) hub->change_bits[0],
5198 (u16) hub->event_bits[0]);
5200 /* Lock the device, then check to see if we were
5201 * disconnected while waiting for the lock to succeed. */
5202 usb_lock_device(hdev);
5203 if (unlikely(hub->disconnected))
5204 goto out_hdev_lock;
5206 /* If the hub has died, clean up after it */
5207 if (hdev->state == USB_STATE_NOTATTACHED) {
5208 hub->error = -ENODEV;
5209 hub_quiesce(hub, HUB_DISCONNECT);
5210 goto out_hdev_lock;
5213 /* Autoresume */
5214 ret = usb_autopm_get_interface(intf);
5215 if (ret) {
5216 dev_dbg(hub_dev, "Can't autoresume: %d\n", ret);
5217 goto out_hdev_lock;
5220 /* If this is an inactive hub, do nothing */
5221 if (hub->quiescing)
5222 goto out_autopm;
5224 if (hub->error) {
5225 dev_dbg(hub_dev, "resetting for error %d\n", hub->error);
5227 ret = usb_reset_device(hdev);
5228 if (ret) {
5229 dev_dbg(hub_dev, "error resetting hub: %d\n", ret);
5230 goto out_autopm;
5233 hub->nerrors = 0;
5234 hub->error = 0;
5237 /* deal with port status changes */
5238 for (i = 1; i <= hdev->maxchild; i++) {
5239 struct usb_port *port_dev = hub->ports[i - 1];
5241 if (test_bit(i, hub->event_bits)
5242 || test_bit(i, hub->change_bits)
5243 || test_bit(i, hub->wakeup_bits)) {
5245 * The get_noresume and barrier ensure that if
5246 * the port was in the process of resuming, we
5247 * flush that work and keep the port active for
5248 * the duration of the port_event(). However,
5249 * if the port is runtime pm suspended
5250 * (powered-off), we leave it in that state, run
5251 * an abbreviated port_event(), and move on.
5253 pm_runtime_get_noresume(&port_dev->dev);
5254 pm_runtime_barrier(&port_dev->dev);
5255 usb_lock_port(port_dev);
5256 port_event(hub, i);
5257 usb_unlock_port(port_dev);
5258 pm_runtime_put_sync(&port_dev->dev);
5262 /* deal with hub status changes */
5263 if (test_and_clear_bit(0, hub->event_bits) == 0)
5264 ; /* do nothing */
5265 else if (hub_hub_status(hub, &hubstatus, &hubchange) < 0)
5266 dev_err(hub_dev, "get_hub_status failed\n");
5267 else {
5268 if (hubchange & HUB_CHANGE_LOCAL_POWER) {
5269 dev_dbg(hub_dev, "power change\n");
5270 clear_hub_feature(hdev, C_HUB_LOCAL_POWER);
5271 if (hubstatus & HUB_STATUS_LOCAL_POWER)
5272 /* FIXME: Is this always true? */
5273 hub->limited_power = 1;
5274 else
5275 hub->limited_power = 0;
5277 if (hubchange & HUB_CHANGE_OVERCURRENT) {
5278 u16 status = 0;
5279 u16 unused;
5281 dev_dbg(hub_dev, "over-current change\n");
5282 clear_hub_feature(hdev, C_HUB_OVER_CURRENT);
5283 msleep(500); /* Cool down */
5284 hub_power_on(hub, true);
5285 hub_hub_status(hub, &status, &unused);
5286 if (status & HUB_STATUS_OVERCURRENT)
5287 dev_err(hub_dev, "over-current condition\n");
5291 out_autopm:
5292 /* Balance the usb_autopm_get_interface() above */
5293 usb_autopm_put_interface_no_suspend(intf);
5294 out_hdev_lock:
5295 usb_unlock_device(hdev);
5297 /* Balance the stuff in kick_hub_wq() and allow autosuspend */
5298 usb_autopm_put_interface(intf);
5299 kref_put(&hub->kref, hub_release);
5302 static const struct usb_device_id hub_id_table[] = {
5303 { .match_flags = USB_DEVICE_ID_MATCH_VENDOR
5304 | USB_DEVICE_ID_MATCH_INT_CLASS,
5305 .idVendor = USB_VENDOR_GENESYS_LOGIC,
5306 .bInterfaceClass = USB_CLASS_HUB,
5307 .driver_info = HUB_QUIRK_CHECK_PORT_AUTOSUSPEND},
5308 { .match_flags = USB_DEVICE_ID_MATCH_DEV_CLASS,
5309 .bDeviceClass = USB_CLASS_HUB},
5310 { .match_flags = USB_DEVICE_ID_MATCH_INT_CLASS,
5311 .bInterfaceClass = USB_CLASS_HUB},
5312 { } /* Terminating entry */
5315 MODULE_DEVICE_TABLE(usb, hub_id_table);
5317 static struct usb_driver hub_driver = {
5318 .name = "hub",
5319 .probe = hub_probe,
5320 .disconnect = hub_disconnect,
5321 .suspend = hub_suspend,
5322 .resume = hub_resume,
5323 .reset_resume = hub_reset_resume,
5324 .pre_reset = hub_pre_reset,
5325 .post_reset = hub_post_reset,
5326 .unlocked_ioctl = hub_ioctl,
5327 .id_table = hub_id_table,
5328 .supports_autosuspend = 1,
5331 int usb_hub_init(void)
5333 if (usb_register(&hub_driver) < 0) {
5334 printk(KERN_ERR "%s: can't register hub driver\n",
5335 usbcore_name);
5336 return -1;
5340 * The workqueue needs to be freezable to avoid interfering with
5341 * USB-PERSIST port handover. Otherwise it might see that a full-speed
5342 * device was gone before the EHCI controller had handed its port
5343 * over to the companion full-speed controller.
5345 hub_wq = alloc_workqueue("usb_hub_wq", WQ_FREEZABLE, 0);
5346 if (hub_wq)
5347 return 0;
5349 /* Fall through if kernel_thread failed */
5350 usb_deregister(&hub_driver);
5351 pr_err("%s: can't allocate workqueue for usb hub\n", usbcore_name);
5353 return -1;
5356 void usb_hub_cleanup(void)
5358 destroy_workqueue(hub_wq);
5361 * Hub resources are freed for us by usb_deregister. It calls
5362 * usb_driver_purge on every device which in turn calls that
5363 * devices disconnect function if it is using this driver.
5364 * The hub_disconnect function takes care of releasing the
5365 * individual hub resources. -greg
5367 usb_deregister(&hub_driver);
5368 } /* usb_hub_cleanup() */
5370 static int descriptors_changed(struct usb_device *udev,
5371 struct usb_device_descriptor *old_device_descriptor,
5372 struct usb_host_bos *old_bos)
5374 int changed = 0;
5375 unsigned index;
5376 unsigned serial_len = 0;
5377 unsigned len;
5378 unsigned old_length;
5379 int length;
5380 char *buf;
5382 if (memcmp(&udev->descriptor, old_device_descriptor,
5383 sizeof(*old_device_descriptor)) != 0)
5384 return 1;
5386 if ((old_bos && !udev->bos) || (!old_bos && udev->bos))
5387 return 1;
5388 if (udev->bos) {
5389 len = le16_to_cpu(udev->bos->desc->wTotalLength);
5390 if (len != le16_to_cpu(old_bos->desc->wTotalLength))
5391 return 1;
5392 if (memcmp(udev->bos->desc, old_bos->desc, len))
5393 return 1;
5396 /* Since the idVendor, idProduct, and bcdDevice values in the
5397 * device descriptor haven't changed, we will assume the
5398 * Manufacturer and Product strings haven't changed either.
5399 * But the SerialNumber string could be different (e.g., a
5400 * different flash card of the same brand).
5402 if (udev->serial)
5403 serial_len = strlen(udev->serial) + 1;
5405 len = serial_len;
5406 for (index = 0; index < udev->descriptor.bNumConfigurations; index++) {
5407 old_length = le16_to_cpu(udev->config[index].desc.wTotalLength);
5408 len = max(len, old_length);
5411 buf = kmalloc(len, GFP_NOIO);
5412 if (!buf)
5413 /* assume the worst */
5414 return 1;
5416 for (index = 0; index < udev->descriptor.bNumConfigurations; index++) {
5417 old_length = le16_to_cpu(udev->config[index].desc.wTotalLength);
5418 length = usb_get_descriptor(udev, USB_DT_CONFIG, index, buf,
5419 old_length);
5420 if (length != old_length) {
5421 dev_dbg(&udev->dev, "config index %d, error %d\n",
5422 index, length);
5423 changed = 1;
5424 break;
5426 if (memcmp(buf, udev->rawdescriptors[index], old_length)
5427 != 0) {
5428 dev_dbg(&udev->dev, "config index %d changed (#%d)\n",
5429 index,
5430 ((struct usb_config_descriptor *) buf)->
5431 bConfigurationValue);
5432 changed = 1;
5433 break;
5437 if (!changed && serial_len) {
5438 length = usb_string(udev, udev->descriptor.iSerialNumber,
5439 buf, serial_len);
5440 if (length + 1 != serial_len) {
5441 dev_dbg(&udev->dev, "serial string error %d\n",
5442 length);
5443 changed = 1;
5444 } else if (memcmp(buf, udev->serial, length) != 0) {
5445 dev_dbg(&udev->dev, "serial string changed\n");
5446 changed = 1;
5450 kfree(buf);
5451 return changed;
5455 * usb_reset_and_verify_device - perform a USB port reset to reinitialize a device
5456 * @udev: device to reset (not in SUSPENDED or NOTATTACHED state)
5458 * WARNING - don't use this routine to reset a composite device
5459 * (one with multiple interfaces owned by separate drivers)!
5460 * Use usb_reset_device() instead.
5462 * Do a port reset, reassign the device's address, and establish its
5463 * former operating configuration. If the reset fails, or the device's
5464 * descriptors change from their values before the reset, or the original
5465 * configuration and altsettings cannot be restored, a flag will be set
5466 * telling hub_wq to pretend the device has been disconnected and then
5467 * re-connected. All drivers will be unbound, and the device will be
5468 * re-enumerated and probed all over again.
5470 * Return: 0 if the reset succeeded, -ENODEV if the device has been
5471 * flagged for logical disconnection, or some other negative error code
5472 * if the reset wasn't even attempted.
5474 * Note:
5475 * The caller must own the device lock and the port lock, the latter is
5476 * taken by usb_reset_device(). For example, it's safe to use
5477 * usb_reset_device() from a driver probe() routine after downloading
5478 * new firmware. For calls that might not occur during probe(), drivers
5479 * should lock the device using usb_lock_device_for_reset().
5481 * Locking exception: This routine may also be called from within an
5482 * autoresume handler. Such usage won't conflict with other tasks
5483 * holding the device lock because these tasks should always call
5484 * usb_autopm_resume_device(), thereby preventing any unwanted
5485 * autoresume. The autoresume handler is expected to have already
5486 * acquired the port lock before calling this routine.
5488 static int usb_reset_and_verify_device(struct usb_device *udev)
5490 struct usb_device *parent_hdev = udev->parent;
5491 struct usb_hub *parent_hub;
5492 struct usb_hcd *hcd = bus_to_hcd(udev->bus);
5493 struct usb_device_descriptor descriptor = udev->descriptor;
5494 struct usb_host_bos *bos;
5495 int i, j, ret = 0;
5496 int port1 = udev->portnum;
5498 if (udev->state == USB_STATE_NOTATTACHED ||
5499 udev->state == USB_STATE_SUSPENDED) {
5500 dev_dbg(&udev->dev, "device reset not allowed in state %d\n",
5501 udev->state);
5502 return -EINVAL;
5505 if (!parent_hdev)
5506 return -EISDIR;
5508 parent_hub = usb_hub_to_struct_hub(parent_hdev);
5510 /* Disable USB2 hardware LPM.
5511 * It will be re-enabled by the enumeration process.
5513 if (udev->usb2_hw_lpm_enabled == 1)
5514 usb_set_usb2_hardware_lpm(udev, 0);
5516 /* Disable LPM and LTM while we reset the device and reinstall the alt
5517 * settings. Device-initiated LPM settings, and system exit latency
5518 * settings are cleared when the device is reset, so we have to set
5519 * them up again.
5521 ret = usb_unlocked_disable_lpm(udev);
5522 if (ret) {
5523 dev_err(&udev->dev, "%s Failed to disable LPM\n", __func__);
5524 goto re_enumerate_no_bos;
5526 ret = usb_disable_ltm(udev);
5527 if (ret) {
5528 dev_err(&udev->dev, "%s Failed to disable LTM\n", __func__);
5529 goto re_enumerate_no_bos;
5532 bos = udev->bos;
5533 udev->bos = NULL;
5535 for (i = 0; i < SET_CONFIG_TRIES; ++i) {
5537 /* ep0 maxpacket size may change; let the HCD know about it.
5538 * Other endpoints will be handled by re-enumeration. */
5539 usb_ep0_reinit(udev);
5540 ret = hub_port_init(parent_hub, udev, port1, i);
5541 if (ret >= 0 || ret == -ENOTCONN || ret == -ENODEV)
5542 break;
5545 if (ret < 0)
5546 goto re_enumerate;
5548 /* Device might have changed firmware (DFU or similar) */
5549 if (descriptors_changed(udev, &descriptor, bos)) {
5550 dev_info(&udev->dev, "device firmware changed\n");
5551 udev->descriptor = descriptor; /* for disconnect() calls */
5552 goto re_enumerate;
5555 /* Restore the device's previous configuration */
5556 if (!udev->actconfig)
5557 goto done;
5559 mutex_lock(hcd->bandwidth_mutex);
5560 ret = usb_hcd_alloc_bandwidth(udev, udev->actconfig, NULL, NULL);
5561 if (ret < 0) {
5562 dev_warn(&udev->dev,
5563 "Busted HC? Not enough HCD resources for "
5564 "old configuration.\n");
5565 mutex_unlock(hcd->bandwidth_mutex);
5566 goto re_enumerate;
5568 ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0),
5569 USB_REQ_SET_CONFIGURATION, 0,
5570 udev->actconfig->desc.bConfigurationValue, 0,
5571 NULL, 0, USB_CTRL_SET_TIMEOUT);
5572 if (ret < 0) {
5573 dev_err(&udev->dev,
5574 "can't restore configuration #%d (error=%d)\n",
5575 udev->actconfig->desc.bConfigurationValue, ret);
5576 mutex_unlock(hcd->bandwidth_mutex);
5577 goto re_enumerate;
5579 mutex_unlock(hcd->bandwidth_mutex);
5580 usb_set_device_state(udev, USB_STATE_CONFIGURED);
5582 /* Put interfaces back into the same altsettings as before.
5583 * Don't bother to send the Set-Interface request for interfaces
5584 * that were already in altsetting 0; besides being unnecessary,
5585 * many devices can't handle it. Instead just reset the host-side
5586 * endpoint state.
5588 for (i = 0; i < udev->actconfig->desc.bNumInterfaces; i++) {
5589 struct usb_host_config *config = udev->actconfig;
5590 struct usb_interface *intf = config->interface[i];
5591 struct usb_interface_descriptor *desc;
5593 desc = &intf->cur_altsetting->desc;
5594 if (desc->bAlternateSetting == 0) {
5595 usb_disable_interface(udev, intf, true);
5596 usb_enable_interface(udev, intf, true);
5597 ret = 0;
5598 } else {
5599 /* Let the bandwidth allocation function know that this
5600 * device has been reset, and it will have to use
5601 * alternate setting 0 as the current alternate setting.
5603 intf->resetting_device = 1;
5604 ret = usb_set_interface(udev, desc->bInterfaceNumber,
5605 desc->bAlternateSetting);
5606 intf->resetting_device = 0;
5608 if (ret < 0) {
5609 dev_err(&udev->dev, "failed to restore interface %d "
5610 "altsetting %d (error=%d)\n",
5611 desc->bInterfaceNumber,
5612 desc->bAlternateSetting,
5613 ret);
5614 goto re_enumerate;
5616 /* Resetting also frees any allocated streams */
5617 for (j = 0; j < intf->cur_altsetting->desc.bNumEndpoints; j++)
5618 intf->cur_altsetting->endpoint[j].streams = 0;
5621 done:
5622 /* Now that the alt settings are re-installed, enable LTM and LPM. */
5623 usb_set_usb2_hardware_lpm(udev, 1);
5624 usb_unlocked_enable_lpm(udev);
5625 usb_enable_ltm(udev);
5626 usb_release_bos_descriptor(udev);
5627 udev->bos = bos;
5628 return 0;
5630 re_enumerate:
5631 usb_release_bos_descriptor(udev);
5632 udev->bos = bos;
5633 re_enumerate_no_bos:
5634 /* LPM state doesn't matter when we're about to destroy the device. */
5635 hub_port_logical_disconnect(parent_hub, port1);
5636 return -ENODEV;
5640 * usb_reset_device - warn interface drivers and perform a USB port reset
5641 * @udev: device to reset (not in SUSPENDED or NOTATTACHED state)
5643 * Warns all drivers bound to registered interfaces (using their pre_reset
5644 * method), performs the port reset, and then lets the drivers know that
5645 * the reset is over (using their post_reset method).
5647 * Return: The same as for usb_reset_and_verify_device().
5649 * Note:
5650 * The caller must own the device lock. For example, it's safe to use
5651 * this from a driver probe() routine after downloading new firmware.
5652 * For calls that might not occur during probe(), drivers should lock
5653 * the device using usb_lock_device_for_reset().
5655 * If an interface is currently being probed or disconnected, we assume
5656 * its driver knows how to handle resets. For all other interfaces,
5657 * if the driver doesn't have pre_reset and post_reset methods then
5658 * we attempt to unbind it and rebind afterward.
5660 int usb_reset_device(struct usb_device *udev)
5662 int ret;
5663 int i;
5664 unsigned int noio_flag;
5665 struct usb_port *port_dev;
5666 struct usb_host_config *config = udev->actconfig;
5667 struct usb_hub *hub = usb_hub_to_struct_hub(udev->parent);
5669 if (udev->state == USB_STATE_NOTATTACHED ||
5670 udev->state == USB_STATE_SUSPENDED) {
5671 dev_dbg(&udev->dev, "device reset not allowed in state %d\n",
5672 udev->state);
5673 return -EINVAL;
5676 if (!udev->parent) {
5677 /* this requires hcd-specific logic; see ohci_restart() */
5678 dev_dbg(&udev->dev, "%s for root hub!\n", __func__);
5679 return -EISDIR;
5682 port_dev = hub->ports[udev->portnum - 1];
5685 * Don't allocate memory with GFP_KERNEL in current
5686 * context to avoid possible deadlock if usb mass
5687 * storage interface or usbnet interface(iSCSI case)
5688 * is included in current configuration. The easist
5689 * approach is to do it for every device reset,
5690 * because the device 'memalloc_noio' flag may have
5691 * not been set before reseting the usb device.
5693 noio_flag = memalloc_noio_save();
5695 /* Prevent autosuspend during the reset */
5696 usb_autoresume_device(udev);
5698 if (config) {
5699 for (i = 0; i < config->desc.bNumInterfaces; ++i) {
5700 struct usb_interface *cintf = config->interface[i];
5701 struct usb_driver *drv;
5702 int unbind = 0;
5704 if (cintf->dev.driver) {
5705 drv = to_usb_driver(cintf->dev.driver);
5706 if (drv->pre_reset && drv->post_reset)
5707 unbind = (drv->pre_reset)(cintf);
5708 else if (cintf->condition ==
5709 USB_INTERFACE_BOUND)
5710 unbind = 1;
5711 if (unbind)
5712 usb_forced_unbind_intf(cintf);
5717 usb_lock_port(port_dev);
5718 ret = usb_reset_and_verify_device(udev);
5719 usb_unlock_port(port_dev);
5721 if (config) {
5722 for (i = config->desc.bNumInterfaces - 1; i >= 0; --i) {
5723 struct usb_interface *cintf = config->interface[i];
5724 struct usb_driver *drv;
5725 int rebind = cintf->needs_binding;
5727 if (!rebind && cintf->dev.driver) {
5728 drv = to_usb_driver(cintf->dev.driver);
5729 if (drv->post_reset)
5730 rebind = (drv->post_reset)(cintf);
5731 else if (cintf->condition ==
5732 USB_INTERFACE_BOUND)
5733 rebind = 1;
5734 if (rebind)
5735 cintf->needs_binding = 1;
5738 usb_unbind_and_rebind_marked_interfaces(udev);
5741 usb_autosuspend_device(udev);
5742 memalloc_noio_restore(noio_flag);
5743 return ret;
5745 EXPORT_SYMBOL_GPL(usb_reset_device);
5749 * usb_queue_reset_device - Reset a USB device from an atomic context
5750 * @iface: USB interface belonging to the device to reset
5752 * This function can be used to reset a USB device from an atomic
5753 * context, where usb_reset_device() won't work (as it blocks).
5755 * Doing a reset via this method is functionally equivalent to calling
5756 * usb_reset_device(), except for the fact that it is delayed to a
5757 * workqueue. This means that any drivers bound to other interfaces
5758 * might be unbound, as well as users from usbfs in user space.
5760 * Corner cases:
5762 * - Scheduling two resets at the same time from two different drivers
5763 * attached to two different interfaces of the same device is
5764 * possible; depending on how the driver attached to each interface
5765 * handles ->pre_reset(), the second reset might happen or not.
5767 * - If the reset is delayed so long that the interface is unbound from
5768 * its driver, the reset will be skipped.
5770 * - This function can be called during .probe(). It can also be called
5771 * during .disconnect(), but doing so is pointless because the reset
5772 * will not occur. If you really want to reset the device during
5773 * .disconnect(), call usb_reset_device() directly -- but watch out
5774 * for nested unbinding issues!
5776 void usb_queue_reset_device(struct usb_interface *iface)
5778 if (schedule_work(&iface->reset_ws))
5779 usb_get_intf(iface);
5781 EXPORT_SYMBOL_GPL(usb_queue_reset_device);
5784 * usb_hub_find_child - Get the pointer of child device
5785 * attached to the port which is specified by @port1.
5786 * @hdev: USB device belonging to the usb hub
5787 * @port1: port num to indicate which port the child device
5788 * is attached to.
5790 * USB drivers call this function to get hub's child device
5791 * pointer.
5793 * Return: %NULL if input param is invalid and
5794 * child's usb_device pointer if non-NULL.
5796 struct usb_device *usb_hub_find_child(struct usb_device *hdev,
5797 int port1)
5799 struct usb_hub *hub = usb_hub_to_struct_hub(hdev);
5801 if (port1 < 1 || port1 > hdev->maxchild)
5802 return NULL;
5803 return hub->ports[port1 - 1]->child;
5805 EXPORT_SYMBOL_GPL(usb_hub_find_child);
5807 void usb_hub_adjust_deviceremovable(struct usb_device *hdev,
5808 struct usb_hub_descriptor *desc)
5810 struct usb_hub *hub = usb_hub_to_struct_hub(hdev);
5811 enum usb_port_connect_type connect_type;
5812 int i;
5814 if (!hub)
5815 return;
5817 if (!hub_is_superspeed(hdev)) {
5818 for (i = 1; i <= hdev->maxchild; i++) {
5819 struct usb_port *port_dev = hub->ports[i - 1];
5821 connect_type = port_dev->connect_type;
5822 if (connect_type == USB_PORT_CONNECT_TYPE_HARD_WIRED) {
5823 u8 mask = 1 << (i%8);
5825 if (!(desc->u.hs.DeviceRemovable[i/8] & mask)) {
5826 dev_dbg(&port_dev->dev, "DeviceRemovable is changed to 1 according to platform information.\n");
5827 desc->u.hs.DeviceRemovable[i/8] |= mask;
5831 } else {
5832 u16 port_removable = le16_to_cpu(desc->u.ss.DeviceRemovable);
5834 for (i = 1; i <= hdev->maxchild; i++) {
5835 struct usb_port *port_dev = hub->ports[i - 1];
5837 connect_type = port_dev->connect_type;
5838 if (connect_type == USB_PORT_CONNECT_TYPE_HARD_WIRED) {
5839 u16 mask = 1 << i;
5841 if (!(port_removable & mask)) {
5842 dev_dbg(&port_dev->dev, "DeviceRemovable is changed to 1 according to platform information.\n");
5843 port_removable |= mask;
5848 desc->u.ss.DeviceRemovable = cpu_to_le16(port_removable);
5852 #ifdef CONFIG_ACPI
5854 * usb_get_hub_port_acpi_handle - Get the usb port's acpi handle
5855 * @hdev: USB device belonging to the usb hub
5856 * @port1: port num of the port
5858 * Return: Port's acpi handle if successful, %NULL if params are
5859 * invalid.
5861 acpi_handle usb_get_hub_port_acpi_handle(struct usb_device *hdev,
5862 int port1)
5864 struct usb_hub *hub = usb_hub_to_struct_hub(hdev);
5866 if (!hub)
5867 return NULL;
5869 return ACPI_HANDLE(&hub->ports[port1 - 1]->dev);
5871 #endif