4 * (C) Copyright 1999 Linus Torvalds
5 * (C) Copyright 1999 Johannes Erdfelt
6 * (C) Copyright 1999 Gregory P. Smith
7 * (C) Copyright 2001 Brad Hards (bhards@bigpond.net.au)
11 #include <linux/kernel.h>
12 #include <linux/errno.h>
13 #include <linux/module.h>
14 #include <linux/moduleparam.h>
15 #include <linux/completion.h>
16 #include <linux/sched.h>
17 #include <linux/list.h>
18 #include <linux/slab.h>
19 #include <linux/ioctl.h>
20 #include <linux/usb.h>
21 #include <linux/usbdevice_fs.h>
22 #include <linux/usb/hcd.h>
23 #include <linux/usb/otg.h>
24 #include <linux/usb/quirks.h>
25 #include <linux/kthread.h>
26 #include <linux/mutex.h>
27 #include <linux/freezer.h>
28 #include <linux/random.h>
29 #include <linux/pm_qos.h>
31 #include <asm/uaccess.h>
32 #include <asm/byteorder.h>
36 #ifdef CONFIG_MTK_ICUSB_SUPPORT
37 int is_musbfsh_rh(struct usb_device
*udev
);
38 void set_icusb_sts_disconnect_done(void);
41 #ifdef CONFIG_MTK_DT_USB_SUPPORT
42 #include <linux/proc_fs.h>
43 #include <linux/uaccess.h>
44 static struct usb_device
*g_dsda_dev
= NULL
;
46 #ifdef CONFIG_PM_RUNTIME
47 struct usb_hub
*usb11_hub
= NULL
;
48 int is_musbfsh_rh(struct usb_device
*udev
);
50 struct usb_device
*get_usb11_child_udev(void)
54 return usb11_hub
->ports
[0]->child
;
62 void dump_data(char *buf
, int len
)
65 for(i
=0 ; i
< len
; i
++)
67 MYDBG("data[%d]: %x\n", i
, buf
[i
]);
71 void test_dsda_device_ep0(void)
76 ret
= usb_control_msg(g_dsda_dev
, usb_rcvctrlpipe(g_dsda_dev
, 0),
77 USB_REQ_GET_DESCRIPTOR
,
83 USB_CTRL_GET_TIMEOUT
);
88 MYDBG("test ep fail, ret : %d\n", ret
);
92 MYDBG("test ep0 ok, ret : %d\n", ret
);
93 dump_data(data_buf
, ret
);
98 void release_usb11_wakelock(void);
99 static ssize_t
dsda_tmp_proc_entry(struct file
*file_ptr
, const char __user
*user_buffer
, size_t count
, loff_t
*position
)
103 int ret
= copy_from_user((char *) &cmd
, user_buffer
, count
);
110 /* apply action here */
114 test_dsda_device_ep0();
119 release_usb11_wakelock();
127 struct file_operations dsda_tmp_proc_fops
= {
128 .write
= dsda_tmp_proc_entry
132 void create_dsda_tmp_entry(void)
134 struct proc_dir_entry
*prEntry
;
138 prEntry
= proc_create("DSDA_TMP_ENTRY", 0660, 0, &dsda_tmp_proc_fops
);
141 MYDBG("add /proc/DSDA_TMP_ENTRY ok\n");
145 MYDBG("add /proc/DSDA_TMP_ENTRY fail\n");
150 /* if we are in debug mode, always announce new devices */
152 #ifndef CONFIG_USB_ANNOUNCE_NEW_DEVICES
153 #define CONFIG_USB_ANNOUNCE_NEW_DEVICES
157 #define USB_VENDOR_GENESYS_LOGIC 0x05e3
158 #define HUB_QUIRK_CHECK_PORT_AUTOSUSPEND 0x01
160 #if defined(CONFIG_USBIF_COMPLIANCE) && defined(CONFIG_USB_XHCI_HCD)
161 extern int usbif_u3h_send_event(char* event
) ;
162 #include "otg_whitelist.h"
166 static inline int hub_is_superspeed(struct usb_device
*hdev
)
168 return (hdev
->descriptor
.bDeviceProtocol
== USB_HUB_PR_SS
);
171 /* Protect struct usb_device->state and ->children members
172 * Note: Both are also protected by ->dev.sem, except that ->state can
173 * change to USB_STATE_NOTATTACHED even when the semaphore isn't held. */
174 static DEFINE_SPINLOCK(device_state_lock
);
176 /* khubd's worklist and its lock */
177 static DEFINE_SPINLOCK(hub_event_lock
);
178 static LIST_HEAD(hub_event_list
); /* List of hubs needing servicing */
181 static DECLARE_WAIT_QUEUE_HEAD(khubd_wait
);
183 static struct task_struct
*khubd_task
;
185 /* cycle leds on hubs that aren't blinking for attention */
186 static bool blinkenlights
= 0;
187 module_param (blinkenlights
, bool, S_IRUGO
);
188 MODULE_PARM_DESC (blinkenlights
, "true to cycle leds on hubs");
191 * Device SATA8000 FW1.0 from DATAST0R Technology Corp requires about
192 * 10 seconds to send reply for the initial 64-byte descriptor request.
194 /* define initial 64-byte descriptor request timeout in milliseconds */
195 static int initial_descriptor_timeout
= USB_CTRL_GET_TIMEOUT
;
196 module_param(initial_descriptor_timeout
, int, S_IRUGO
|S_IWUSR
);
197 MODULE_PARM_DESC(initial_descriptor_timeout
,
198 "initial 64-byte descriptor request timeout in milliseconds "
199 "(default 5000 - 5.0 seconds)");
202 * As of 2.6.10 we introduce a new USB device initialization scheme which
203 * closely resembles the way Windows works. Hopefully it will be compatible
204 * with a wider range of devices than the old scheme. However some previously
205 * working devices may start giving rise to "device not accepting address"
206 * errors; if that happens the user can try the old scheme by adjusting the
207 * following module parameters.
209 * For maximum flexibility there are two boolean parameters to control the
210 * hub driver's behavior. On the first initialization attempt, if the
211 * "old_scheme_first" parameter is set then the old scheme will be used,
212 * otherwise the new scheme is used. If that fails and "use_both_schemes"
213 * is set, then the driver will make another attempt, using the other scheme.
215 static bool old_scheme_first
= 0;
216 module_param(old_scheme_first
, bool, S_IRUGO
| S_IWUSR
);
217 MODULE_PARM_DESC(old_scheme_first
,
218 "start with the old device initialization scheme");
220 static bool use_both_schemes
= 1;
221 module_param(use_both_schemes
, bool, S_IRUGO
| S_IWUSR
);
222 MODULE_PARM_DESC(use_both_schemes
,
223 "try the other device initialization scheme if the "
226 /* Mutual exclusion for EHCI CF initialization. This interferes with
227 * port reset on some companion controllers.
229 DECLARE_RWSEM(ehci_cf_port_reset_rwsem
);
230 EXPORT_SYMBOL_GPL(ehci_cf_port_reset_rwsem
);
232 #define HUB_DEBOUNCE_TIMEOUT 2000
233 #define HUB_DEBOUNCE_STEP 25
234 #define HUB_DEBOUNCE_STABLE 100
236 static int usb_reset_and_verify_device(struct usb_device
*udev
);
238 #define usb_sndaddr0pipe() (PIPE_CONTROL << 30)
239 #define usb_rcvaddr0pipe() ((PIPE_CONTROL << 30) | USB_DIR_IN)
242 static inline char *portspeed(struct usb_hub
*hub
, int portstatus
)
244 if (hub_is_superspeed(hub
->hdev
))
246 if (portstatus
& USB_PORT_STAT_HIGH_SPEED
)
248 else if (portstatus
& USB_PORT_STAT_LOW_SPEED
)
254 /* Note that hdev or one of its children must be locked! */
255 struct usb_hub
*usb_hub_to_struct_hub(struct usb_device
*hdev
)
257 if (!hdev
|| !hdev
->actconfig
|| !hdev
->maxchild
)
259 return usb_get_intfdata(hdev
->actconfig
->interface
[0]);
262 static int usb_device_supports_lpm(struct usb_device
*udev
)
264 /* USB 2.1 (and greater) devices indicate LPM support through
265 * their USB 2.0 Extended Capabilities BOS descriptor.
267 if (udev
->speed
== USB_SPEED_HIGH
) {
268 if (udev
->bos
->ext_cap
&&
270 le32_to_cpu(udev
->bos
->ext_cap
->bmAttributes
)))
275 /* All USB 3.0 must support LPM, but we need their max exit latency
276 * information from the SuperSpeed Extended Capabilities BOS descriptor.
278 if (!udev
->bos
->ss_cap
) {
279 dev_warn(&udev
->dev
, "No LPM exit latency info found. "
280 "Power management will be impacted.\n");
283 if (udev
->parent
->lpm_capable
)
286 dev_warn(&udev
->dev
, "Parent hub missing LPM exit latency info. "
287 "Power management will be impacted.\n");
292 * Set the Maximum Exit Latency (MEL) for the host to initiate a transition from
295 static void usb_set_lpm_mel(struct usb_device
*udev
,
296 struct usb3_lpm_parameters
*udev_lpm_params
,
297 unsigned int udev_exit_latency
,
299 struct usb3_lpm_parameters
*hub_lpm_params
,
300 unsigned int hub_exit_latency
)
302 unsigned int total_mel
;
303 unsigned int device_mel
;
304 unsigned int hub_mel
;
307 * Calculate the time it takes to transition all links from the roothub
308 * to the parent hub into U0. The parent hub must then decode the
309 * packet (hub header decode latency) to figure out which port it was
312 * The Hub Header decode latency is expressed in 0.1us intervals (0x1
313 * means 0.1us). Multiply that by 100 to get nanoseconds.
315 total_mel
= hub_lpm_params
->mel
+
316 (hub
->descriptor
->u
.ss
.bHubHdrDecLat
* 100);
319 * How long will it take to transition the downstream hub's port into
320 * U0? The greater of either the hub exit latency or the device exit
323 * The BOS U1/U2 exit latencies are expressed in 1us intervals.
324 * Multiply that by 1000 to get nanoseconds.
326 device_mel
= udev_exit_latency
* 1000;
327 hub_mel
= hub_exit_latency
* 1000;
328 if (device_mel
> hub_mel
)
329 total_mel
+= device_mel
;
331 total_mel
+= hub_mel
;
333 udev_lpm_params
->mel
= total_mel
;
337 * Set the maximum Device to Host Exit Latency (PEL) for the device to initiate
338 * a transition from either U1 or U2.
340 static void usb_set_lpm_pel(struct usb_device
*udev
,
341 struct usb3_lpm_parameters
*udev_lpm_params
,
342 unsigned int udev_exit_latency
,
344 struct usb3_lpm_parameters
*hub_lpm_params
,
345 unsigned int hub_exit_latency
,
346 unsigned int port_to_port_exit_latency
)
348 unsigned int first_link_pel
;
349 unsigned int hub_pel
;
352 * First, the device sends an LFPS to transition the link between the
353 * device and the parent hub into U0. The exit latency is the bigger of
354 * the device exit latency or the hub exit latency.
356 if (udev_exit_latency
> hub_exit_latency
)
357 first_link_pel
= udev_exit_latency
* 1000;
359 first_link_pel
= hub_exit_latency
* 1000;
362 * When the hub starts to receive the LFPS, there is a slight delay for
363 * it to figure out that one of the ports is sending an LFPS. Then it
364 * will forward the LFPS to its upstream link. The exit latency is the
365 * delay, plus the PEL that we calculated for this hub.
367 hub_pel
= port_to_port_exit_latency
* 1000 + hub_lpm_params
->pel
;
370 * According to figure C-7 in the USB 3.0 spec, the PEL for this device
371 * is the greater of the two exit latencies.
373 if (first_link_pel
> hub_pel
)
374 udev_lpm_params
->pel
= first_link_pel
;
376 udev_lpm_params
->pel
= hub_pel
;
380 * Set the System Exit Latency (SEL) to indicate the total worst-case time from
381 * when a device initiates a transition to U0, until when it will receive the
382 * first packet from the host controller.
384 * Section C.1.5.1 describes the four components to this:
386 * - t2: time for the ERDY to make it from the device to the host.
387 * - t3: a host-specific delay to process the ERDY.
388 * - t4: time for the packet to make it from the host to the device.
390 * t3 is specific to both the xHCI host and the platform the host is integrated
391 * into. The Intel HW folks have said it's negligible, FIXME if a different
392 * vendor says otherwise.
394 static void usb_set_lpm_sel(struct usb_device
*udev
,
395 struct usb3_lpm_parameters
*udev_lpm_params
)
397 struct usb_device
*parent
;
398 unsigned int num_hubs
;
399 unsigned int total_sel
;
401 /* t1 = device PEL */
402 total_sel
= udev_lpm_params
->pel
;
403 /* How many external hubs are in between the device & the root port. */
404 for (parent
= udev
->parent
, num_hubs
= 0; parent
->parent
;
405 parent
= parent
->parent
)
407 /* t2 = 2.1us + 250ns * (num_hubs - 1) */
409 total_sel
+= 2100 + 250 * (num_hubs
- 1);
411 /* t4 = 250ns * num_hubs */
412 total_sel
+= 250 * num_hubs
;
414 udev_lpm_params
->sel
= total_sel
;
417 static void usb_set_lpm_parameters(struct usb_device
*udev
)
420 unsigned int port_to_port_delay
;
421 unsigned int udev_u1_del
;
422 unsigned int udev_u2_del
;
423 unsigned int hub_u1_del
;
424 unsigned int hub_u2_del
;
426 if (!udev
->lpm_capable
|| udev
->speed
!= USB_SPEED_SUPER
)
429 hub
= usb_hub_to_struct_hub(udev
->parent
);
430 /* It doesn't take time to transition the roothub into U0, since it
431 * doesn't have an upstream link.
436 udev_u1_del
= udev
->bos
->ss_cap
->bU1devExitLat
;
437 udev_u2_del
= udev
->bos
->ss_cap
->bU2DevExitLat
;
438 hub_u1_del
= udev
->parent
->bos
->ss_cap
->bU1devExitLat
;
439 hub_u2_del
= udev
->parent
->bos
->ss_cap
->bU2DevExitLat
;
441 usb_set_lpm_mel(udev
, &udev
->u1_params
, udev_u1_del
,
442 hub
, &udev
->parent
->u1_params
, hub_u1_del
);
444 usb_set_lpm_mel(udev
, &udev
->u2_params
, udev_u2_del
,
445 hub
, &udev
->parent
->u2_params
, hub_u2_del
);
448 * Appendix C, section C.2.2.2, says that there is a slight delay from
449 * when the parent hub notices the downstream port is trying to
450 * transition to U0 to when the hub initiates a U0 transition on its
451 * upstream port. The section says the delays are tPort2PortU1EL and
452 * tPort2PortU2EL, but it doesn't define what they are.
454 * The hub chapter, sections 10.4.2.4 and 10.4.2.5 seem to be talking
455 * about the same delays. Use the maximum delay calculations from those
456 * sections. For U1, it's tHubPort2PortExitLat, which is 1us max. For
457 * U2, it's tHubPort2PortExitLat + U2DevExitLat - U1DevExitLat. I
458 * assume the device exit latencies they are talking about are the hub
461 * What do we do if the U2 exit latency is less than the U1 exit
462 * latency? It's possible, although not likely...
464 port_to_port_delay
= 1;
466 usb_set_lpm_pel(udev
, &udev
->u1_params
, udev_u1_del
,
467 hub
, &udev
->parent
->u1_params
, hub_u1_del
,
470 if (hub_u2_del
> hub_u1_del
)
471 port_to_port_delay
= 1 + hub_u2_del
- hub_u1_del
;
473 port_to_port_delay
= 1 + hub_u1_del
;
475 usb_set_lpm_pel(udev
, &udev
->u2_params
, udev_u2_del
,
476 hub
, &udev
->parent
->u2_params
, hub_u2_del
,
479 /* Now that we've got PEL, calculate SEL. */
480 usb_set_lpm_sel(udev
, &udev
->u1_params
);
481 usb_set_lpm_sel(udev
, &udev
->u2_params
);
484 /* USB 2.0 spec Section 11.24.4.5 */
485 static int get_hub_descriptor(struct usb_device
*hdev
, void *data
)
490 if (hub_is_superspeed(hdev
)) {
491 dtype
= USB_DT_SS_HUB
;
492 size
= USB_DT_SS_HUB_SIZE
;
495 size
= sizeof(struct usb_hub_descriptor
);
498 for (i
= 0; i
< 3; i
++) {
499 ret
= usb_control_msg(hdev
, usb_rcvctrlpipe(hdev
, 0),
500 USB_REQ_GET_DESCRIPTOR
, USB_DIR_IN
| USB_RT_HUB
,
501 dtype
<< 8, 0, data
, size
,
502 USB_CTRL_GET_TIMEOUT
);
503 if (ret
>= (USB_DT_HUB_NONVAR_SIZE
+ 2))
510 * USB 2.0 spec Section 11.24.2.1
512 static int clear_hub_feature(struct usb_device
*hdev
, int feature
)
514 return usb_control_msg(hdev
, usb_sndctrlpipe(hdev
, 0),
515 USB_REQ_CLEAR_FEATURE
, USB_RT_HUB
, feature
, 0, NULL
, 0, 1000);
519 * USB 2.0 spec Section 11.24.2.2
521 int usb_clear_port_feature(struct usb_device
*hdev
, int port1
, int feature
)
523 return usb_control_msg(hdev
, usb_sndctrlpipe(hdev
, 0),
524 USB_REQ_CLEAR_FEATURE
, USB_RT_PORT
, feature
, port1
,
529 * USB 2.0 spec Section 11.24.2.13
531 static int set_port_feature(struct usb_device
*hdev
, int port1
, int feature
)
534 return usb_control_msg(hdev
, usb_sndctrlpipe(hdev
, 0),
535 USB_REQ_SET_FEATURE
, USB_RT_PORT
, feature
, port1
,
540 * USB 2.0 spec Section 11.24.2.7.1.10 and table 11-7
541 * for info about using port indicators
543 static void set_port_led(
549 int status
= set_port_feature(hub
->hdev
, (selector
<< 8) | port1
,
550 USB_PORT_FEAT_INDICATOR
);
552 dev_dbg (hub
->intfdev
,
553 "port %d indicator %s status %d\n",
555 ({ char *s
; switch (selector
) {
556 case HUB_LED_AMBER
: s
= "amber"; break;
557 case HUB_LED_GREEN
: s
= "green"; break;
558 case HUB_LED_OFF
: s
= "off"; break;
559 case HUB_LED_AUTO
: s
= "auto"; break;
560 default: s
= "??"; break;
565 #define LED_CYCLE_PERIOD ((2*HZ)/3)
567 static void led_work (struct work_struct
*work
)
569 struct usb_hub
*hub
=
570 container_of(work
, struct usb_hub
, leds
.work
);
571 struct usb_device
*hdev
= hub
->hdev
;
573 unsigned changed
= 0;
576 if (hdev
->state
!= USB_STATE_CONFIGURED
|| hub
->quiescing
)
579 for (i
= 0; i
< hub
->descriptor
->bNbrPorts
; i
++) {
580 unsigned selector
, mode
;
582 /* 30%-50% duty cycle */
584 switch (hub
->indicator
[i
]) {
586 case INDICATOR_CYCLE
:
588 selector
= HUB_LED_AUTO
;
589 mode
= INDICATOR_AUTO
;
591 /* blinking green = sw attention */
592 case INDICATOR_GREEN_BLINK
:
593 selector
= HUB_LED_GREEN
;
594 mode
= INDICATOR_GREEN_BLINK_OFF
;
596 case INDICATOR_GREEN_BLINK_OFF
:
597 selector
= HUB_LED_OFF
;
598 mode
= INDICATOR_GREEN_BLINK
;
600 /* blinking amber = hw attention */
601 case INDICATOR_AMBER_BLINK
:
602 selector
= HUB_LED_AMBER
;
603 mode
= INDICATOR_AMBER_BLINK_OFF
;
605 case INDICATOR_AMBER_BLINK_OFF
:
606 selector
= HUB_LED_OFF
;
607 mode
= INDICATOR_AMBER_BLINK
;
609 /* blink green/amber = reserved */
610 case INDICATOR_ALT_BLINK
:
611 selector
= HUB_LED_GREEN
;
612 mode
= INDICATOR_ALT_BLINK_OFF
;
614 case INDICATOR_ALT_BLINK_OFF
:
615 selector
= HUB_LED_AMBER
;
616 mode
= INDICATOR_ALT_BLINK
;
621 if (selector
!= HUB_LED_AUTO
)
623 set_port_led(hub
, i
+ 1, selector
);
624 hub
->indicator
[i
] = mode
;
626 if (!changed
&& blinkenlights
) {
628 cursor
%= hub
->descriptor
->bNbrPorts
;
629 set_port_led(hub
, cursor
+ 1, HUB_LED_GREEN
);
630 hub
->indicator
[cursor
] = INDICATOR_CYCLE
;
634 schedule_delayed_work(&hub
->leds
, LED_CYCLE_PERIOD
);
637 /* use a short timeout for hub/port status fetches */
638 #define USB_STS_TIMEOUT 1000
639 #define USB_STS_RETRIES 5
642 * USB 2.0 spec Section 11.24.2.6
644 static int get_hub_status(struct usb_device
*hdev
,
645 struct usb_hub_status
*data
)
647 int i
, status
= -ETIMEDOUT
;
649 for (i
= 0; i
< USB_STS_RETRIES
&&
650 (status
== -ETIMEDOUT
|| status
== -EPIPE
); i
++) {
651 status
= usb_control_msg(hdev
, usb_rcvctrlpipe(hdev
, 0),
652 USB_REQ_GET_STATUS
, USB_DIR_IN
| USB_RT_HUB
, 0, 0,
653 data
, sizeof(*data
), USB_STS_TIMEOUT
);
659 * USB 2.0 spec Section 11.24.2.7
661 static int get_port_status(struct usb_device
*hdev
, int port1
,
662 struct usb_port_status
*data
)
664 int i
, status
= -ETIMEDOUT
;
666 for (i
= 0; i
< USB_STS_RETRIES
&&
667 (status
== -ETIMEDOUT
|| status
== -EPIPE
); i
++) {
668 status
= usb_control_msg(hdev
, usb_rcvctrlpipe(hdev
, 0),
669 USB_REQ_GET_STATUS
, USB_DIR_IN
| USB_RT_PORT
, 0, port1
,
670 data
, sizeof(*data
), USB_STS_TIMEOUT
);
675 static int hub_port_status(struct usb_hub
*hub
, int port1
,
676 u16
*status
, u16
*change
)
680 mutex_lock(&hub
->status_mutex
);
681 ret
= get_port_status(hub
->hdev
, port1
, &hub
->status
->port
);
684 dev_err(hub
->intfdev
,
685 "%s failed (err = %d)\n", __func__
, ret
);
689 *status
= le16_to_cpu(hub
->status
->port
.wPortStatus
);
690 *change
= le16_to_cpu(hub
->status
->port
.wPortChange
);
694 mutex_unlock(&hub
->status_mutex
);
698 static void kick_khubd(struct usb_hub
*hub
)
702 spin_lock_irqsave(&hub_event_lock
, flags
);
703 if (!hub
->disconnected
&& list_empty(&hub
->event_list
)) {
704 list_add_tail(&hub
->event_list
, &hub_event_list
);
706 /* Suppress autosuspend until khubd runs */
707 usb_autopm_get_interface_no_resume(
708 to_usb_interface(hub
->intfdev
));
709 wake_up(&khubd_wait
);
711 spin_unlock_irqrestore(&hub_event_lock
, flags
);
714 void usb_kick_khubd(struct usb_device
*hdev
)
716 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
723 * Let the USB core know that a USB 3.0 device has sent a Function Wake Device
724 * Notification, which indicates it had initiated remote wakeup.
726 * USB 3.0 hubs do not report the port link state change from U3 to U0 when the
727 * device initiates resume, so the USB core will not receive notice of the
728 * resume through the normal hub interrupt URB.
730 void usb_wakeup_notification(struct usb_device
*hdev
,
731 unsigned int portnum
)
738 hub
= usb_hub_to_struct_hub(hdev
);
740 set_bit(portnum
, hub
->wakeup_bits
);
744 EXPORT_SYMBOL_GPL(usb_wakeup_notification
);
746 /* completion function, fires on port status changes and various faults */
747 static void hub_irq(struct urb
*urb
)
749 struct usb_hub
*hub
= urb
->context
;
750 int status
= urb
->status
;
755 case -ENOENT
: /* synchronous unlink */
756 case -ECONNRESET
: /* async unlink */
757 case -ESHUTDOWN
: /* hardware going away */
760 default: /* presumably an error */
761 /* Cause a hub reset after 10 consecutive errors */
762 dev_dbg (hub
->intfdev
, "transfer --> %d\n", status
);
763 if ((++hub
->nerrors
< 10) || hub
->error
)
768 /* let khubd handle things */
769 case 0: /* we got data: port status changed */
771 for (i
= 0; i
< urb
->actual_length
; ++i
)
772 bits
|= ((unsigned long) ((*hub
->buffer
)[i
]))
774 hub
->event_bits
[0] = bits
;
780 /* Something happened, let khubd figure it out */
787 if ((status
= usb_submit_urb (hub
->urb
, GFP_ATOMIC
)) != 0
788 && status
!= -ENODEV
&& status
!= -EPERM
)
789 dev_err (hub
->intfdev
, "resubmit --> %d\n", status
);
792 /* USB 2.0 spec Section 11.24.2.3 */
794 hub_clear_tt_buffer (struct usb_device
*hdev
, u16 devinfo
, u16 tt
)
796 /* Need to clear both directions for control ep */
797 if (((devinfo
>> 11) & USB_ENDPOINT_XFERTYPE_MASK
) ==
798 USB_ENDPOINT_XFER_CONTROL
) {
799 int status
= usb_control_msg(hdev
, usb_sndctrlpipe(hdev
, 0),
800 HUB_CLEAR_TT_BUFFER
, USB_RT_PORT
,
801 devinfo
^ 0x8000, tt
, NULL
, 0, 1000);
805 return usb_control_msg(hdev
, usb_sndctrlpipe(hdev
, 0),
806 HUB_CLEAR_TT_BUFFER
, USB_RT_PORT
, devinfo
,
811 * enumeration blocks khubd for a long time. we use keventd instead, since
812 * long blocking there is the exception, not the rule. accordingly, HCDs
813 * talking to TTs must queue control transfers (not just bulk and iso), so
814 * both can talk to the same hub concurrently.
816 static void hub_tt_work(struct work_struct
*work
)
818 struct usb_hub
*hub
=
819 container_of(work
, struct usb_hub
, tt
.clear_work
);
822 spin_lock_irqsave (&hub
->tt
.lock
, flags
);
823 while (!list_empty(&hub
->tt
.clear_list
)) {
824 struct list_head
*next
;
825 struct usb_tt_clear
*clear
;
826 struct usb_device
*hdev
= hub
->hdev
;
827 const struct hc_driver
*drv
;
830 next
= hub
->tt
.clear_list
.next
;
831 clear
= list_entry (next
, struct usb_tt_clear
, clear_list
);
832 list_del (&clear
->clear_list
);
834 /* drop lock so HCD can concurrently report other TT errors */
835 spin_unlock_irqrestore (&hub
->tt
.lock
, flags
);
836 status
= hub_clear_tt_buffer (hdev
, clear
->devinfo
, clear
->tt
);
837 if (status
&& status
!= -ENODEV
)
839 "clear tt %d (%04x) error %d\n",
840 clear
->tt
, clear
->devinfo
, status
);
842 /* Tell the HCD, even if the operation failed */
843 drv
= clear
->hcd
->driver
;
844 if (drv
->clear_tt_buffer_complete
)
845 (drv
->clear_tt_buffer_complete
)(clear
->hcd
, clear
->ep
);
848 spin_lock_irqsave(&hub
->tt
.lock
, flags
);
850 spin_unlock_irqrestore (&hub
->tt
.lock
, flags
);
854 * usb_hub_set_port_power - control hub port's power state
857 * @set: expected status
859 * call this function to control port's power via setting or
860 * clearing the port's PORT_POWER feature.
862 int usb_hub_set_port_power(struct usb_device
*hdev
, int port1
,
866 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
867 struct usb_port
*port_dev
= hub
->ports
[port1
- 1];
870 ret
= set_port_feature(hdev
, port1
, USB_PORT_FEAT_POWER
);
872 ret
= usb_clear_port_feature(hdev
, port1
, USB_PORT_FEAT_POWER
);
875 port_dev
->power_is_on
= set
;
880 * usb_hub_clear_tt_buffer - clear control/bulk TT state in high speed hub
881 * @urb: an URB associated with the failed or incomplete split transaction
883 * High speed HCDs use this to tell the hub driver that some split control or
884 * bulk transaction failed in a way that requires clearing internal state of
885 * a transaction translator. This is normally detected (and reported) from
888 * It may not be possible for that hub to handle additional full (or low)
889 * speed transactions until that state is fully cleared out.
891 int usb_hub_clear_tt_buffer(struct urb
*urb
)
893 struct usb_device
*udev
= urb
->dev
;
894 int pipe
= urb
->pipe
;
895 struct usb_tt
*tt
= udev
->tt
;
897 struct usb_tt_clear
*clear
;
899 /* we've got to cope with an arbitrary number of pending TT clears,
900 * since each TT has "at least two" buffers that can need it (and
901 * there can be many TTs per hub). even if they're uncommon.
903 if ((clear
= kmalloc (sizeof *clear
, GFP_ATOMIC
)) == NULL
) {
904 dev_err (&udev
->dev
, "can't save CLEAR_TT_BUFFER state\n");
905 /* FIXME recover somehow ... RESET_TT? */
909 /* info that CLEAR_TT_BUFFER needs */
910 clear
->tt
= tt
->multi
? udev
->ttport
: 1;
911 clear
->devinfo
= usb_pipeendpoint (pipe
);
912 clear
->devinfo
|= udev
->devnum
<< 4;
913 clear
->devinfo
|= usb_pipecontrol (pipe
)
914 ? (USB_ENDPOINT_XFER_CONTROL
<< 11)
915 : (USB_ENDPOINT_XFER_BULK
<< 11);
916 if (usb_pipein (pipe
))
917 clear
->devinfo
|= 1 << 15;
919 /* info for completion callback */
920 clear
->hcd
= bus_to_hcd(udev
->bus
);
923 /* tell keventd to clear state for this TT */
924 spin_lock_irqsave (&tt
->lock
, flags
);
925 list_add_tail (&clear
->clear_list
, &tt
->clear_list
);
926 schedule_work(&tt
->clear_work
);
927 spin_unlock_irqrestore (&tt
->lock
, flags
);
930 EXPORT_SYMBOL_GPL(usb_hub_clear_tt_buffer
);
932 /* If do_delay is false, return the number of milliseconds the caller
935 static unsigned hub_power_on(struct usb_hub
*hub
, bool do_delay
)
938 unsigned pgood_delay
= hub
->descriptor
->bPwrOn2PwrGood
* 2;
940 u16 wHubCharacteristics
=
941 le16_to_cpu(hub
->descriptor
->wHubCharacteristics
);
943 /* Enable power on each port. Some hubs have reserved values
944 * of LPSM (> 2) in their descriptors, even though they are
945 * USB 2.0 hubs. Some hubs do not implement port-power switching
946 * but only emulate it. In all cases, the ports won't work
947 * unless we send these messages to the hub.
949 if ((wHubCharacteristics
& HUB_CHAR_LPSM
) < 2)
950 dev_dbg(hub
->intfdev
, "enabling power on all ports\n");
952 dev_dbg(hub
->intfdev
, "trying to enable port power on "
953 "non-switchable hub\n");
954 for (port1
= 1; port1
<= hub
->descriptor
->bNbrPorts
; port1
++)
955 if (hub
->ports
[port1
- 1]->power_is_on
)
956 set_port_feature(hub
->hdev
, port1
, USB_PORT_FEAT_POWER
);
958 usb_clear_port_feature(hub
->hdev
, port1
,
959 USB_PORT_FEAT_POWER
);
961 /* Wait at least 100 msec for power to become stable */
962 delay
= max(pgood_delay
, (unsigned) 100);
968 static int hub_hub_status(struct usb_hub
*hub
,
969 u16
*status
, u16
*change
)
973 mutex_lock(&hub
->status_mutex
);
974 ret
= get_hub_status(hub
->hdev
, &hub
->status
->hub
);
977 dev_err(hub
->intfdev
,
978 "%s failed (err = %d)\n", __func__
, ret
);
980 *status
= le16_to_cpu(hub
->status
->hub
.wHubStatus
);
981 *change
= le16_to_cpu(hub
->status
->hub
.wHubChange
);
984 mutex_unlock(&hub
->status_mutex
);
988 static int hub_set_port_link_state(struct usb_hub
*hub
, int port1
,
989 unsigned int link_status
)
991 return set_port_feature(hub
->hdev
,
992 port1
| (link_status
<< 3),
993 USB_PORT_FEAT_LINK_STATE
);
997 * If USB 3.0 ports are placed into the Disabled state, they will no longer
998 * detect any device connects or disconnects. This is generally not what the
999 * USB core wants, since it expects a disabled port to produce a port status
1000 * change event when a new device connects.
1002 * Instead, set the link state to Disabled, wait for the link to settle into
1003 * that state, clear any change bits, and then put the port into the RxDetect
1006 static int hub_usb3_port_disable(struct usb_hub
*hub
, int port1
)
1010 u16 portchange
, portstatus
;
1012 if (!hub_is_superspeed(hub
->hdev
))
1015 ret
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
1020 * USB controller Advanced Micro Devices, Inc. [AMD] FCH USB XHCI
1021 * Controller [1022:7814] will have spurious result making the following
1022 * usb 3.0 device hotplugging route to the 2.0 root hub and recognized
1023 * as high-speed device if we set the usb 3.0 port link state to
1024 * Disabled. Since it's already in USB_SS_PORT_LS_RX_DETECT state, we
1025 * check the state here to avoid the bug.
1027 if ((portstatus
& USB_PORT_STAT_LINK_STATE
) ==
1028 USB_SS_PORT_LS_RX_DETECT
) {
1029 dev_dbg(&hub
->ports
[port1
- 1]->dev
,
1030 "Not disabling port; link state is RxDetect\n");
1034 ret
= hub_set_port_link_state(hub
, port1
, USB_SS_PORT_LS_SS_DISABLED
);
1038 /* Wait for the link to enter the disabled state. */
1039 for (total_time
= 0; ; total_time
+= HUB_DEBOUNCE_STEP
) {
1040 ret
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
1044 if ((portstatus
& USB_PORT_STAT_LINK_STATE
) ==
1045 USB_SS_PORT_LS_SS_DISABLED
)
1047 if (total_time
>= HUB_DEBOUNCE_TIMEOUT
)
1049 msleep(HUB_DEBOUNCE_STEP
);
1051 if (total_time
>= HUB_DEBOUNCE_TIMEOUT
)
1052 dev_warn(hub
->intfdev
, "Could not disable port %d after %d ms\n",
1055 return hub_set_port_link_state(hub
, port1
, USB_SS_PORT_LS_RX_DETECT
);
1058 static int hub_port_disable(struct usb_hub
*hub
, int port1
, int set_state
)
1060 struct usb_device
*hdev
= hub
->hdev
;
1063 if (hub
->ports
[port1
- 1]->child
&& set_state
)
1064 usb_set_device_state(hub
->ports
[port1
- 1]->child
,
1065 USB_STATE_NOTATTACHED
);
1067 if (hub_is_superspeed(hub
->hdev
))
1068 ret
= hub_usb3_port_disable(hub
, port1
);
1070 ret
= usb_clear_port_feature(hdev
, port1
,
1071 USB_PORT_FEAT_ENABLE
);
1073 if (ret
&& ret
!= -ENODEV
)
1074 dev_err(hub
->intfdev
, "cannot disable port %d (err = %d)\n",
1080 * Disable a port and mark a logical connect-change event, so that some
1081 * time later khubd will disconnect() any existing usb_device on the port
1082 * and will re-enumerate if there actually is a device attached.
1084 static void hub_port_logical_disconnect(struct usb_hub
*hub
, int port1
)
1086 dev_dbg(hub
->intfdev
, "logical disconnect on port %d\n", port1
);
1087 hub_port_disable(hub
, port1
, 1);
1089 /* FIXME let caller ask to power down the port:
1090 * - some devices won't enumerate without a VBUS power cycle
1091 * - SRP saves power that way
1092 * - ... new call, TBD ...
1093 * That's easy if this hub can switch power per-port, and
1094 * khubd reactivates the port later (timer, SRP, etc).
1095 * Powerdown must be optional, because of reset/DFU.
1098 set_bit(port1
, hub
->change_bits
);
1103 * usb_remove_device - disable a device's port on its parent hub
1104 * @udev: device to be disabled and removed
1105 * Context: @udev locked, must be able to sleep.
1107 * After @udev's port has been disabled, khubd is notified and it will
1108 * see that the device has been disconnected. When the device is
1109 * physically unplugged and something is plugged in, the events will
1110 * be received and processed normally.
1112 int usb_remove_device(struct usb_device
*udev
)
1114 struct usb_hub
*hub
;
1115 struct usb_interface
*intf
;
1117 if (!udev
->parent
) /* Can't remove a root hub */
1119 hub
= usb_hub_to_struct_hub(udev
->parent
);
1120 intf
= to_usb_interface(hub
->intfdev
);
1122 usb_autopm_get_interface(intf
);
1123 set_bit(udev
->portnum
, hub
->removed_bits
);
1124 hub_port_logical_disconnect(hub
, udev
->portnum
);
1125 usb_autopm_put_interface(intf
);
1129 enum hub_activation_type
{
1130 HUB_INIT
, HUB_INIT2
, HUB_INIT3
, /* INITs must come first */
1131 HUB_POST_RESET
, HUB_RESUME
, HUB_RESET_RESUME
,
1134 static void hub_init_func2(struct work_struct
*ws
);
1135 static void hub_init_func3(struct work_struct
*ws
);
1137 static void hub_activate(struct usb_hub
*hub
, enum hub_activation_type type
)
1139 struct usb_device
*hdev
= hub
->hdev
;
1140 struct usb_hcd
*hcd
;
1144 bool need_debounce_delay
= false;
1147 /* Continue a partial initialization */
1148 if (type
== HUB_INIT2
)
1150 if (type
== HUB_INIT3
)
1153 /* The superspeed hub except for root hub has to use Hub Depth
1154 * value as an offset into the route string to locate the bits
1155 * it uses to determine the downstream port number. So hub driver
1156 * should send a set hub depth request to superspeed hub after
1157 * the superspeed hub is set configuration in initialization or
1160 * After a resume, port power should still be on.
1161 * For any other type of activation, turn it on.
1163 if (type
!= HUB_RESUME
) {
1164 if (hdev
->parent
&& hub_is_superspeed(hdev
)) {
1165 ret
= usb_control_msg(hdev
, usb_sndctrlpipe(hdev
, 0),
1166 HUB_SET_DEPTH
, USB_RT_HUB
,
1167 hdev
->level
- 1, 0, NULL
, 0,
1168 USB_CTRL_SET_TIMEOUT
);
1170 dev_err(hub
->intfdev
,
1171 "set hub depth failed\n");
1174 /* Speed up system boot by using a delayed_work for the
1175 * hub's initial power-up delays. This is pretty awkward
1176 * and the implementation looks like a home-brewed sort of
1177 * setjmp/longjmp, but it saves at least 100 ms for each
1178 * root hub (assuming usbcore is compiled into the kernel
1179 * rather than as a module). It adds up.
1181 * This can't be done for HUB_RESUME or HUB_RESET_RESUME
1182 * because for those activation types the ports have to be
1183 * operational when we return. In theory this could be done
1184 * for HUB_POST_RESET, but it's easier not to.
1186 if (type
== HUB_INIT
) {
1187 delay
= hub_power_on(hub
, false);
1188 PREPARE_DELAYED_WORK(&hub
->init_work
, hub_init_func2
);
1189 schedule_delayed_work(&hub
->init_work
,
1190 msecs_to_jiffies(delay
));
1192 /* Suppress autosuspend until init is done */
1193 usb_autopm_get_interface_no_resume(
1194 to_usb_interface(hub
->intfdev
));
1195 return; /* Continues at init2: below */
1196 } else if (type
== HUB_RESET_RESUME
) {
1197 /* The internal host controller state for the hub device
1198 * may be gone after a host power loss on system resume.
1199 * Update the device's info so the HW knows it's a hub.
1201 hcd
= bus_to_hcd(hdev
->bus
);
1202 if (hcd
->driver
->update_hub_device
) {
1203 ret
= hcd
->driver
->update_hub_device(hcd
, hdev
,
1204 &hub
->tt
, GFP_NOIO
);
1206 dev_err(hub
->intfdev
, "Host not "
1207 "accepting hub info "
1209 dev_err(hub
->intfdev
, "LS/FS devices "
1210 "and hubs may not work "
1211 "under this hub\n.");
1214 hub_power_on(hub
, true);
1216 hub_power_on(hub
, true);
1221 /* Check each port and set hub->change_bits to let khubd know
1222 * which ports need attention.
1224 for (port1
= 1; port1
<= hdev
->maxchild
; ++port1
) {
1225 struct usb_device
*udev
= hub
->ports
[port1
- 1]->child
;
1226 u16 portstatus
, portchange
;
1228 portstatus
= portchange
= 0;
1229 status
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
1230 if (udev
|| (portstatus
& USB_PORT_STAT_CONNECTION
))
1231 dev_dbg(hub
->intfdev
,
1232 "port %d: status %04x change %04x\n",
1233 port1
, portstatus
, portchange
);
1235 /* After anything other than HUB_RESUME (i.e., initialization
1236 * or any sort of reset), every port should be disabled.
1237 * Unconnected ports should likewise be disabled (paranoia),
1238 * and so should ports for which we have no usb_device.
1240 if ((portstatus
& USB_PORT_STAT_ENABLE
) && (
1241 type
!= HUB_RESUME
||
1242 !(portstatus
& USB_PORT_STAT_CONNECTION
) ||
1244 udev
->state
== USB_STATE_NOTATTACHED
)) {
1246 * USB3 protocol ports will automatically transition
1247 * to Enabled state when detect an USB3.0 device attach.
1248 * Do not disable USB3 protocol ports.
1250 if (!hub_is_superspeed(hdev
)) {
1251 usb_clear_port_feature(hdev
, port1
,
1252 USB_PORT_FEAT_ENABLE
);
1253 portstatus
&= ~USB_PORT_STAT_ENABLE
;
1255 /* Pretend that power was lost for USB3 devs */
1256 portstatus
&= ~USB_PORT_STAT_ENABLE
;
1260 /* Clear status-change flags; we'll debounce later */
1261 if (portchange
& USB_PORT_STAT_C_CONNECTION
) {
1262 need_debounce_delay
= true;
1263 usb_clear_port_feature(hub
->hdev
, port1
,
1264 USB_PORT_FEAT_C_CONNECTION
);
1266 if (portchange
& USB_PORT_STAT_C_ENABLE
) {
1267 need_debounce_delay
= true;
1268 usb_clear_port_feature(hub
->hdev
, port1
,
1269 USB_PORT_FEAT_C_ENABLE
);
1271 if (portchange
& USB_PORT_STAT_C_RESET
) {
1272 need_debounce_delay
= true;
1273 usb_clear_port_feature(hub
->hdev
, port1
,
1274 USB_PORT_FEAT_C_RESET
);
1276 if ((portchange
& USB_PORT_STAT_C_BH_RESET
) &&
1277 hub_is_superspeed(hub
->hdev
)) {
1278 need_debounce_delay
= true;
1279 usb_clear_port_feature(hub
->hdev
, port1
,
1280 USB_PORT_FEAT_C_BH_PORT_RESET
);
1282 /* We can forget about a "removed" device when there's a
1283 * physical disconnect or the connect status changes.
1285 if (!(portstatus
& USB_PORT_STAT_CONNECTION
) ||
1286 (portchange
& USB_PORT_STAT_C_CONNECTION
))
1287 clear_bit(port1
, hub
->removed_bits
);
1289 if (!udev
|| udev
->state
== USB_STATE_NOTATTACHED
) {
1290 /* Tell khubd to disconnect the device or
1291 * check for a new connection
1293 if (udev
|| (portstatus
& USB_PORT_STAT_CONNECTION
))
1294 set_bit(port1
, hub
->change_bits
);
1296 } else if (portstatus
& USB_PORT_STAT_ENABLE
) {
1297 bool port_resumed
= (portstatus
&
1298 USB_PORT_STAT_LINK_STATE
) ==
1300 /* The power session apparently survived the resume.
1301 * If there was an overcurrent or suspend change
1302 * (i.e., remote wakeup request), have khubd
1303 * take care of it. Look at the port link state
1304 * for USB 3.0 hubs, since they don't have a suspend
1305 * change bit, and they don't set the port link change
1306 * bit on device-initiated resume.
1308 if (portchange
|| (hub_is_superspeed(hub
->hdev
) &&
1310 set_bit(port1
, hub
->change_bits
);
1312 } else if (udev
->persist_enabled
) {
1313 struct usb_port
*port_dev
= hub
->ports
[port1
- 1];
1316 udev
->reset_resume
= 1;
1318 /* Don't set the change_bits when the device
1321 if (port_dev
->power_is_on
)
1322 set_bit(port1
, hub
->change_bits
);
1325 /* The power session is gone; tell khubd */
1326 usb_set_device_state(udev
, USB_STATE_NOTATTACHED
);
1327 set_bit(port1
, hub
->change_bits
);
1331 /* If no port-status-change flags were set, we don't need any
1332 * debouncing. If flags were set we can try to debounce the
1333 * ports all at once right now, instead of letting khubd do them
1334 * one at a time later on.
1336 * If any port-status changes do occur during this delay, khubd
1337 * will see them later and handle them normally.
1339 if (need_debounce_delay
) {
1340 delay
= HUB_DEBOUNCE_STABLE
;
1342 /* Don't do a long sleep inside a workqueue routine */
1343 if (type
== HUB_INIT2
) {
1344 PREPARE_DELAYED_WORK(&hub
->init_work
, hub_init_func3
);
1345 schedule_delayed_work(&hub
->init_work
,
1346 msecs_to_jiffies(delay
));
1347 return; /* Continues at init3: below */
1355 status
= usb_submit_urb(hub
->urb
, GFP_NOIO
);
1357 dev_err(hub
->intfdev
, "activate --> %d\n", status
);
1358 if (hub
->has_indicators
&& blinkenlights
)
1359 schedule_delayed_work(&hub
->leds
, LED_CYCLE_PERIOD
);
1361 /* Scan all ports that need attention */
1364 /* Allow autosuspend if it was suppressed */
1365 if (type
<= HUB_INIT3
)
1366 usb_autopm_put_interface_async(to_usb_interface(hub
->intfdev
));
1369 /* Implement the continuations for the delays above */
1370 static void hub_init_func2(struct work_struct
*ws
)
1372 struct usb_hub
*hub
= container_of(ws
, struct usb_hub
, init_work
.work
);
1374 hub_activate(hub
, HUB_INIT2
);
1377 static void hub_init_func3(struct work_struct
*ws
)
1379 struct usb_hub
*hub
= container_of(ws
, struct usb_hub
, init_work
.work
);
1381 hub_activate(hub
, HUB_INIT3
);
1384 enum hub_quiescing_type
{
1385 HUB_DISCONNECT
, HUB_PRE_RESET
, HUB_SUSPEND
1388 static void hub_quiesce(struct usb_hub
*hub
, enum hub_quiescing_type type
)
1390 struct usb_device
*hdev
= hub
->hdev
;
1393 cancel_delayed_work_sync(&hub
->init_work
);
1395 /* khubd and related activity won't re-trigger */
1398 if (type
!= HUB_SUSPEND
) {
1399 /* Disconnect all the children */
1400 for (i
= 0; i
< hdev
->maxchild
; ++i
) {
1401 if (hub
->ports
[i
]->child
)
1402 usb_disconnect(&hub
->ports
[i
]->child
);
1406 /* Stop khubd and related activity */
1407 usb_kill_urb(hub
->urb
);
1408 if (hub
->has_indicators
)
1409 cancel_delayed_work_sync(&hub
->leds
);
1411 flush_work(&hub
->tt
.clear_work
);
1414 /* caller has locked the hub device */
1415 static int hub_pre_reset(struct usb_interface
*intf
)
1417 struct usb_hub
*hub
= usb_get_intfdata(intf
);
1419 hub_quiesce(hub
, HUB_PRE_RESET
);
1423 /* caller has locked the hub device */
1424 static int hub_post_reset(struct usb_interface
*intf
)
1426 struct usb_hub
*hub
= usb_get_intfdata(intf
);
1428 hub_activate(hub
, HUB_POST_RESET
);
1432 static int hub_configure(struct usb_hub
*hub
,
1433 struct usb_endpoint_descriptor
*endpoint
)
1435 struct usb_hcd
*hcd
;
1436 struct usb_device
*hdev
= hub
->hdev
;
1437 struct device
*hub_dev
= hub
->intfdev
;
1438 u16 hubstatus
, hubchange
;
1439 u16 wHubCharacteristics
;
1442 char *message
= "out of memory";
1446 hub
->buffer
= kmalloc(sizeof(*hub
->buffer
), GFP_KERNEL
);
1452 hub
->status
= kmalloc(sizeof(*hub
->status
), GFP_KERNEL
);
1457 mutex_init(&hub
->status_mutex
);
1459 hub
->descriptor
= kmalloc(sizeof(*hub
->descriptor
), GFP_KERNEL
);
1460 if (!hub
->descriptor
) {
1465 /* Request the entire hub descriptor.
1466 * hub->descriptor can handle USB_MAXCHILDREN ports,
1467 * but the hub can/will return fewer bytes here.
1469 ret
= get_hub_descriptor(hdev
, hub
->descriptor
);
1471 message
= "can't read hub descriptor";
1473 } else if (hub
->descriptor
->bNbrPorts
> USB_MAXCHILDREN
) {
1474 message
= "hub has too many ports!";
1477 } else if (hub
->descriptor
->bNbrPorts
== 0) {
1478 message
= "hub doesn't have any ports!";
1483 hdev
->maxchild
= hub
->descriptor
->bNbrPorts
;
1484 dev_info (hub_dev
, "%d port%s detected\n", hdev
->maxchild
,
1485 (hdev
->maxchild
== 1) ? "" : "s");
1487 hub
->ports
= kzalloc(hdev
->maxchild
* sizeof(struct usb_port
*),
1494 wHubCharacteristics
= le16_to_cpu(hub
->descriptor
->wHubCharacteristics
);
1495 if (hub_is_superspeed(hdev
)) {
1503 /* FIXME for USB 3.0, skip for now */
1504 if ((wHubCharacteristics
& HUB_CHAR_COMPOUND
) &&
1505 !(hub_is_superspeed(hdev
))) {
1507 char portstr
[USB_MAXCHILDREN
+ 1];
1509 for (i
= 0; i
< hdev
->maxchild
; i
++)
1510 portstr
[i
] = hub
->descriptor
->u
.hs
.DeviceRemovable
1511 [((i
+ 1) / 8)] & (1 << ((i
+ 1) % 8))
1513 portstr
[hdev
->maxchild
] = 0;
1514 dev_dbg(hub_dev
, "compound device; port removable status: %s\n", portstr
);
1516 dev_dbg(hub_dev
, "standalone hub\n");
1518 switch (wHubCharacteristics
& HUB_CHAR_LPSM
) {
1519 case HUB_CHAR_COMMON_LPSM
:
1520 dev_dbg(hub_dev
, "ganged power switching\n");
1522 case HUB_CHAR_INDV_PORT_LPSM
:
1523 dev_dbg(hub_dev
, "individual port power switching\n");
1525 case HUB_CHAR_NO_LPSM
:
1527 dev_dbg(hub_dev
, "no power switching (usb 1.0)\n");
1531 switch (wHubCharacteristics
& HUB_CHAR_OCPM
) {
1532 case HUB_CHAR_COMMON_OCPM
:
1533 dev_dbg(hub_dev
, "global over-current protection\n");
1535 case HUB_CHAR_INDV_PORT_OCPM
:
1536 dev_dbg(hub_dev
, "individual port over-current protection\n");
1538 case HUB_CHAR_NO_OCPM
:
1540 dev_dbg(hub_dev
, "no over-current protection\n");
1544 spin_lock_init (&hub
->tt
.lock
);
1545 INIT_LIST_HEAD (&hub
->tt
.clear_list
);
1546 INIT_WORK(&hub
->tt
.clear_work
, hub_tt_work
);
1547 switch (hdev
->descriptor
.bDeviceProtocol
) {
1550 case USB_HUB_PR_HS_SINGLE_TT
:
1551 dev_dbg(hub_dev
, "Single TT\n");
1554 case USB_HUB_PR_HS_MULTI_TT
:
1555 ret
= usb_set_interface(hdev
, 0, 1);
1557 dev_dbg(hub_dev
, "TT per port\n");
1560 dev_err(hub_dev
, "Using single TT (err %d)\n",
1565 /* USB 3.0 hubs don't have a TT */
1568 dev_dbg(hub_dev
, "Unrecognized hub protocol %d\n",
1569 hdev
->descriptor
.bDeviceProtocol
);
1573 /* Note 8 FS bit times == (8 bits / 12000000 bps) ~= 666ns */
1574 switch (wHubCharacteristics
& HUB_CHAR_TTTT
) {
1575 case HUB_TTTT_8_BITS
:
1576 if (hdev
->descriptor
.bDeviceProtocol
!= 0) {
1577 hub
->tt
.think_time
= 666;
1578 dev_dbg(hub_dev
, "TT requires at most %d "
1579 "FS bit times (%d ns)\n",
1580 8, hub
->tt
.think_time
);
1583 case HUB_TTTT_16_BITS
:
1584 hub
->tt
.think_time
= 666 * 2;
1585 dev_dbg(hub_dev
, "TT requires at most %d "
1586 "FS bit times (%d ns)\n",
1587 16, hub
->tt
.think_time
);
1589 case HUB_TTTT_24_BITS
:
1590 hub
->tt
.think_time
= 666 * 3;
1591 dev_dbg(hub_dev
, "TT requires at most %d "
1592 "FS bit times (%d ns)\n",
1593 24, hub
->tt
.think_time
);
1595 case HUB_TTTT_32_BITS
:
1596 hub
->tt
.think_time
= 666 * 4;
1597 dev_dbg(hub_dev
, "TT requires at most %d "
1598 "FS bit times (%d ns)\n",
1599 32, hub
->tt
.think_time
);
1603 /* probe() zeroes hub->indicator[] */
1604 if (wHubCharacteristics
& HUB_CHAR_PORTIND
) {
1605 hub
->has_indicators
= 1;
1606 dev_dbg(hub_dev
, "Port indicators are supported\n");
1609 dev_dbg(hub_dev
, "power on to power good time: %dms\n",
1610 hub
->descriptor
->bPwrOn2PwrGood
* 2);
1612 /* power budgeting mostly matters with bus-powered hubs,
1613 * and battery-powered root hubs (may provide just 8 mA).
1615 ret
= usb_get_status(hdev
, USB_RECIP_DEVICE
, 0, &hubstatus
);
1617 message
= "can't get hub status";
1620 le16_to_cpus(&hubstatus
);
1621 hcd
= bus_to_hcd(hdev
->bus
);
1622 if (hdev
== hdev
->bus
->root_hub
) {
1623 if (hcd
->power_budget
> 0)
1624 hdev
->bus_mA
= hcd
->power_budget
;
1626 hdev
->bus_mA
= full_load
* hdev
->maxchild
;
1627 if (hdev
->bus_mA
>= full_load
)
1628 hub
->mA_per_port
= full_load
;
1630 hub
->mA_per_port
= hdev
->bus_mA
;
1631 hub
->limited_power
= 1;
1633 } else if ((hubstatus
& (1 << USB_DEVICE_SELF_POWERED
)) == 0) { // bus powered
1634 int remaining
= hdev
->bus_mA
-
1635 hub
->descriptor
->bHubContrCurrent
;
1637 dev_dbg(hub_dev
, "hub controller current requirement: %dmA\n",
1638 hub
->descriptor
->bHubContrCurrent
);
1639 hub
->limited_power
= 1;
1641 if (remaining
< hdev
->maxchild
* unit_load
){
1642 #if defined(CONFIG_USBIF_COMPLIANCE) && defined(CONFIG_USB_XHCI_HCD)
1643 usbif_u3h_send_event("DEV_OVER_CURRENT");
1646 "insufficient power available "
1647 "to use all downstream ports\n");
1649 hub
->mA_per_port
= unit_load
; /* 7.2.1 */
1651 } else { /* Self-powered external hub */
1652 /* FIXME: What about battery-powered external hubs that
1653 * provide less current per port? */
1654 hub
->mA_per_port
= full_load
;
1656 if (hub
->mA_per_port
< full_load
)
1657 dev_dbg(hub_dev
, "%umA bus power budget for each child\n",
1660 /* Update the HCD's internal representation of this hub before khubd
1661 * starts getting port status changes for devices under the hub.
1663 if (hcd
->driver
->update_hub_device
) {
1664 ret
= hcd
->driver
->update_hub_device(hcd
, hdev
,
1665 &hub
->tt
, GFP_KERNEL
);
1667 message
= "can't update HCD hub info";
1672 ret
= hub_hub_status(hub
, &hubstatus
, &hubchange
);
1674 message
= "can't get hub status";
1678 /* local power status reports aren't always correct */
1679 if (hdev
->actconfig
->desc
.bmAttributes
& USB_CONFIG_ATT_SELFPOWER
)
1680 dev_dbg(hub_dev
, "local power source is %s\n",
1681 (hubstatus
& HUB_STATUS_LOCAL_POWER
)
1682 ? "lost (inactive)" : "good");
1684 if ((wHubCharacteristics
& HUB_CHAR_OCPM
) == 0)
1685 dev_dbg(hub_dev
, "%sover-current condition exists\n",
1686 (hubstatus
& HUB_STATUS_OVERCURRENT
) ? "" : "no ");
1688 /* set up the interrupt endpoint
1689 * We use the EP's maxpacket size instead of (PORTS+1+7)/8
1690 * bytes as USB2.0[11.12.3] says because some hubs are known
1691 * to send more data (and thus cause overflow). For root hubs,
1692 * maxpktsize is defined in hcd.c's fake endpoint descriptors
1693 * to be big enough for at least USB_MAXCHILDREN ports. */
1694 pipe
= usb_rcvintpipe(hdev
, endpoint
->bEndpointAddress
);
1695 maxp
= usb_maxpacket(hdev
, pipe
, usb_pipeout(pipe
));
1697 if (maxp
> sizeof(*hub
->buffer
))
1698 maxp
= sizeof(*hub
->buffer
);
1700 hub
->urb
= usb_alloc_urb(0, GFP_KERNEL
);
1706 usb_fill_int_urb(hub
->urb
, hdev
, pipe
, *hub
->buffer
, maxp
, hub_irq
,
1707 hub
, endpoint
->bInterval
);
1709 /* maybe cycle the hub leds */
1710 if (hub
->has_indicators
&& blinkenlights
)
1711 hub
->indicator
[0] = INDICATOR_CYCLE
;
1713 for (i
= 0; i
< hdev
->maxchild
; i
++) {
1714 ret
= usb_hub_create_port_device(hub
, i
+ 1);
1716 dev_err(hub
->intfdev
,
1717 "couldn't create port%d device.\n", i
+ 1);
1719 goto fail_keep_maxchild
;
1723 usb_hub_adjust_deviceremovable(hdev
, hub
->descriptor
);
1725 hub_activate(hub
, HUB_INIT
);
1731 dev_err (hub_dev
, "config failed, %s (err %d)\n",
1733 /* hub_disconnect() frees urb and descriptor */
1737 static void hub_release(struct kref
*kref
)
1739 struct usb_hub
*hub
= container_of(kref
, struct usb_hub
, kref
);
1741 usb_put_intf(to_usb_interface(hub
->intfdev
));
1745 static unsigned highspeed_hubs
;
1747 static void hub_disconnect(struct usb_interface
*intf
)
1749 struct usb_hub
*hub
= usb_get_intfdata(intf
);
1750 struct usb_device
*hdev
= interface_to_usbdev(intf
);
1753 /* Take the hub off the event list and don't let it be added again */
1754 spin_lock_irq(&hub_event_lock
);
1755 if (!list_empty(&hub
->event_list
)) {
1756 list_del_init(&hub
->event_list
);
1757 usb_autopm_put_interface_no_suspend(intf
);
1759 hub
->disconnected
= 1;
1760 spin_unlock_irq(&hub_event_lock
);
1762 /* Disconnect all children and quiesce the hub */
1764 hub_quiesce(hub
, HUB_DISCONNECT
);
1766 /* Avoid races with recursively_mark_NOTATTACHED() */
1767 spin_lock_irq(&device_state_lock
);
1768 port1
= hdev
->maxchild
;
1770 usb_set_intfdata(intf
, NULL
);
1771 spin_unlock_irq(&device_state_lock
);
1773 for (; port1
> 0; --port1
)
1774 usb_hub_remove_port_device(hub
, port1
);
1776 if (hub
->hdev
->speed
== USB_SPEED_HIGH
)
1779 usb_free_urb(hub
->urb
);
1781 kfree(hub
->descriptor
);
1785 pm_suspend_ignore_children(&intf
->dev
, false);
1786 kref_put(&hub
->kref
, hub_release
);
1789 static int hub_probe(struct usb_interface
*intf
, const struct usb_device_id
*id
)
1791 struct usb_host_interface
*desc
;
1792 struct usb_endpoint_descriptor
*endpoint
;
1793 struct usb_device
*hdev
;
1794 struct usb_hub
*hub
;
1797 desc
= intf
->cur_altsetting
;
1798 hdev
= interface_to_usbdev(intf
);
1801 * Set default autosuspend delay as 0 to speedup bus suspend,
1802 * based on the below considerations:
1804 * - Unlike other drivers, the hub driver does not rely on the
1805 * autosuspend delay to provide enough time to handle a wakeup
1806 * event, and the submitted status URB is just to check future
1807 * change on hub downstream ports, so it is safe to do it.
1809 * - The patch might cause one or more auto supend/resume for
1810 * below very rare devices when they are plugged into hub
1813 * devices having trouble initializing, and disconnect
1814 * themselves from the bus and then reconnect a second
1817 * devices just for downloading firmware, and disconnects
1818 * themselves after completing it
1820 * For these quite rare devices, their drivers may change the
1821 * autosuspend delay of their parent hub in the probe() to one
1822 * appropriate value to avoid the subtle problem if someone
1825 * - The patch may cause one or more auto suspend/resume on
1826 * hub during running 'lsusb', but it is probably too
1827 * infrequent to worry about.
1829 * - Change autosuspend delay of hub can avoid unnecessary auto
1830 * suspend timer for hub, also may decrease power consumption
1833 * - If user has indicated to prevent autosuspend by passing
1834 * usbcore.autosuspend = -1 then keep autosuspend disabled.
1836 #ifdef CONFIG_PM_RUNTIME
1837 if (hdev
->dev
.power
.autosuspend_delay
>= 0)
1838 pm_runtime_set_autosuspend_delay(&hdev
->dev
, 0);
1842 * Hubs have proper suspend/resume support, except for root hubs
1843 * where the controller driver doesn't have bus_suspend and
1844 * bus_resume methods.
1846 if (hdev
->parent
) { /* normal device */
1847 usb_enable_autosuspend(hdev
);
1848 } else { /* root hub */
1849 const struct hc_driver
*drv
= bus_to_hcd(hdev
->bus
)->driver
;
1851 if (drv
->bus_suspend
&& drv
->bus_resume
)
1852 usb_enable_autosuspend(hdev
);
1855 if (hdev
->level
== MAX_TOPO_LEVEL
) {
1857 "Unsupported bus topology: hub nested too deep\n");
1858 #if defined(CONFIG_USBIF_COMPLIANCE) && defined(CONFIG_USB_XHCI_HCD)
1859 usbif_u3h_send_event("MAX_HUB_TIER_EXCEED");
1864 #ifdef CONFIG_USB_OTG_BLACKLIST_HUB
1866 dev_warn(&intf
->dev
, "ignoring external hub\n");
1867 #if defined(CONFIG_USBIF_COMPLIANCE) && defined(CONFIG_USB_XHCI_HCD)
1868 usbif_u3h_send_event("HUB_NOT_SUPPORTED");
1874 /* Some hubs have a subclass of 1, which AFAICT according to the */
1875 /* specs is not defined, but it works */
1876 if ((desc
->desc
.bInterfaceSubClass
!= 0) &&
1877 (desc
->desc
.bInterfaceSubClass
!= 1)) {
1879 dev_err (&intf
->dev
, "bad descriptor, ignoring hub\n");
1883 /* Multiple endpoints? What kind of mutant ninja-hub is this? */
1884 if (desc
->desc
.bNumEndpoints
!= 1)
1885 goto descriptor_error
;
1887 endpoint
= &desc
->endpoint
[0].desc
;
1889 /* If it's not an interrupt in endpoint, we'd better punt! */
1890 if (!usb_endpoint_is_int_in(endpoint
))
1891 goto descriptor_error
;
1893 /* We found a hub */
1894 dev_info (&intf
->dev
, "USB hub found\n");
1896 hub
= kzalloc(sizeof(*hub
), GFP_KERNEL
);
1898 dev_dbg (&intf
->dev
, "couldn't kmalloc hub struct\n");
1902 kref_init(&hub
->kref
);
1903 INIT_LIST_HEAD(&hub
->event_list
);
1904 hub
->intfdev
= &intf
->dev
;
1906 INIT_DELAYED_WORK(&hub
->leds
, led_work
);
1907 INIT_DELAYED_WORK(&hub
->init_work
, NULL
);
1910 usb_set_intfdata (intf
, hub
);
1911 intf
->needs_remote_wakeup
= 1;
1912 pm_suspend_ignore_children(&intf
->dev
, true);
1914 if (hdev
->speed
== USB_SPEED_HIGH
)
1917 if (id
->driver_info
& HUB_QUIRK_CHECK_PORT_AUTOSUSPEND
)
1918 hub
->quirk_check_port_auto_suspend
= 1;
1920 if (hub_configure(hub
, endpoint
) >= 0)
1923 hub_disconnect (intf
);
1928 hub_ioctl(struct usb_interface
*intf
, unsigned int code
, void *user_data
)
1930 struct usb_device
*hdev
= interface_to_usbdev (intf
);
1931 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
1933 /* assert ifno == 0 (part of hub spec) */
1935 case USBDEVFS_HUB_PORTINFO
: {
1936 struct usbdevfs_hub_portinfo
*info
= user_data
;
1939 spin_lock_irq(&device_state_lock
);
1940 if (hdev
->devnum
<= 0)
1943 info
->nports
= hdev
->maxchild
;
1944 for (i
= 0; i
< info
->nports
; i
++) {
1945 if (hub
->ports
[i
]->child
== NULL
)
1949 hub
->ports
[i
]->child
->devnum
;
1952 spin_unlock_irq(&device_state_lock
);
1954 return info
->nports
+ 1;
1963 * Allow user programs to claim ports on a hub. When a device is attached
1964 * to one of these "claimed" ports, the program will "own" the device.
1966 static int find_port_owner(struct usb_device
*hdev
, unsigned port1
,
1967 struct dev_state
***ppowner
)
1969 if (hdev
->state
== USB_STATE_NOTATTACHED
)
1971 if (port1
== 0 || port1
> hdev
->maxchild
)
1974 /* This assumes that devices not managed by the hub driver
1975 * will always have maxchild equal to 0.
1977 *ppowner
= &(usb_hub_to_struct_hub(hdev
)->ports
[port1
- 1]->port_owner
);
1981 /* In the following three functions, the caller must hold hdev's lock */
1982 int usb_hub_claim_port(struct usb_device
*hdev
, unsigned port1
,
1983 struct dev_state
*owner
)
1986 struct dev_state
**powner
;
1988 rc
= find_port_owner(hdev
, port1
, &powner
);
1997 int usb_hub_release_port(struct usb_device
*hdev
, unsigned port1
,
1998 struct dev_state
*owner
)
2001 struct dev_state
**powner
;
2003 rc
= find_port_owner(hdev
, port1
, &powner
);
2006 if (*powner
!= owner
)
2012 void usb_hub_release_all_ports(struct usb_device
*hdev
, struct dev_state
*owner
)
2014 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
2017 for (n
= 0; n
< hdev
->maxchild
; n
++) {
2018 if (hub
->ports
[n
]->port_owner
== owner
)
2019 hub
->ports
[n
]->port_owner
= NULL
;
2024 /* The caller must hold udev's lock */
2025 bool usb_device_is_owned(struct usb_device
*udev
)
2027 struct usb_hub
*hub
;
2029 if (udev
->state
== USB_STATE_NOTATTACHED
|| !udev
->parent
)
2031 hub
= usb_hub_to_struct_hub(udev
->parent
);
2032 return !!hub
->ports
[udev
->portnum
- 1]->port_owner
;
2035 static void recursively_mark_NOTATTACHED(struct usb_device
*udev
)
2037 struct usb_hub
*hub
= usb_hub_to_struct_hub(udev
);
2040 for (i
= 0; i
< udev
->maxchild
; ++i
) {
2041 if (hub
->ports
[i
]->child
)
2042 recursively_mark_NOTATTACHED(hub
->ports
[i
]->child
);
2044 if (udev
->state
== USB_STATE_SUSPENDED
)
2045 udev
->active_duration
-= jiffies
;
2046 udev
->state
= USB_STATE_NOTATTACHED
;
2050 * usb_set_device_state - change a device's current state (usbcore, hcds)
2051 * @udev: pointer to device whose state should be changed
2052 * @new_state: new state value to be stored
2054 * udev->state is _not_ fully protected by the device lock. Although
2055 * most transitions are made only while holding the lock, the state can
2056 * can change to USB_STATE_NOTATTACHED at almost any time. This
2057 * is so that devices can be marked as disconnected as soon as possible,
2058 * without having to wait for any semaphores to be released. As a result,
2059 * all changes to any device's state must be protected by the
2060 * device_state_lock spinlock.
2062 * Once a device has been added to the device tree, all changes to its state
2063 * should be made using this routine. The state should _not_ be set directly.
2065 * If udev->state is already USB_STATE_NOTATTACHED then no change is made.
2066 * Otherwise udev->state is set to new_state, and if new_state is
2067 * USB_STATE_NOTATTACHED then all of udev's descendants' states are also set
2068 * to USB_STATE_NOTATTACHED.
2070 void usb_set_device_state(struct usb_device
*udev
,
2071 enum usb_device_state new_state
)
2073 unsigned long flags
;
2076 spin_lock_irqsave(&device_state_lock
, flags
);
2077 if (udev
->state
== USB_STATE_NOTATTACHED
)
2079 else if (new_state
!= USB_STATE_NOTATTACHED
) {
2081 /* root hub wakeup capabilities are managed out-of-band
2082 * and may involve silicon errata ... ignore them here.
2085 if (udev
->state
== USB_STATE_SUSPENDED
2086 || new_state
== USB_STATE_SUSPENDED
)
2087 ; /* No change to wakeup settings */
2088 else if (new_state
== USB_STATE_CONFIGURED
)
2089 wakeup
= udev
->actconfig
->desc
.bmAttributes
2090 & USB_CONFIG_ATT_WAKEUP
;
2094 if (udev
->state
== USB_STATE_SUSPENDED
&&
2095 new_state
!= USB_STATE_SUSPENDED
)
2096 udev
->active_duration
-= jiffies
;
2097 else if (new_state
== USB_STATE_SUSPENDED
&&
2098 udev
->state
!= USB_STATE_SUSPENDED
)
2099 udev
->active_duration
+= jiffies
;
2100 udev
->state
= new_state
;
2102 recursively_mark_NOTATTACHED(udev
);
2103 spin_unlock_irqrestore(&device_state_lock
, flags
);
2105 device_set_wakeup_capable(&udev
->dev
, wakeup
);
2107 EXPORT_SYMBOL_GPL(usb_set_device_state
);
2110 * Choose a device number.
2112 * Device numbers are used as filenames in usbfs. On USB-1.1 and
2113 * USB-2.0 buses they are also used as device addresses, however on
2114 * USB-3.0 buses the address is assigned by the controller hardware
2115 * and it usually is not the same as the device number.
2117 * WUSB devices are simple: they have no hubs behind, so the mapping
2118 * device <-> virtual port number becomes 1:1. Why? to simplify the
2119 * life of the device connection logic in
2120 * drivers/usb/wusbcore/devconnect.c. When we do the initial secret
2121 * handshake we need to assign a temporary address in the unauthorized
2122 * space. For simplicity we use the first virtual port number found to
2123 * be free [drivers/usb/wusbcore/devconnect.c:wusbhc_devconnect_ack()]
2124 * and that becomes it's address [X < 128] or its unauthorized address
2127 * We add 1 as an offset to the one-based USB-stack port number
2128 * (zero-based wusb virtual port index) for two reasons: (a) dev addr
2129 * 0 is reserved by USB for default address; (b) Linux's USB stack
2130 * uses always #1 for the root hub of the controller. So USB stack's
2131 * port #1, which is wusb virtual-port #0 has address #2.
2133 * Devices connected under xHCI are not as simple. The host controller
2134 * supports virtualization, so the hardware assigns device addresses and
2135 * the HCD must setup data structures before issuing a set address
2136 * command to the hardware.
2138 static void choose_devnum(struct usb_device
*udev
)
2141 struct usb_bus
*bus
= udev
->bus
;
2143 /* If khubd ever becomes multithreaded, this will need a lock */
2145 devnum
= udev
->portnum
+ 1;
2146 BUG_ON(test_bit(devnum
, bus
->devmap
.devicemap
));
2148 /* Try to allocate the next devnum beginning at
2149 * bus->devnum_next. */
2150 devnum
= find_next_zero_bit(bus
->devmap
.devicemap
, 128,
2153 devnum
= find_next_zero_bit(bus
->devmap
.devicemap
,
2155 bus
->devnum_next
= ( devnum
>= 127 ? 1 : devnum
+ 1);
2158 set_bit(devnum
, bus
->devmap
.devicemap
);
2159 udev
->devnum
= devnum
;
2163 static void release_devnum(struct usb_device
*udev
)
2165 if (udev
->devnum
> 0) {
2166 clear_bit(udev
->devnum
, udev
->bus
->devmap
.devicemap
);
2171 static void update_devnum(struct usb_device
*udev
, int devnum
)
2173 /* The address for a WUSB device is managed by wusbcore. */
2175 udev
->devnum
= devnum
;
2178 static void hub_free_dev(struct usb_device
*udev
)
2180 struct usb_hcd
*hcd
= bus_to_hcd(udev
->bus
);
2182 /* Root hubs aren't real devices, so don't free HCD resources */
2183 if (hcd
->driver
->free_dev
&& udev
->parent
)
2184 hcd
->driver
->free_dev(hcd
, udev
);
2188 * usb_disconnect - disconnect a device (usbcore-internal)
2189 * @pdev: pointer to device being disconnected
2190 * Context: !in_interrupt ()
2192 * Something got disconnected. Get rid of it and all of its children.
2194 * If *pdev is a normal device then the parent hub must already be locked.
2195 * If *pdev is a root hub then this routine will acquire the
2196 * usb_bus_list_lock on behalf of the caller.
2198 * Only hub drivers (including virtual root hub drivers for host
2199 * controllers) should ever call this.
2201 * This call is synchronous, and may not be used in an interrupt context.
2203 void usb_disconnect(struct usb_device
**pdev
)
2205 struct usb_device
*udev
= *pdev
;
2206 struct usb_hub
*hub
= usb_hub_to_struct_hub(udev
);
2208 struct timeval tv_begin
, tv_end
;
2209 struct timeval tv_before
, tv_after
;
2210 do_gettimeofday(&tv_begin
);
2212 #ifdef CONFIG_MTK_ICUSB_SUPPORT
2216 #ifdef CONFIG_MTK_ICUSB_SUPPORT
2217 is_icusb_rh
= is_musbfsh_rh(udev
->parent
);
2221 /* mark the device as inactive, so any further urb submissions for
2222 * this device (and any of its children) will fail immediately.
2223 * this quiesces everything except pending urbs.
2225 usb_set_device_state(udev
, USB_STATE_NOTATTACHED
);
2226 dev_info(&udev
->dev
, "USB disconnect, device number %d\n",
2229 usb_lock_device(udev
);
2231 /* Free up all the children before we remove this device */
2232 for (i
= 0; i
< udev
->maxchild
; i
++) {
2233 if (hub
->ports
[i
]->child
)
2234 usb_disconnect(&hub
->ports
[i
]->child
);
2237 /* deallocate hcd/hardware state ... nuking all pending urbs and
2238 * cleaning up all state associated with the current configuration
2239 * so that the hardware is now fully quiesced.
2241 dev_dbg (&udev
->dev
, "unregistering device\n");
2243 do_gettimeofday(&tv_before
);
2244 usb_disable_device(udev
, 0);
2245 do_gettimeofday(&tv_after
);
2246 MYDBG("usb_disable_device(), time spent, sec : %d, usec : %d\n", (unsigned int)(tv_after
.tv_sec
- tv_before
.tv_sec
), (unsigned int)(tv_after
.tv_usec
- tv_before
.tv_usec
));
2248 usb_hcd_synchronize_unlinks(udev
);
2251 struct usb_hub
*hub
= usb_hub_to_struct_hub(udev
->parent
);
2252 struct usb_port
*port_dev
= hub
->ports
[udev
->portnum
- 1];
2254 sysfs_remove_link(&udev
->dev
.kobj
, "port");
2255 sysfs_remove_link(&port_dev
->dev
.kobj
, "device");
2257 if (!port_dev
->did_runtime_put
)
2258 pm_runtime_put(&port_dev
->dev
);
2260 port_dev
->did_runtime_put
= false;
2263 do_gettimeofday(&tv_before
);
2264 usb_remove_ep_devs(&udev
->ep0
);
2265 do_gettimeofday(&tv_after
);
2266 MYDBG("usb_remove_ep_devs(), time spent, sec : %d, usec : %d\n", (unsigned int)(tv_after
.tv_sec
- tv_before
.tv_sec
), (unsigned int)(tv_after
.tv_usec
- tv_before
.tv_usec
));
2268 usb_unlock_device(udev
);
2270 /* Unregister the device. The device driver is responsible
2271 * for de-configuring the device and invoking the remove-device
2272 * notifier chain (used by usbfs and possibly others).
2274 do_gettimeofday(&tv_before
);
2275 device_del(&udev
->dev
);
2276 do_gettimeofday(&tv_after
);
2277 MYDBG("device_del(), time spent, sec : %d, usec : %d\n", (unsigned int)(tv_after
.tv_sec
- tv_before
.tv_sec
), (unsigned int)(tv_after
.tv_usec
- tv_before
.tv_usec
));
2279 /* Free the device number and delete the parent's children[]
2280 * (or root_hub) pointer.
2282 release_devnum(udev
);
2284 /* Avoid races with recursively_mark_NOTATTACHED() */
2285 spin_lock_irq(&device_state_lock
);
2287 spin_unlock_irq(&device_state_lock
);
2291 put_device(&udev
->dev
);
2293 #ifdef CONFIG_MTK_ICUSB_SUPPORT
2296 set_icusb_sts_disconnect_done();
2297 MYDBG("ICUSB Disconnect\n");
2300 do_gettimeofday(&tv_end
);
2301 MYDBG("time spent, sec : %d, usec : %d\n", (unsigned int)(tv_end
.tv_sec
- tv_begin
.tv_sec
), (unsigned int)(tv_end
.tv_usec
- tv_begin
.tv_usec
));
2304 #ifdef CONFIG_USB_ANNOUNCE_NEW_DEVICES
2305 static void show_string(struct usb_device
*udev
, char *id
, char *string
)
2309 dev_info(&udev
->dev
, "%s: %s\n", id
, string
);
2312 static void announce_device(struct usb_device
*udev
)
2314 dev_info(&udev
->dev
, "New USB device found, idVendor=%04x, idProduct=%04x\n",
2315 le16_to_cpu(udev
->descriptor
.idVendor
),
2316 le16_to_cpu(udev
->descriptor
.idProduct
));
2317 dev_info(&udev
->dev
,
2318 "New USB device strings: Mfr=%d, Product=%d, SerialNumber=%d\n",
2319 udev
->descriptor
.iManufacturer
,
2320 udev
->descriptor
.iProduct
,
2321 udev
->descriptor
.iSerialNumber
);
2322 show_string(udev
, "Product", udev
->product
);
2323 show_string(udev
, "Manufacturer", udev
->manufacturer
);
2324 show_string(udev
, "SerialNumber", udev
->serial
);
2327 static inline void announce_device(struct usb_device
*udev
) { }
2330 #ifdef CONFIG_USB_OTG
2331 #include "otg_whitelist.h"
2335 * usb_enumerate_device_otg - FIXME (usbcore-internal)
2336 * @udev: newly addressed device (in ADDRESS state)
2338 * Finish enumeration for On-The-Go devices
2340 static int usb_enumerate_device_otg(struct usb_device
*udev
)
2344 #ifdef CONFIG_USB_OTG
2346 * OTG-aware devices on OTG-capable root hubs may be able to use SRP,
2347 * to wake us after we've powered off VBUS; and HNP, switching roles
2348 * "host" to "peripheral". The OTG descriptor helps figure this out.
2350 if (!udev
->bus
->is_b_host
2352 && udev
->parent
== udev
->bus
->root_hub
) {
2353 struct usb_otg_descriptor
*desc
= NULL
;
2354 struct usb_bus
*bus
= udev
->bus
;
2356 /* descriptor may appear anywhere in config */
2357 if (__usb_get_extra_descriptor (udev
->rawdescriptors
[0],
2358 le16_to_cpu(udev
->config
[0].desc
.wTotalLength
),
2359 USB_DT_OTG
, (void **) &desc
) == 0) {
2360 if (desc
->bmAttributes
& USB_OTG_HNP
) {
2361 unsigned port1
= udev
->portnum
;
2363 dev_info(&udev
->dev
,
2364 "Dual-Role OTG device on %sHNP port\n",
2365 (port1
== bus
->otg_port
)
2368 /* enable HNP before suspend, it's simpler */
2369 if (port1
== bus
->otg_port
)
2370 bus
->b_hnp_enable
= 1;
2371 err
= usb_control_msg(udev
,
2372 usb_sndctrlpipe(udev
, 0),
2373 USB_REQ_SET_FEATURE
, 0,
2375 ? USB_DEVICE_B_HNP_ENABLE
2376 : USB_DEVICE_A_ALT_HNP_SUPPORT
,
2377 0, NULL
, 0, USB_CTRL_SET_TIMEOUT
);
2379 /* OTG MESSAGE: report errors here,
2380 * customize to match your product.
2382 dev_info(&udev
->dev
,
2383 "can't set HNP mode: %d\n",
2385 bus
->b_hnp_enable
= 0;
2391 if (!is_targeted(udev
)) {
2393 /* Maybe it can talk to us, though we can't talk to it.
2394 * (Includes HNP test device.)
2396 if (udev
->bus
->b_hnp_enable
|| udev
->bus
->is_b_host
) {
2397 err
= usb_port_suspend(udev
, PMSG_SUSPEND
);
2399 dev_dbg(&udev
->dev
, "HNP fail, %d\n", err
);
2411 * usb_enumerate_device - Read device configs/intfs/otg (usbcore-internal)
2412 * @udev: newly addressed device (in ADDRESS state)
2414 * This is only called by usb_new_device() and usb_authorize_device()
2415 * and FIXME -- all comments that apply to them apply here wrt to
2418 * If the device is WUSB and not authorized, we don't attempt to read
2419 * the string descriptors, as they will be errored out by the device
2420 * until it has been authorized.
2422 static int usb_enumerate_device(struct usb_device
*udev
)
2426 if (udev
->config
== NULL
) {
2427 err
= usb_get_configuration(udev
);
2430 dev_err(&udev
->dev
, "can't read configurations, error %d\n",
2436 /* read the standard strings and cache them if present */
2437 udev
->product
= usb_cache_string(udev
, udev
->descriptor
.iProduct
);
2438 udev
->manufacturer
= usb_cache_string(udev
,
2439 udev
->descriptor
.iManufacturer
);
2440 udev
->serial
= usb_cache_string(udev
, udev
->descriptor
.iSerialNumber
);
2442 err
= usb_enumerate_device_otg(udev
);
2444 #if defined(CONFIG_USBIF_COMPLIANCE) && defined(CONFIG_USB_XHCI_HCD)
2445 if (udev
->parent
){ // we don't have to check ourself (roothub)
2446 if (!is_targeted(udev
)) {
2447 usbif_u3h_send_event("DEV_NOT_SUPPORTED");
2456 usb_detect_interface_quirks(udev
);
2461 static void set_usb_port_removable(struct usb_device
*udev
)
2463 struct usb_device
*hdev
= udev
->parent
;
2464 struct usb_hub
*hub
;
2465 u8 port
= udev
->portnum
;
2466 u16 wHubCharacteristics
;
2467 bool removable
= true;
2472 hub
= usb_hub_to_struct_hub(udev
->parent
);
2474 wHubCharacteristics
= le16_to_cpu(hub
->descriptor
->wHubCharacteristics
);
2476 if (!(wHubCharacteristics
& HUB_CHAR_COMPOUND
))
2479 if (hub_is_superspeed(hdev
)) {
2480 if (le16_to_cpu(hub
->descriptor
->u
.ss
.DeviceRemovable
)
2484 if (hub
->descriptor
->u
.hs
.DeviceRemovable
[port
/ 8] & (1 << (port
% 8)))
2489 udev
->removable
= USB_DEVICE_REMOVABLE
;
2491 udev
->removable
= USB_DEVICE_FIXED
;
2495 * usb_new_device - perform initial device setup (usbcore-internal)
2496 * @udev: newly addressed device (in ADDRESS state)
2498 * This is called with devices which have been detected but not fully
2499 * enumerated. The device descriptor is available, but not descriptors
2500 * for any device configuration. The caller must have locked either
2501 * the parent hub (if udev is a normal device) or else the
2502 * usb_bus_list_lock (if udev is a root hub). The parent's pointer to
2503 * udev has already been installed, but udev is not yet visible through
2504 * sysfs or other filesystem code.
2506 * It will return if the device is configured properly or not. Zero if
2507 * the interface was registered with the driver core; else a negative
2510 * This call is synchronous, and may not be used in an interrupt context.
2512 * Only the hub driver or root-hub registrar should ever call this.
2514 int usb_new_device(struct usb_device
*udev
)
2519 /* Initialize non-root-hub device wakeup to disabled;
2520 * device (un)configuration controls wakeup capable
2521 * sysfs power/wakeup controls wakeup enabled/disabled
2523 device_init_wakeup(&udev
->dev
, 0);
2524 MYDBG("udev :%p\n", udev
);
2525 #ifdef CONFIG_MTK_DT_USB_SUPPORT
2526 #ifdef CONFIG_PM_RUNTIME
2527 if(is_musbfsh_rh(udev
->parent
)){
2529 /*find out struct *usb_hub and hook it */
2530 usb11_hub
= usb_hub_to_struct_hub(udev
->parent
);
2536 /* Tell the runtime-PM framework the device is active */
2537 pm_runtime_set_active(&udev
->dev
);
2538 pm_runtime_get_noresume(&udev
->dev
);
2539 pm_runtime_use_autosuspend(&udev
->dev
);
2540 pm_runtime_enable(&udev
->dev
);
2542 /* By default, forbid autosuspend for all devices. It will be
2543 * allowed for hubs during binding.
2545 usb_disable_autosuspend(udev
);
2547 err
= usb_enumerate_device(udev
); /* Read descriptors */
2550 dev_dbg(&udev
->dev
, "udev %d, busnum %d, minor = %d\n",
2551 udev
->devnum
, udev
->bus
->busnum
,
2552 (((udev
->bus
->busnum
-1) * 128) + (udev
->devnum
-1)));
2553 /* export the usbdev device-node for libusb */
2554 udev
->dev
.devt
= MKDEV(USB_DEVICE_MAJOR
,
2555 (((udev
->bus
->busnum
-1) * 128) + (udev
->devnum
-1)));
2557 /* Tell the world! */
2558 announce_device(udev
);
2561 add_device_randomness(udev
->serial
, strlen(udev
->serial
));
2563 add_device_randomness(udev
->product
, strlen(udev
->product
));
2564 if (udev
->manufacturer
)
2565 add_device_randomness(udev
->manufacturer
,
2566 strlen(udev
->manufacturer
));
2568 device_enable_async_suspend(&udev
->dev
);
2571 * check whether the hub marks this port as non-removable. Do it
2572 * now so that platform-specific data can override it in
2576 set_usb_port_removable(udev
);
2578 /* Register the device. The device driver is responsible
2579 * for configuring the device and invoking the add-device
2580 * notifier chain (used by usbfs and possibly others).
2582 err
= device_add(&udev
->dev
);
2584 dev_err(&udev
->dev
, "can't device_add, error %d\n", err
);
2588 /* Create link files between child device and usb port device. */
2590 struct usb_hub
*hub
= usb_hub_to_struct_hub(udev
->parent
);
2591 struct usb_port
*port_dev
= hub
->ports
[udev
->portnum
- 1];
2593 err
= sysfs_create_link(&udev
->dev
.kobj
,
2594 &port_dev
->dev
.kobj
, "port");
2598 err
= sysfs_create_link(&port_dev
->dev
.kobj
,
2599 &udev
->dev
.kobj
, "device");
2601 sysfs_remove_link(&udev
->dev
.kobj
, "port");
2605 pm_runtime_get_sync(&port_dev
->dev
);
2608 (void) usb_create_ep_devs(&udev
->dev
, &udev
->ep0
, udev
);
2609 usb_mark_last_busy(udev
);
2610 pm_runtime_put_sync_autosuspend(&udev
->dev
);
2614 usb_set_device_state(udev
, USB_STATE_NOTATTACHED
);
2615 pm_runtime_disable(&udev
->dev
);
2616 pm_runtime_set_suspended(&udev
->dev
);
2622 * usb_deauthorize_device - deauthorize a device (usbcore-internal)
2623 * @usb_dev: USB device
2625 * Move the USB device to a very basic state where interfaces are disabled
2626 * and the device is in fact unconfigured and unusable.
2628 * We share a lock (that we have) with device_del(), so we need to
2631 int usb_deauthorize_device(struct usb_device
*usb_dev
)
2633 usb_lock_device(usb_dev
);
2634 if (usb_dev
->authorized
== 0)
2635 goto out_unauthorized
;
2637 usb_dev
->authorized
= 0;
2638 usb_set_configuration(usb_dev
, -1);
2641 usb_unlock_device(usb_dev
);
2646 int usb_authorize_device(struct usb_device
*usb_dev
)
2650 usb_lock_device(usb_dev
);
2651 if (usb_dev
->authorized
== 1)
2652 goto out_authorized
;
2654 result
= usb_autoresume_device(usb_dev
);
2656 dev_err(&usb_dev
->dev
,
2657 "can't autoresume for authorization: %d\n", result
);
2658 goto error_autoresume
;
2660 result
= usb_get_device_descriptor(usb_dev
, sizeof(usb_dev
->descriptor
));
2662 dev_err(&usb_dev
->dev
, "can't re-read device descriptor for "
2663 "authorization: %d\n", result
);
2664 goto error_device_descriptor
;
2667 usb_dev
->authorized
= 1;
2668 /* Choose and set the configuration. This registers the interfaces
2669 * with the driver core and lets interface drivers bind to them.
2671 c
= usb_choose_configuration(usb_dev
);
2673 result
= usb_set_configuration(usb_dev
, c
);
2675 dev_err(&usb_dev
->dev
,
2676 "can't set config #%d, error %d\n", c
, result
);
2677 /* This need not be fatal. The user can try to
2678 * set other configurations. */
2681 dev_info(&usb_dev
->dev
, "authorized to connect\n");
2683 error_device_descriptor
:
2684 usb_autosuspend_device(usb_dev
);
2687 usb_unlock_device(usb_dev
); // complements locktree
2692 /* Returns 1 if @hub is a WUSB root hub, 0 otherwise */
2693 static unsigned hub_is_wusb(struct usb_hub
*hub
)
2695 struct usb_hcd
*hcd
;
2696 if (hub
->hdev
->parent
!= NULL
) /* not a root hub? */
2698 hcd
= container_of(hub
->hdev
->bus
, struct usb_hcd
, self
);
2699 return hcd
->wireless
;
2703 #define PORT_RESET_TRIES 5
2704 #define SET_ADDRESS_TRIES 2
2705 #define GET_DESCRIPTOR_TRIES 2
2706 #define SET_CONFIG_TRIES (2 * (use_both_schemes + 1))
2707 #define USE_NEW_SCHEME(i) ((i) / 2 == (int)old_scheme_first)
2709 #define HUB_ROOT_RESET_TIME 50 /* times are in msec */
2710 #define HUB_SHORT_RESET_TIME 10
2711 #define HUB_BH_RESET_TIME 50
2712 #define HUB_LONG_RESET_TIME 200
2713 #define HUB_RESET_TIMEOUT 800
2715 static int hub_port_reset(struct usb_hub
*hub
, int port1
,
2716 struct usb_device
*udev
, unsigned int delay
, bool warm
);
2718 /* Is a USB 3.0 port in the Inactive or Complinance Mode state?
2719 * Port worm reset is required to recover
2721 static bool hub_port_warm_reset_required(struct usb_hub
*hub
, u16 portstatus
)
2723 return hub_is_superspeed(hub
->hdev
) &&
2724 (((portstatus
& USB_PORT_STAT_LINK_STATE
) ==
2725 USB_SS_PORT_LS_SS_INACTIVE
) ||
2726 ((portstatus
& USB_PORT_STAT_LINK_STATE
) ==
2727 USB_SS_PORT_LS_COMP_MOD
)) ;
2730 static int hub_port_wait_reset(struct usb_hub
*hub
, int port1
,
2731 struct usb_device
*udev
, unsigned int delay
, bool warm
)
2733 int delay_time
, ret
;
2737 for (delay_time
= 0;
2738 delay_time
< HUB_RESET_TIMEOUT
;
2739 delay_time
+= delay
) {
2740 /* wait to give the device a chance to reset */
2743 /* read and decode port status */
2745 ret
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
2750 /* The port state is unknown until the reset completes. */
2751 if (!(portstatus
& USB_PORT_STAT_RESET
))
2754 /* switch to the long delay after two short delay failures */
2755 if (delay_time
>= 2 * HUB_SHORT_RESET_TIME
)
2756 delay
= HUB_LONG_RESET_TIME
;
2758 dev_dbg (hub
->intfdev
,
2759 "port %d not %sreset yet, waiting %dms\n",
2760 port1
, warm
? "warm " : "", delay
);
2763 if ((portstatus
& USB_PORT_STAT_RESET
))
2766 if (hub_port_warm_reset_required(hub
, portstatus
))
2769 /* Device went away? */
2770 if (!(portstatus
& USB_PORT_STAT_CONNECTION
))
2773 /* bomb out completely if the connection bounced. A USB 3.0
2774 * connection may bounce if multiple warm resets were issued,
2775 * but the device may have successfully re-connected. Ignore it.
2777 if (!hub_is_superspeed(hub
->hdev
) &&
2778 (portchange
& USB_PORT_STAT_C_CONNECTION
))
2781 if (!(portstatus
& USB_PORT_STAT_ENABLE
))
2787 if (hub_is_wusb(hub
))
2788 udev
->speed
= USB_SPEED_WIRELESS
;
2789 else if (hub_is_superspeed(hub
->hdev
))
2790 udev
->speed
= USB_SPEED_SUPER
;
2791 else if (portstatus
& USB_PORT_STAT_HIGH_SPEED
)
2792 udev
->speed
= USB_SPEED_HIGH
;
2793 else if (portstatus
& USB_PORT_STAT_LOW_SPEED
)
2794 udev
->speed
= USB_SPEED_LOW
;
2796 udev
->speed
= USB_SPEED_FULL
;
2800 static void hub_port_finish_reset(struct usb_hub
*hub
, int port1
,
2801 struct usb_device
*udev
, int *status
)
2805 /* TRSTRCY = 10 ms; plus some extra */
2808 struct usb_hcd
*hcd
= bus_to_hcd(udev
->bus
);
2810 update_devnum(udev
, 0);
2811 /* The xHC may think the device is already reset,
2812 * so ignore the status.
2814 if (hcd
->driver
->reset_device
)
2815 hcd
->driver
->reset_device(hcd
, udev
);
2820 usb_clear_port_feature(hub
->hdev
,
2821 port1
, USB_PORT_FEAT_C_RESET
);
2822 if (hub_is_superspeed(hub
->hdev
)) {
2823 usb_clear_port_feature(hub
->hdev
, port1
,
2824 USB_PORT_FEAT_C_BH_PORT_RESET
);
2825 usb_clear_port_feature(hub
->hdev
, port1
,
2826 USB_PORT_FEAT_C_PORT_LINK_STATE
);
2827 usb_clear_port_feature(hub
->hdev
, port1
,
2828 USB_PORT_FEAT_C_CONNECTION
);
2831 usb_set_device_state(udev
, *status
2832 ? USB_STATE_NOTATTACHED
2833 : USB_STATE_DEFAULT
);
2838 /* Handle port reset and port warm(BH) reset (for USB3 protocol ports) */
2839 static int hub_port_reset(struct usb_hub
*hub
, int port1
,
2840 struct usb_device
*udev
, unsigned int delay
, bool warm
)
2843 u16 portchange
, portstatus
;
2845 if (!hub_is_superspeed(hub
->hdev
)) {
2847 dev_err(hub
->intfdev
, "only USB3 hub support "
2851 /* Block EHCI CF initialization during the port reset.
2852 * Some companion controllers don't like it when they mix.
2854 down_read(&ehci_cf_port_reset_rwsem
);
2857 * If the caller hasn't explicitly requested a warm reset,
2858 * double check and see if one is needed.
2860 status
= hub_port_status(hub
, port1
,
2861 &portstatus
, &portchange
);
2865 if (hub_port_warm_reset_required(hub
, portstatus
))
2869 /* Reset the port */
2870 for (i
= 0; i
< PORT_RESET_TRIES
; i
++) {
2872 status
= set_port_feature(hub
->hdev
, port1
, (warm
?
2873 USB_PORT_FEAT_BH_PORT_RESET
:
2874 USB_PORT_FEAT_RESET
));
2876 if (status
== -ENODEV
) {
2878 ; /* The hub is gone */
2879 } else if (status
) {
2881 dev_err(hub
->intfdev
,
2882 "cannot %sreset port %d (err = %d)\n",
2883 warm
? "warm " : "", port1
, status
);
2886 status
= hub_port_wait_reset(hub
, port1
, udev
, delay
,
2888 if (status
&& status
!= -ENOTCONN
)
2891 dev_dbg(hub
->intfdev
,
2892 "port_wait_reset: err = %d\n",
2898 /* Check for disconnect or reset */
2899 if (status
== 0 || status
== -ENOTCONN
|| status
== -ENODEV
) {
2901 hub_port_finish_reset(hub
, port1
, udev
, &status
);
2904 if (!hub_is_superspeed(hub
->hdev
))
2908 * If a USB 3.0 device migrates from reset to an error
2909 * state, re-issue the warm reset.
2911 if (hub_port_status(hub
, port1
,
2912 &portstatus
, &portchange
) < 0)
2915 if (!hub_port_warm_reset_required(hub
, portstatus
))
2919 * If the port is in SS.Inactive or Compliance Mode, the
2920 * hot or warm reset failed. Try another warm reset.
2923 dev_dbg(hub
->intfdev
, "hot reset failed, warm reset port %d\n",
2930 dev_dbg (hub
->intfdev
,
2931 "port %d not enabled, trying %sreset again...\n",
2932 port1
, warm
? "warm " : "");
2933 delay
= HUB_LONG_RESET_TIME
;
2938 dev_err (hub
->intfdev
,
2939 "Cannot enable port %i. Maybe the USB cable is bad?\n",
2943 if (!hub_is_superspeed(hub
->hdev
))
2946 up_read(&ehci_cf_port_reset_rwsem
);
2954 /* Check if a port is power on */
2955 static int port_is_power_on(struct usb_hub
*hub
, unsigned portstatus
)
2959 if (hub_is_superspeed(hub
->hdev
)) {
2960 if (portstatus
& USB_SS_PORT_STAT_POWER
)
2963 if (portstatus
& USB_PORT_STAT_POWER
)
2972 /* Check if a port is suspended(USB2.0 port) or in U3 state(USB3.0 port) */
2973 static int port_is_suspended(struct usb_hub
*hub
, unsigned portstatus
)
2977 if (hub_is_superspeed(hub
->hdev
)) {
2978 if ((portstatus
& USB_PORT_STAT_LINK_STATE
)
2979 == USB_SS_PORT_LS_U3
)
2982 if (portstatus
& USB_PORT_STAT_SUSPEND
)
2989 /* Determine whether the device on a port is ready for a normal resume,
2990 * is ready for a reset-resume, or should be disconnected.
2992 static int check_port_resume_type(struct usb_device
*udev
,
2993 struct usb_hub
*hub
, int port1
,
2994 int status
, unsigned portchange
, unsigned portstatus
)
2996 /* Is the device still present? */
2997 if (status
|| port_is_suspended(hub
, portstatus
) ||
2998 !port_is_power_on(hub
, portstatus
) ||
2999 !(portstatus
& USB_PORT_STAT_CONNECTION
)) {
3004 /* Can't do a normal resume if the port isn't enabled,
3005 * so try a reset-resume instead.
3007 else if (!(portstatus
& USB_PORT_STAT_ENABLE
) && !udev
->reset_resume
) {
3008 if (udev
->persist_enabled
)
3009 udev
->reset_resume
= 1;
3015 dev_dbg(hub
->intfdev
,
3016 "port %d status %04x.%04x after resume, %d\n",
3017 port1
, portchange
, portstatus
, status
);
3018 } else if (udev
->reset_resume
) {
3020 /* Late port handoff can set status-change bits */
3021 if (portchange
& USB_PORT_STAT_C_CONNECTION
)
3022 usb_clear_port_feature(hub
->hdev
, port1
,
3023 USB_PORT_FEAT_C_CONNECTION
);
3024 if (portchange
& USB_PORT_STAT_C_ENABLE
)
3025 usb_clear_port_feature(hub
->hdev
, port1
,
3026 USB_PORT_FEAT_C_ENABLE
);
3032 int usb_disable_ltm(struct usb_device
*udev
)
3034 struct usb_hcd
*hcd
= bus_to_hcd(udev
->bus
);
3036 /* Check if the roothub and device supports LTM. */
3037 if (!usb_device_supports_ltm(hcd
->self
.root_hub
) ||
3038 !usb_device_supports_ltm(udev
))
3041 /* Clear Feature LTM Enable can only be sent if the device is
3044 if (!udev
->actconfig
)
3047 return usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3048 USB_REQ_CLEAR_FEATURE
, USB_RECIP_DEVICE
,
3049 USB_DEVICE_LTM_ENABLE
, 0, NULL
, 0,
3050 USB_CTRL_SET_TIMEOUT
);
3052 EXPORT_SYMBOL_GPL(usb_disable_ltm
);
3054 void usb_enable_ltm(struct usb_device
*udev
)
3056 struct usb_hcd
*hcd
= bus_to_hcd(udev
->bus
);
3058 /* Check if the roothub and device supports LTM. */
3059 if (!usb_device_supports_ltm(hcd
->self
.root_hub
) ||
3060 !usb_device_supports_ltm(udev
))
3063 /* Set Feature LTM Enable can only be sent if the device is
3066 if (!udev
->actconfig
)
3069 usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3070 USB_REQ_SET_FEATURE
, USB_RECIP_DEVICE
,
3071 USB_DEVICE_LTM_ENABLE
, 0, NULL
, 0,
3072 USB_CTRL_SET_TIMEOUT
);
3074 EXPORT_SYMBOL_GPL(usb_enable_ltm
);
3078 * usb_disable_function_remotewakeup - disable usb3.0
3079 * device's function remote wakeup
3080 * @udev: target device
3082 * Assume there's only one function on the USB 3.0
3083 * device and disable remote wake for the first
3084 * interface. FIXME if the interface association
3085 * descriptor shows there's more than one function.
3087 static int usb_disable_function_remotewakeup(struct usb_device
*udev
)
3089 return usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3090 USB_REQ_CLEAR_FEATURE
, USB_RECIP_INTERFACE
,
3091 USB_INTRF_FUNC_SUSPEND
, 0, NULL
, 0,
3092 USB_CTRL_SET_TIMEOUT
);
3095 /* Count of wakeup-enabled devices at or below udev */
3096 static unsigned wakeup_enabled_descendants(struct usb_device
*udev
)
3098 struct usb_hub
*hub
= usb_hub_to_struct_hub(udev
);
3100 return udev
->do_remote_wakeup
+
3101 (hub
? hub
->wakeup_enabled_descendants
: 0);
3105 * usb_port_suspend - suspend a usb device's upstream port
3106 * @udev: device that's no longer in active use, not a root hub
3107 * Context: must be able to sleep; device not locked; pm locks held
3109 * Suspends a USB device that isn't in active use, conserving power.
3110 * Devices may wake out of a suspend, if anything important happens,
3111 * using the remote wakeup mechanism. They may also be taken out of
3112 * suspend by the host, using usb_port_resume(). It's also routine
3113 * to disconnect devices while they are suspended.
3115 * This only affects the USB hardware for a device; its interfaces
3116 * (and, for hubs, child devices) must already have been suspended.
3118 * Selective port suspend reduces power; most suspended devices draw
3119 * less than 500 uA. It's also used in OTG, along with remote wakeup.
3120 * All devices below the suspended port are also suspended.
3122 * Devices leave suspend state when the host wakes them up. Some devices
3123 * also support "remote wakeup", where the device can activate the USB
3124 * tree above them to deliver data, such as a keypress or packet. In
3125 * some cases, this wakes the USB host.
3127 * Suspending OTG devices may trigger HNP, if that's been enabled
3128 * between a pair of dual-role devices. That will change roles, such
3129 * as from A-Host to A-Peripheral or from B-Host back to B-Peripheral.
3131 * Devices on USB hub ports have only one "suspend" state, corresponding
3132 * to ACPI D2, "may cause the device to lose some context".
3133 * State transitions include:
3135 * - suspend, resume ... when the VBUS power link stays live
3136 * - suspend, disconnect ... VBUS lost
3138 * Once VBUS drop breaks the circuit, the port it's using has to go through
3139 * normal re-enumeration procedures, starting with enabling VBUS power.
3140 * Other than re-initializing the hub (plug/unplug, except for root hubs),
3141 * Linux (2.6) currently has NO mechanisms to initiate that: no khubd
3142 * timer, no SRP, no requests through sysfs.
3144 * If Runtime PM isn't enabled or used, non-SuperSpeed devices may not get
3145 * suspended until their bus goes into global suspend (i.e., the root
3146 * hub is suspended). Nevertheless, we change @udev->state to
3147 * USB_STATE_SUSPENDED as this is the device's "logical" state. The actual
3148 * upstream port setting is stored in @udev->port_is_suspended.
3150 * Returns 0 on success, else negative errno.
3152 int usb_port_suspend(struct usb_device
*udev
, pm_message_t msg
)
3154 struct usb_hub
*hub
= usb_hub_to_struct_hub(udev
->parent
);
3155 struct usb_port
*port_dev
= hub
->ports
[udev
->portnum
- 1];
3156 int port1
= udev
->portnum
;
3158 bool really_suspend
= true;
3160 /* enable remote wakeup when appropriate; this lets the device
3161 * wake up the upstream hub (including maybe the root hub).
3163 * NOTE: OTG devices may issue remote wakeup (or SRP) even when
3164 * we don't explicitly enable it here.
3166 if (udev
->do_remote_wakeup
) {
3167 if (!hub_is_superspeed(hub
->hdev
)) {
3168 status
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3169 USB_REQ_SET_FEATURE
, USB_RECIP_DEVICE
,
3170 USB_DEVICE_REMOTE_WAKEUP
, 0,
3172 USB_CTRL_SET_TIMEOUT
);
3174 /* Assume there's only one function on the USB 3.0
3175 * device and enable remote wake for the first
3176 * interface. FIXME if the interface association
3177 * descriptor shows there's more than one function.
3179 status
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3180 USB_REQ_SET_FEATURE
,
3181 USB_RECIP_INTERFACE
,
3182 USB_INTRF_FUNC_SUSPEND
,
3183 USB_INTRF_FUNC_SUSPEND_RW
|
3184 USB_INTRF_FUNC_SUSPEND_LP
,
3186 USB_CTRL_SET_TIMEOUT
);
3189 dev_dbg(&udev
->dev
, "won't remote wakeup, status %d\n",
3191 /* bail if autosuspend is requested */
3192 if (PMSG_IS_AUTO(msg
))
3200 /* disable USB2 hardware LPM */
3201 if (udev
->usb2_hw_lpm_enabled
== 1)
3202 usb_set_usb2_hardware_lpm(udev
, 0);
3204 if (usb_disable_ltm(udev
)) {
3205 dev_err(&udev
->dev
, "Failed to disable LTM before suspend\n.");
3208 if (PMSG_IS_AUTO(msg
))
3211 if (usb_unlocked_disable_lpm(udev
)) {
3212 dev_err(&udev
->dev
, "Failed to disable LPM before suspend\n.");
3215 if (PMSG_IS_AUTO(msg
))
3220 if (hub_is_superspeed(hub
->hdev
))
3223 status
= hub_set_port_link_state(hub
, port1
, USB_SS_PORT_LS_U3
);
3225 #if 0 /* behavior for kernel 3.10 */
3227 * For system suspend, we do not need to enable the suspend feature
3228 * on individual USB-2 ports. The devices will automatically go
3229 * into suspend a few ms after the root hub stops sending packets.
3230 * The USB 2.0 spec calls this "global suspend".
3232 * However, many USB hubs have a bug: They don't relay wakeup requests
3233 * from a downstream port if the port's suspend feature isn't on.
3234 * Therefore we will turn on the suspend feature if udev or any of its
3235 * descendants is enabled for remote wakeup.
3237 } else if (PMSG_IS_AUTO(msg
) || wakeup_enabled_descendants(udev
) > 0) {
3239 status
= set_port_feature(hub
->hdev
, port1
,
3240 USB_PORT_FEAT_SUSPEND
);
3242 really_suspend
= false;
3245 #else /*roll back behavior to kernel 3.4 */
3248 status
= set_port_feature(hub
->hdev
, port1
,
3249 USB_PORT_FEAT_SUSPEND
);
3254 dev_dbg(hub
->intfdev
, "can't suspend port %d, status %d\n",
3258 /* Try to enable USB3 LPM and LTM again */
3259 usb_unlocked_enable_lpm(udev
);
3261 usb_enable_ltm(udev
);
3263 /* Try to enable USB2 hardware LPM again */
3264 if (udev
->usb2_hw_lpm_capable
== 1)
3265 usb_set_usb2_hardware_lpm(udev
, 1);
3267 if (udev
->do_remote_wakeup
) {
3268 if (udev
->speed
< USB_SPEED_SUPER
)
3269 usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3270 USB_REQ_CLEAR_FEATURE
,
3272 USB_DEVICE_REMOTE_WAKEUP
, 0,
3273 NULL
, 0, USB_CTRL_SET_TIMEOUT
);
3275 usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3276 USB_REQ_CLEAR_FEATURE
,
3277 USB_RECIP_INTERFACE
,
3278 USB_INTRF_FUNC_SUSPEND
, 0,
3279 NULL
, 0, USB_CTRL_SET_TIMEOUT
);
3283 /* System sleep transitions should never fail */
3284 if (!PMSG_IS_AUTO(msg
))
3287 dev_dbg(&udev
->dev
, "usb %ssuspend, wakeup %d\n",
3288 (PMSG_IS_AUTO(msg
) ? "auto-" : ""),
3289 udev
->do_remote_wakeup
);
3290 if (really_suspend
) {
3291 udev
->port_is_suspended
= 1;
3293 /* device has up to 10 msec to fully suspend */
3296 usb_set_device_state(udev
, USB_STATE_SUSPENDED
);
3299 if (status
== 0 && !udev
->do_remote_wakeup
&& udev
->persist_enabled
) {
3300 pm_runtime_put_sync(&port_dev
->dev
);
3301 port_dev
->did_runtime_put
= true;
3304 usb_mark_last_busy(hub
->hdev
);
3309 * If the USB "suspend" state is in use (rather than "global suspend"),
3310 * many devices will be individually taken out of suspend state using
3311 * special "resume" signaling. This routine kicks in shortly after
3312 * hardware resume signaling is finished, either because of selective
3313 * resume (by host) or remote wakeup (by device) ... now see what changed
3314 * in the tree that's rooted at this device.
3316 * If @udev->reset_resume is set then the device is reset before the
3317 * status check is done.
3319 static int finish_port_resume(struct usb_device
*udev
)
3324 /* caller owns the udev device lock */
3325 dev_dbg(&udev
->dev
, "%s\n",
3326 udev
->reset_resume
? "finish reset-resume" : "finish resume");
3328 /* usb ch9 identifies four variants of SUSPENDED, based on what
3329 * state the device resumes to. Linux currently won't see the
3330 * first two on the host side; they'd be inside hub_port_init()
3331 * during many timeouts, but khubd can't suspend until later.
3333 usb_set_device_state(udev
, udev
->actconfig
3334 ? USB_STATE_CONFIGURED
3335 : USB_STATE_ADDRESS
);
3337 /* 10.5.4.5 says not to reset a suspended port if the attached
3338 * device is enabled for remote wakeup. Hence the reset
3339 * operation is carried out here, after the port has been
3342 if (udev
->reset_resume
)
3344 status
= usb_reset_and_verify_device(udev
);
3346 /* 10.5.4.5 says be sure devices in the tree are still there.
3347 * For now let's assume the device didn't go crazy on resume,
3348 * and device drivers will know about any resume quirks.
3353 status
= usb_get_status(udev
, USB_RECIP_DEVICE
, 0, &devstatus
);
3354 MYDBG("%d\n", status
);
3356 status
= (status
> 0 ? 0 : -ENODEV
);
3358 /* If a normal resume failed, try doing a reset-resume */
3359 if (status
&& !udev
->reset_resume
&& udev
->persist_enabled
) {
3360 dev_dbg(&udev
->dev
, "retry with reset-resume\n");
3361 udev
->reset_resume
= 1;
3362 goto retry_reset_resume
;
3367 dev_dbg(&udev
->dev
, "gone after usb resume? status %d\n",
3370 * There are a few quirky devices which violate the standard
3371 * by claiming to have remote wakeup enabled after a reset,
3372 * which crash if the feature is cleared, hence check for
3373 * udev->reset_resume
3375 } else if (udev
->actconfig
&& !udev
->reset_resume
) {
3376 if (!hub_is_superspeed(udev
->parent
)) {
3377 le16_to_cpus(&devstatus
);
3378 if (devstatus
& (1 << USB_DEVICE_REMOTE_WAKEUP
))
3379 status
= usb_control_msg(udev
,
3380 usb_sndctrlpipe(udev
, 0),
3381 USB_REQ_CLEAR_FEATURE
,
3383 USB_DEVICE_REMOTE_WAKEUP
, 0,
3385 USB_CTRL_SET_TIMEOUT
);
3387 status
= usb_get_status(udev
, USB_RECIP_INTERFACE
, 0,
3389 le16_to_cpus(&devstatus
);
3390 if (!status
&& devstatus
& (USB_INTRF_STAT_FUNC_RW_CAP
3391 | USB_INTRF_STAT_FUNC_RW
))
3393 usb_disable_function_remotewakeup(udev
);
3398 "disable remote wakeup, status %d\n",
3406 * There are some SS USB devices which take longer time for link training.
3407 * XHCI specs 4.19.4 says that when Link training is successful, port
3408 * sets CSC bit to 1. So if SW reads port status before successful link
3409 * training, then it will not find device to be present.
3410 * USB Analyzer log with such buggy devices show that in some cases
3411 * device switch on the RX termination after long delay of host enabling
3412 * the VBUS. In few other cases it has been seen that device fails to
3413 * negotiate link training in first attempt. It has been
3414 * reported till now that few devices take as long as 2000 ms to train
3415 * the link after host enabling its VBUS and termination. Following
3416 * routine implements a 2000 ms timeout for link training. If in a case
3417 * link trains before timeout, loop will exit earlier.
3419 * FIXME: If a device was connected before suspend, but was removed
3420 * while system was asleep, then the loop in the following routine will
3421 * only exit at timeout.
3423 * This routine should only be called when persist is enabled for a SS
3426 static int wait_for_ss_port_enable(struct usb_device
*udev
,
3427 struct usb_hub
*hub
, int *port1
,
3428 u16
*portchange
, u16
*portstatus
)
3430 int status
= 0, delay_ms
= 0;
3432 while (delay_ms
< 2000) {
3433 if (status
|| *portstatus
& USB_PORT_STAT_CONNECTION
)
3437 status
= hub_port_status(hub
, *port1
, portstatus
, portchange
);
3443 * usb_port_resume - re-activate a suspended usb device's upstream port
3444 * @udev: device to re-activate, not a root hub
3445 * Context: must be able to sleep; device not locked; pm locks held
3447 * This will re-activate the suspended device, increasing power usage
3448 * while letting drivers communicate again with its endpoints.
3449 * USB resume explicitly guarantees that the power session between
3450 * the host and the device is the same as it was when the device
3453 * If @udev->reset_resume is set then this routine won't check that the
3454 * port is still enabled. Furthermore, finish_port_resume() above will
3455 * reset @udev. The end result is that a broken power session can be
3456 * recovered and @udev will appear to persist across a loss of VBUS power.
3458 * For example, if a host controller doesn't maintain VBUS suspend current
3459 * during a system sleep or is reset when the system wakes up, all the USB
3460 * power sessions below it will be broken. This is especially troublesome
3461 * for mass-storage devices containing mounted filesystems, since the
3462 * device will appear to have disconnected and all the memory mappings
3463 * to it will be lost. Using the USB_PERSIST facility, the device can be
3464 * made to appear as if it had not disconnected.
3466 * This facility can be dangerous. Although usb_reset_and_verify_device() makes
3467 * every effort to insure that the same device is present after the
3468 * reset as before, it cannot provide a 100% guarantee. Furthermore it's
3469 * quite possible for a device to remain unaltered but its media to be
3470 * changed. If the user replaces a flash memory card while the system is
3471 * asleep, he will have only himself to blame when the filesystem on the
3472 * new card is corrupted and the system crashes.
3474 * Returns 0 on success, else negative errno.
3476 int usb_port_resume(struct usb_device
*udev
, pm_message_t msg
)
3478 struct usb_hub
*hub
= usb_hub_to_struct_hub(udev
->parent
);
3479 struct usb_port
*port_dev
= hub
->ports
[udev
->portnum
- 1];
3480 int port1
= udev
->portnum
;
3482 u16 portchange
, portstatus
;
3484 if (port_dev
->did_runtime_put
) {
3485 status
= pm_runtime_get_sync(&port_dev
->dev
);
3486 port_dev
->did_runtime_put
= false;
3488 dev_dbg(&udev
->dev
, "can't resume usb port, status %d\n",
3494 /* Skip the initial Clear-Suspend step for a remote wakeup */
3495 status
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
3496 if (status
== 0 && !port_is_suspended(hub
, portstatus
))
3497 goto SuspendCleared
;
3499 // dev_dbg(hub->intfdev, "resume port %d\n", port1);
3501 set_bit(port1
, hub
->busy_bits
);
3503 /* see 7.1.7.7; affects power usage, but not budgeting */
3504 if (hub_is_superspeed(hub
->hdev
))
3505 status
= hub_set_port_link_state(hub
, port1
, USB_SS_PORT_LS_U0
);
3507 status
= usb_clear_port_feature(hub
->hdev
,
3508 port1
, USB_PORT_FEAT_SUSPEND
);
3510 dev_dbg(hub
->intfdev
, "can't resume port %d, status %d\n",
3513 /* drive resume for at least 20 msec */
3514 dev_dbg(&udev
->dev
, "usb %sresume\n",
3515 (PMSG_IS_AUTO(msg
) ? "auto-" : ""));
3518 /* Virtual root hubs can trigger on GET_PORT_STATUS to
3519 * stop resume signaling. Then finish the resume
3522 status
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
3524 /* TRSMRCY = 10 msec */
3530 udev
->port_is_suspended
= 0;
3531 if (hub_is_superspeed(hub
->hdev
)) {
3532 if (portchange
& USB_PORT_STAT_C_LINK_STATE
)
3533 usb_clear_port_feature(hub
->hdev
, port1
,
3534 USB_PORT_FEAT_C_PORT_LINK_STATE
);
3536 if (portchange
& USB_PORT_STAT_C_SUSPEND
)
3537 usb_clear_port_feature(hub
->hdev
, port1
,
3538 USB_PORT_FEAT_C_SUSPEND
);
3542 clear_bit(port1
, hub
->busy_bits
);
3544 if (udev
->persist_enabled
&& hub_is_superspeed(hub
->hdev
))
3545 status
= wait_for_ss_port_enable(udev
, hub
, &port1
, &portchange
,
3548 status
= check_port_resume_type(udev
,
3549 hub
, port1
, status
, portchange
, portstatus
);
3551 status
= finish_port_resume(udev
);
3553 dev_dbg(&udev
->dev
, "can't resume, status %d\n", status
);
3554 hub_port_logical_disconnect(hub
, port1
);
3556 /* Try to enable USB2 hardware LPM */
3557 if (udev
->usb2_hw_lpm_capable
== 1)
3558 usb_set_usb2_hardware_lpm(udev
, 1);
3560 /* Try to enable USB3 LTM and LPM */
3561 usb_enable_ltm(udev
);
3562 usb_unlocked_enable_lpm(udev
);
3568 #endif /* CONFIG_PM */
3570 #ifdef CONFIG_PM_RUNTIME
3572 /* caller has locked udev */
3573 int usb_remote_wakeup(struct usb_device
*udev
)
3577 if (udev
->state
== USB_STATE_SUSPENDED
) {
3578 dev_dbg(&udev
->dev
, "usb %sresume\n", "wakeup-");
3579 status
= usb_autoresume_device(udev
);
3581 /* Let the drivers do their thing, then... */
3582 usb_autosuspend_device(udev
);
3590 static int check_ports_changed(struct usb_hub
*hub
)
3594 for (port1
= 1; port1
<= hub
->hdev
->maxchild
; ++port1
) {
3595 u16 portstatus
, portchange
;
3598 status
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
3599 if (!status
&& portchange
)
3605 static int hub_suspend(struct usb_interface
*intf
, pm_message_t msg
)
3607 struct usb_hub
*hub
= usb_get_intfdata (intf
);
3608 struct usb_device
*hdev
= hub
->hdev
;
3613 * Warn if children aren't already suspended.
3614 * Also, add up the number of wakeup-enabled descendants.
3616 hub
->wakeup_enabled_descendants
= 0;
3617 for (port1
= 1; port1
<= hdev
->maxchild
; port1
++) {
3618 struct usb_device
*udev
;
3620 udev
= hub
->ports
[port1
- 1]->child
;
3621 if (udev
&& udev
->can_submit
) {
3622 dev_warn(&intf
->dev
, "port %d nyet suspended\n", port1
);
3623 if (PMSG_IS_AUTO(msg
))
3627 hub
->wakeup_enabled_descendants
+=
3628 wakeup_enabled_descendants(udev
);
3631 if (hdev
->do_remote_wakeup
&& hub
->quirk_check_port_auto_suspend
) {
3632 /* check if there are changes pending on hub ports */
3633 if (check_ports_changed(hub
)) {
3634 if (PMSG_IS_AUTO(msg
))
3636 pm_wakeup_event(&hdev
->dev
, 2000);
3640 if (hub_is_superspeed(hdev
) && hdev
->do_remote_wakeup
) {
3641 /* Enable hub to send remote wakeup for all ports. */
3642 for (port1
= 1; port1
<= hdev
->maxchild
; port1
++) {
3643 status
= set_port_feature(hdev
,
3645 USB_PORT_FEAT_REMOTE_WAKE_CONNECT
|
3646 USB_PORT_FEAT_REMOTE_WAKE_DISCONNECT
|
3647 USB_PORT_FEAT_REMOTE_WAKE_OVER_CURRENT
,
3648 USB_PORT_FEAT_REMOTE_WAKE_MASK
);
3652 dev_dbg(&intf
->dev
, "%s\n", __func__
);
3654 /* stop khubd and related activity */
3655 hub_quiesce(hub
, HUB_SUSPEND
);
3659 static int hub_resume(struct usb_interface
*intf
)
3661 struct usb_hub
*hub
= usb_get_intfdata(intf
);
3663 dev_dbg(&intf
->dev
, "%s\n", __func__
);
3664 hub_activate(hub
, HUB_RESUME
);
3668 static int hub_reset_resume(struct usb_interface
*intf
)
3670 struct usb_hub
*hub
= usb_get_intfdata(intf
);
3672 dev_dbg(&intf
->dev
, "%s\n", __func__
);
3673 hub_activate(hub
, HUB_RESET_RESUME
);
3678 * usb_root_hub_lost_power - called by HCD if the root hub lost Vbus power
3679 * @rhdev: struct usb_device for the root hub
3681 * The USB host controller driver calls this function when its root hub
3682 * is resumed and Vbus power has been interrupted or the controller
3683 * has been reset. The routine marks @rhdev as having lost power.
3684 * When the hub driver is resumed it will take notice and carry out
3685 * power-session recovery for all the "USB-PERSIST"-enabled child devices;
3686 * the others will be disconnected.
3688 void usb_root_hub_lost_power(struct usb_device
*rhdev
)
3690 dev_warn(&rhdev
->dev
, "root hub lost power or was reset\n");
3691 rhdev
->reset_resume
= 1;
3693 EXPORT_SYMBOL_GPL(usb_root_hub_lost_power
);
3695 static const char * const usb3_lpm_names
[] = {
3703 * Send a Set SEL control transfer to the device, prior to enabling
3704 * device-initiated U1 or U2. This lets the device know the exit latencies from
3705 * the time the device initiates a U1 or U2 exit, to the time it will receive a
3706 * packet from the host.
3708 * This function will fail if the SEL or PEL values for udev are greater than
3709 * the maximum allowed values for the link state to be enabled.
3711 static int usb_req_set_sel(struct usb_device
*udev
, enum usb3_link_state state
)
3713 struct usb_set_sel_req
*sel_values
;
3714 unsigned long long u1_sel
;
3715 unsigned long long u1_pel
;
3716 unsigned long long u2_sel
;
3717 unsigned long long u2_pel
;
3720 /* Convert SEL and PEL stored in ns to us */
3721 u1_sel
= DIV_ROUND_UP(udev
->u1_params
.sel
, 1000);
3722 u1_pel
= DIV_ROUND_UP(udev
->u1_params
.pel
, 1000);
3723 u2_sel
= DIV_ROUND_UP(udev
->u2_params
.sel
, 1000);
3724 u2_pel
= DIV_ROUND_UP(udev
->u2_params
.pel
, 1000);
3727 * Make sure that the calculated SEL and PEL values for the link
3728 * state we're enabling aren't bigger than the max SEL/PEL
3729 * value that will fit in the SET SEL control transfer.
3730 * Otherwise the device would get an incorrect idea of the exit
3731 * latency for the link state, and could start a device-initiated
3732 * U1/U2 when the exit latencies are too high.
3734 if ((state
== USB3_LPM_U1
&&
3735 (u1_sel
> USB3_LPM_MAX_U1_SEL_PEL
||
3736 u1_pel
> USB3_LPM_MAX_U1_SEL_PEL
)) ||
3737 (state
== USB3_LPM_U2
&&
3738 (u2_sel
> USB3_LPM_MAX_U2_SEL_PEL
||
3739 u2_pel
> USB3_LPM_MAX_U2_SEL_PEL
))) {
3740 dev_dbg(&udev
->dev
, "Device-initiated %s disabled due to long SEL %llu us or PEL %llu us\n",
3741 usb3_lpm_names
[state
], u1_sel
, u1_pel
);
3746 * If we're enabling device-initiated LPM for one link state,
3747 * but the other link state has a too high SEL or PEL value,
3748 * just set those values to the max in the Set SEL request.
3750 if (u1_sel
> USB3_LPM_MAX_U1_SEL_PEL
)
3751 u1_sel
= USB3_LPM_MAX_U1_SEL_PEL
;
3753 if (u1_pel
> USB3_LPM_MAX_U1_SEL_PEL
)
3754 u1_pel
= USB3_LPM_MAX_U1_SEL_PEL
;
3756 if (u2_sel
> USB3_LPM_MAX_U2_SEL_PEL
)
3757 u2_sel
= USB3_LPM_MAX_U2_SEL_PEL
;
3759 if (u2_pel
> USB3_LPM_MAX_U2_SEL_PEL
)
3760 u2_pel
= USB3_LPM_MAX_U2_SEL_PEL
;
3763 * usb_enable_lpm() can be called as part of a failed device reset,
3764 * which may be initiated by an error path of a mass storage driver.
3765 * Therefore, use GFP_NOIO.
3767 sel_values
= kmalloc(sizeof *(sel_values
), GFP_NOIO
);
3771 sel_values
->u1_sel
= u1_sel
;
3772 sel_values
->u1_pel
= u1_pel
;
3773 sel_values
->u2_sel
= cpu_to_le16(u2_sel
);
3774 sel_values
->u2_pel
= cpu_to_le16(u2_pel
);
3776 ret
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3780 sel_values
, sizeof *(sel_values
),
3781 USB_CTRL_SET_TIMEOUT
);
3787 * Enable or disable device-initiated U1 or U2 transitions.
3789 static int usb_set_device_initiated_lpm(struct usb_device
*udev
,
3790 enum usb3_link_state state
, bool enable
)
3797 feature
= USB_DEVICE_U1_ENABLE
;
3800 feature
= USB_DEVICE_U2_ENABLE
;
3803 dev_warn(&udev
->dev
, "%s: Can't %s non-U1 or U2 state.\n",
3804 __func__
, enable
? "enable" : "disable");
3808 if (udev
->state
!= USB_STATE_CONFIGURED
) {
3809 dev_dbg(&udev
->dev
, "%s: Can't %s %s state "
3810 "for unconfigured device.\n",
3811 __func__
, enable
? "enable" : "disable",
3812 usb3_lpm_names
[state
]);
3818 * Now send the control transfer to enable device-initiated LPM
3819 * for either U1 or U2.
3821 ret
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3822 USB_REQ_SET_FEATURE
,
3826 USB_CTRL_SET_TIMEOUT
);
3828 ret
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
3829 USB_REQ_CLEAR_FEATURE
,
3833 USB_CTRL_SET_TIMEOUT
);
3836 dev_warn(&udev
->dev
, "%s of device-initiated %s failed.\n",
3837 enable
? "Enable" : "Disable",
3838 usb3_lpm_names
[state
]);
3844 static int usb_set_lpm_timeout(struct usb_device
*udev
,
3845 enum usb3_link_state state
, int timeout
)
3852 feature
= USB_PORT_FEAT_U1_TIMEOUT
;
3855 feature
= USB_PORT_FEAT_U2_TIMEOUT
;
3858 dev_warn(&udev
->dev
, "%s: Can't set timeout for non-U1 or U2 state.\n",
3863 if (state
== USB3_LPM_U1
&& timeout
> USB3_LPM_U1_MAX_TIMEOUT
&&
3864 timeout
!= USB3_LPM_DEVICE_INITIATED
) {
3865 dev_warn(&udev
->dev
, "Failed to set %s timeout to 0x%x, "
3866 "which is a reserved value.\n",
3867 usb3_lpm_names
[state
], timeout
);
3871 ret
= set_port_feature(udev
->parent
,
3872 USB_PORT_LPM_TIMEOUT(timeout
) | udev
->portnum
,
3875 dev_warn(&udev
->dev
, "Failed to set %s timeout to 0x%x,"
3876 "error code %i\n", usb3_lpm_names
[state
],
3880 if (state
== USB3_LPM_U1
)
3881 udev
->u1_params
.timeout
= timeout
;
3883 udev
->u2_params
.timeout
= timeout
;
3888 * Enable the hub-initiated U1/U2 idle timeouts, and enable device-initiated
3891 * We will attempt to enable U1 or U2, but there are no guarantees that the
3892 * control transfers to set the hub timeout or enable device-initiated U1/U2
3893 * will be successful.
3895 * If we cannot set the parent hub U1/U2 timeout, we attempt to let the xHCI
3896 * driver know about it. If that call fails, it should be harmless, and just
3897 * take up more slightly more bus bandwidth for unnecessary U1/U2 exit latency.
3899 static void usb_enable_link_state(struct usb_hcd
*hcd
, struct usb_device
*udev
,
3900 enum usb3_link_state state
)
3903 __u8 u1_mel
= udev
->bos
->ss_cap
->bU1devExitLat
;
3904 __le16 u2_mel
= udev
->bos
->ss_cap
->bU2DevExitLat
;
3906 /* If the device says it doesn't have *any* exit latency to come out of
3907 * U1 or U2, it's probably lying. Assume it doesn't implement that link
3910 if ((state
== USB3_LPM_U1
&& u1_mel
== 0) ||
3911 (state
== USB3_LPM_U2
&& u2_mel
== 0))
3915 * First, let the device know about the exit latencies
3916 * associated with the link state we're about to enable.
3918 ret
= usb_req_set_sel(udev
, state
);
3920 dev_warn(&udev
->dev
, "Set SEL for device-initiated %s failed.\n",
3921 usb3_lpm_names
[state
]);
3925 /* We allow the host controller to set the U1/U2 timeout internally
3926 * first, so that it can change its schedule to account for the
3927 * additional latency to send data to a device in a lower power
3930 timeout
= hcd
->driver
->enable_usb3_lpm_timeout(hcd
, udev
, state
);
3932 /* xHCI host controller doesn't want to enable this LPM state. */
3937 dev_warn(&udev
->dev
, "Could not enable %s link state, "
3938 "xHCI error %i.\n", usb3_lpm_names
[state
],
3943 if (usb_set_lpm_timeout(udev
, state
, timeout
))
3944 /* If we can't set the parent hub U1/U2 timeout,
3945 * device-initiated LPM won't be allowed either, so let the xHCI
3946 * host know that this link state won't be enabled.
3948 hcd
->driver
->disable_usb3_lpm_timeout(hcd
, udev
, state
);
3950 /* Only a configured device will accept the Set Feature U1/U2_ENABLE */
3951 else if (udev
->actconfig
)
3952 usb_set_device_initiated_lpm(udev
, state
, true);
3957 * Disable the hub-initiated U1/U2 idle timeouts, and disable device-initiated
3960 * If this function returns -EBUSY, the parent hub will still allow U1/U2 entry.
3961 * If zero is returned, the parent will not allow the link to go into U1/U2.
3963 * If zero is returned, device-initiated U1/U2 entry may still be enabled, but
3964 * it won't have an effect on the bus link state because the parent hub will
3965 * still disallow device-initiated U1/U2 entry.
3967 * If zero is returned, the xHCI host controller may still think U1/U2 entry is
3968 * possible. The result will be slightly more bus bandwidth will be taken up
3969 * (to account for U1/U2 exit latency), but it should be harmless.
3971 static int usb_disable_link_state(struct usb_hcd
*hcd
, struct usb_device
*udev
,
3972 enum usb3_link_state state
)
3978 feature
= USB_PORT_FEAT_U1_TIMEOUT
;
3981 feature
= USB_PORT_FEAT_U2_TIMEOUT
;
3984 dev_warn(&udev
->dev
, "%s: Can't disable non-U1 or U2 state.\n",
3989 if (usb_set_lpm_timeout(udev
, state
, 0))
3992 usb_set_device_initiated_lpm(udev
, state
, false);
3994 if (hcd
->driver
->disable_usb3_lpm_timeout(hcd
, udev
, state
))
3995 dev_warn(&udev
->dev
, "Could not disable xHCI %s timeout, "
3996 "bus schedule bandwidth may be impacted.\n",
3997 usb3_lpm_names
[state
]);
4002 * Disable hub-initiated and device-initiated U1 and U2 entry.
4003 * Caller must own the bandwidth_mutex.
4005 * This will call usb_enable_lpm() on failure, which will decrement
4006 * lpm_disable_count, and will re-enable LPM if lpm_disable_count reaches zero.
4008 int usb_disable_lpm(struct usb_device
*udev
)
4010 struct usb_hcd
*hcd
;
4012 if (!udev
|| !udev
->parent
||
4013 udev
->speed
!= USB_SPEED_SUPER
||
4017 hcd
= bus_to_hcd(udev
->bus
);
4018 if (!hcd
|| !hcd
->driver
->disable_usb3_lpm_timeout
)
4021 udev
->lpm_disable_count
++;
4022 if ((udev
->u1_params
.timeout
== 0 && udev
->u2_params
.timeout
== 0))
4025 /* If LPM is enabled, attempt to disable it. */
4026 if (usb_disable_link_state(hcd
, udev
, USB3_LPM_U1
))
4028 if (usb_disable_link_state(hcd
, udev
, USB3_LPM_U2
))
4034 usb_enable_lpm(udev
);
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
);
4048 mutex_lock(hcd
->bandwidth_mutex
);
4049 ret
= usb_disable_lpm(udev
);
4050 mutex_unlock(hcd
->bandwidth_mutex
);
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
4064 void usb_enable_lpm(struct usb_device
*udev
)
4066 struct usb_hcd
*hcd
;
4068 if (!udev
|| !udev
->parent
||
4069 udev
->speed
!= USB_SPEED_SUPER
||
4073 udev
->lpm_disable_count
--;
4074 hcd
= bus_to_hcd(udev
->bus
);
4075 /* Double check that we can both enable and disable LPM.
4076 * Device must be configured to accept set feature U1/U2 timeout.
4078 if (!hcd
|| !hcd
->driver
->enable_usb3_lpm_timeout
||
4079 !hcd
->driver
->disable_usb3_lpm_timeout
)
4082 if (udev
->lpm_disable_count
> 0)
4085 usb_enable_link_state(hcd
, udev
, USB3_LPM_U1
);
4086 usb_enable_link_state(hcd
, udev
, USB3_LPM_U2
);
4088 EXPORT_SYMBOL_GPL(usb_enable_lpm
);
4090 /* Grab the bandwidth_mutex before calling usb_enable_lpm() */
4091 void usb_unlocked_enable_lpm(struct usb_device
*udev
)
4093 struct usb_hcd
*hcd
= bus_to_hcd(udev
->bus
);
4098 mutex_lock(hcd
->bandwidth_mutex
);
4099 usb_enable_lpm(udev
);
4100 mutex_unlock(hcd
->bandwidth_mutex
);
4102 EXPORT_SYMBOL_GPL(usb_unlocked_enable_lpm
);
4105 #else /* CONFIG_PM */
4107 #define hub_suspend NULL
4108 #define hub_resume NULL
4109 #define hub_reset_resume NULL
4111 int usb_disable_lpm(struct usb_device
*udev
)
4115 EXPORT_SYMBOL_GPL(usb_disable_lpm
);
4117 void usb_enable_lpm(struct usb_device
*udev
) { }
4118 EXPORT_SYMBOL_GPL(usb_enable_lpm
);
4120 int usb_unlocked_disable_lpm(struct usb_device
*udev
)
4124 EXPORT_SYMBOL_GPL(usb_unlocked_disable_lpm
);
4126 void usb_unlocked_enable_lpm(struct usb_device
*udev
) { }
4127 EXPORT_SYMBOL_GPL(usb_unlocked_enable_lpm
);
4129 int usb_disable_ltm(struct usb_device
*udev
)
4133 EXPORT_SYMBOL_GPL(usb_disable_ltm
);
4135 void usb_enable_ltm(struct usb_device
*udev
) { }
4136 EXPORT_SYMBOL_GPL(usb_enable_ltm
);
4140 /* USB 2.0 spec, 7.1.7.3 / fig 7-29:
4142 * Between connect detection and reset signaling there must be a delay
4143 * of 100ms at least for debounce and power-settling. The corresponding
4144 * timer shall restart whenever the downstream port detects a disconnect.
4146 * Apparently there are some bluetooth and irda-dongles and a number of
4147 * low-speed devices for which this debounce period may last over a second.
4148 * Not covered by the spec - but easy to deal with.
4150 * This implementation uses a 1500ms total debounce timeout; if the
4151 * connection isn't stable by then it returns -ETIMEDOUT. It checks
4152 * every 25ms for transient disconnects. When the port status has been
4153 * unchanged for 100ms it returns the port status.
4155 int hub_port_debounce(struct usb_hub
*hub
, int port1
, bool must_be_connected
)
4158 int total_time
, stable_time
= 0;
4159 u16 portchange
, portstatus
;
4160 unsigned connection
= 0xffff;
4162 for (total_time
= 0; ; total_time
+= HUB_DEBOUNCE_STEP
) {
4163 ret
= hub_port_status(hub
, port1
, &portstatus
, &portchange
);
4167 if (!(portchange
& USB_PORT_STAT_C_CONNECTION
) &&
4168 (portstatus
& USB_PORT_STAT_CONNECTION
) == connection
) {
4169 if (!must_be_connected
||
4170 (connection
== USB_PORT_STAT_CONNECTION
))
4171 stable_time
+= HUB_DEBOUNCE_STEP
;
4172 if (stable_time
>= HUB_DEBOUNCE_STABLE
)
4176 connection
= portstatus
& USB_PORT_STAT_CONNECTION
;
4179 if (portchange
& USB_PORT_STAT_C_CONNECTION
) {
4180 usb_clear_port_feature(hub
->hdev
, port1
,
4181 USB_PORT_FEAT_C_CONNECTION
);
4184 if (total_time
>= HUB_DEBOUNCE_TIMEOUT
)
4186 msleep(HUB_DEBOUNCE_STEP
);
4189 dev_dbg (hub
->intfdev
,
4190 "debounce: port %d: total %dms stable %dms status 0x%x\n",
4191 port1
, total_time
, stable_time
, portstatus
);
4193 if (stable_time
< HUB_DEBOUNCE_STABLE
)
4198 void usb_ep0_reinit(struct usb_device
*udev
)
4200 usb_disable_endpoint(udev
, 0 + USB_DIR_IN
, true);
4201 usb_disable_endpoint(udev
, 0 + USB_DIR_OUT
, true);
4202 usb_enable_endpoint(udev
, &udev
->ep0
, true);
4204 EXPORT_SYMBOL_GPL(usb_ep0_reinit
);
4207 static int hub_set_address(struct usb_device
*udev
, int devnum
)
4210 struct usb_hcd
*hcd
= bus_to_hcd(udev
->bus
);
4213 * The host controller will choose the device address,
4214 * instead of the core having chosen it earlier
4216 if (!hcd
->driver
->address_device
&& devnum
<= 1)
4218 if (udev
->state
== USB_STATE_ADDRESS
)
4220 if (udev
->state
!= USB_STATE_DEFAULT
)
4222 if (hcd
->driver
->address_device
)
4223 retval
= hcd
->driver
->address_device(hcd
, udev
);
4225 retval
= usb_control_msg(udev
, usb_sndaddr0pipe(),
4226 USB_REQ_SET_ADDRESS
, 0, devnum
, 0,
4227 NULL
, 0, USB_CTRL_SET_TIMEOUT
);
4229 update_devnum(udev
, devnum
);
4230 /* Device now using proper address. */
4231 usb_set_device_state(udev
, USB_STATE_ADDRESS
);
4232 usb_ep0_reinit(udev
);
4237 /* Reset device, (re)assign address, get device descriptor.
4238 * Device connection must be stable, no more debouncing needed.
4239 * Returns device in USB_STATE_ADDRESS, except on error.
4241 * If this is called for an already-existing device (as part of
4242 * usb_reset_and_verify_device), the caller must own the device lock. For a
4243 * newly detected device that is not accessible through any global
4244 * pointers, it's not necessary to lock the device.
4247 hub_port_init (struct usb_hub
*hub
, struct usb_device
*udev
, int port1
,
4250 static DEFINE_MUTEX(usb_address0_mutex
);
4252 struct usb_device
*hdev
= hub
->hdev
;
4253 struct usb_hcd
*hcd
= bus_to_hcd(hdev
->bus
);
4255 unsigned delay
= HUB_SHORT_RESET_TIME
;
4256 enum usb_device_speed oldspeed
= udev
->speed
;
4258 int devnum
= udev
->devnum
;
4261 /* root hub ports have a slightly longer reset period
4262 * (from USB 2.0 spec, section 7.1.7.5)
4264 if (!hdev
->parent
) {
4265 delay
= HUB_ROOT_RESET_TIME
;
4266 if (port1
== hdev
->bus
->otg_port
)
4267 hdev
->bus
->b_hnp_enable
= 0;
4270 /* Some low speed devices have problems with the quick delay, so */
4271 /* be a bit pessimistic with those devices. RHbug #23670 */
4272 if (oldspeed
== USB_SPEED_LOW
)
4273 delay
= HUB_LONG_RESET_TIME
;
4275 mutex_lock(&usb_address0_mutex
);
4277 /* Reset the device; full speed may morph to high speed */
4278 /* FIXME a USB 2.0 device may morph into SuperSpeed on reset. */
4280 retval
= hub_port_reset(hub
, port1
, udev
, delay
, false);
4282 if (retval
< 0) /* error or disconnect */
4284 /* success, speed is known */
4288 if (oldspeed
!= USB_SPEED_UNKNOWN
&& oldspeed
!= udev
->speed
) {
4289 dev_dbg(&udev
->dev
, "device reset changed speed!\n");
4292 oldspeed
= udev
->speed
;
4294 /* USB 2.0 section 5.5.3 talks about ep0 maxpacket ...
4295 * it's fixed size except for full speed devices.
4296 * For Wireless USB devices, ep0 max packet is always 512 (tho
4297 * reported as 0xff in the device descriptor). WUSB1.0[4.8.1].
4299 switch (udev
->speed
) {
4300 case USB_SPEED_SUPER
:
4301 case USB_SPEED_WIRELESS
: /* fixed at 512 */
4302 udev
->ep0
.desc
.wMaxPacketSize
= cpu_to_le16(512);
4304 case USB_SPEED_HIGH
: /* fixed at 64 */
4305 udev
->ep0
.desc
.wMaxPacketSize
= cpu_to_le16(64);
4307 case USB_SPEED_FULL
: /* 8, 16, 32, or 64 */
4308 /* to determine the ep0 maxpacket size, try to read
4309 * the device descriptor to get bMaxPacketSize0 and
4310 * then correct our initial guess.
4312 udev
->ep0
.desc
.wMaxPacketSize
= cpu_to_le16(64);
4314 case USB_SPEED_LOW
: /* fixed at 8 */
4315 udev
->ep0
.desc
.wMaxPacketSize
= cpu_to_le16(8);
4322 if (udev
->speed
== USB_SPEED_WIRELESS
)
4323 speed
= "variable speed Wireless";
4325 speed
= usb_speed_string(udev
->speed
);
4327 if (udev
->speed
!= USB_SPEED_SUPER
)
4328 dev_info(&udev
->dev
,
4329 "%s %s USB device number %d using %s\n",
4330 (udev
->config
) ? "reset" : "new", speed
,
4331 devnum
, udev
->bus
->controller
->driver
->name
);
4333 /* Set up TT records, if needed */
4335 udev
->tt
= hdev
->tt
;
4336 udev
->ttport
= hdev
->ttport
;
4337 } else if (udev
->speed
!= USB_SPEED_HIGH
4338 && hdev
->speed
== USB_SPEED_HIGH
) {
4340 dev_err(&udev
->dev
, "parent hub has no TT\n");
4344 udev
->tt
= &hub
->tt
;
4345 udev
->ttport
= port1
;
4348 /* Why interleave GET_DESCRIPTOR and SET_ADDRESS this way?
4349 * Because device hardware and firmware is sometimes buggy in
4350 * this area, and this is how Linux has done it for ages.
4351 * Change it cautiously.
4353 * NOTE: If USE_NEW_SCHEME() is true we will start by issuing
4354 * a 64-byte GET_DESCRIPTOR request. This is what Windows does,
4355 * so it may help with some non-standards-compliant devices.
4356 * Otherwise we start with SET_ADDRESS and then try to read the
4357 * first 8 bytes of the device descriptor to get the ep0 maxpacket
4360 for (i
= 0; i
< GET_DESCRIPTOR_TRIES
; (++i
, msleep(100))) {
4362 if (USE_NEW_SCHEME(retry_counter
) && !(hcd
->driver
->flags
& HCD_USB3
)) {
4363 struct usb_device_descriptor
*buf
;
4366 #define GET_DESCRIPTOR_BUFSIZE 64
4367 buf
= kmalloc(GET_DESCRIPTOR_BUFSIZE
, GFP_NOIO
);
4373 /* Retry on all errors; some devices are flakey.
4374 * 255 is for WUSB devices, we actually need to use
4375 * 512 (WUSB1.0[4.8.1]).
4377 for (j
= 0; j
< 3; ++j
) {
4378 buf
->bMaxPacketSize0
= 0;
4379 r
= usb_control_msg(udev
, usb_rcvaddr0pipe(),
4380 USB_REQ_GET_DESCRIPTOR
, USB_DIR_IN
,
4381 USB_DT_DEVICE
<< 8, 0,
4382 buf
, GET_DESCRIPTOR_BUFSIZE
,
4383 initial_descriptor_timeout
);
4384 switch (buf
->bMaxPacketSize0
) {
4385 case 8: case 16: case 32: case 64: case 255:
4386 if (buf
->bDescriptorType
==
4400 #if defined(CONFIG_USBIF_COMPLIANCE) && defined(CONFIG_USB_XHCI_HCD)
4401 if (buf
->bMaxPacketSize0
== 0) {
4402 usbif_u3h_send_event("DEV_CONN_TMOUT");
4407 udev
->descriptor
.bMaxPacketSize0
=
4408 buf
->bMaxPacketSize0
;
4411 retval
= hub_port_reset(hub
, port1
, udev
, delay
, false);
4412 if (retval
< 0) /* error or disconnect */
4414 if (oldspeed
!= udev
->speed
) {
4416 "device reset changed speed!\n");
4422 dev_err(&udev
->dev
, "device descriptor read/64, error %d\n",
4427 #undef GET_DESCRIPTOR_BUFSIZE
4431 * If device is WUSB, we already assigned an
4432 * unauthorized address in the Connect Ack sequence;
4433 * authorization will assign the final address.
4435 if (udev
->wusb
== 0) {
4436 for (j
= 0; j
< SET_ADDRESS_TRIES
; ++j
) {
4437 retval
= hub_set_address(udev
, devnum
);
4443 if (retval
!= -ENODEV
)
4444 dev_err(&udev
->dev
, "device not accepting address %d, error %d\n",
4448 if (udev
->speed
== USB_SPEED_SUPER
) {
4449 devnum
= udev
->devnum
;
4450 dev_info(&udev
->dev
,
4451 "%s SuperSpeed USB device number %d using %s\n",
4452 (udev
->config
) ? "reset" : "new",
4453 devnum
, udev
->bus
->controller
->driver
->name
);
4456 /* cope with hardware quirkiness:
4457 * - let SET_ADDRESS settle, some device hardware wants it
4458 * - read ep0 maxpacket even for high and low speed,
4461 if (USE_NEW_SCHEME(retry_counter
) && !(hcd
->driver
->flags
& HCD_USB3
))
4465 retval
= usb_get_device_descriptor(udev
, 8);
4467 if (retval
!= -ENODEV
)
4469 "device descriptor read/8, error %d\n",
4481 if (hcd
->phy
&& !hdev
->parent
)
4482 usb_phy_notify_connect(hcd
->phy
, udev
->speed
);
4485 * Some superspeed devices have finished the link training process
4486 * and attached to a superspeed hub port, but the device descriptor
4487 * got from those devices show they aren't superspeed devices. Warm
4488 * reset the port attached by the devices can fix them.
4490 if ((udev
->speed
== USB_SPEED_SUPER
) &&
4491 (le16_to_cpu(udev
->descriptor
.bcdUSB
) < 0x0300)) {
4492 dev_err(&udev
->dev
, "got a wrong device descriptor, "
4493 "warm reset device\n");
4494 hub_port_reset(hub
, port1
, udev
,
4495 HUB_BH_RESET_TIME
, true);
4500 if (udev
->descriptor
.bMaxPacketSize0
== 0xff ||
4501 udev
->speed
== USB_SPEED_SUPER
)
4504 i
= udev
->descriptor
.bMaxPacketSize0
;
4505 if (usb_endpoint_maxp(&udev
->ep0
.desc
) != i
) {
4506 if (udev
->speed
== USB_SPEED_LOW
||
4507 !(i
== 8 || i
== 16 || i
== 32 || i
== 64)) {
4508 dev_err(&udev
->dev
, "Invalid ep0 maxpacket: %d\n", i
);
4512 if (udev
->speed
== USB_SPEED_FULL
)
4513 dev_dbg(&udev
->dev
, "ep0 maxpacket = %d\n", i
);
4515 dev_warn(&udev
->dev
, "Using ep0 maxpacket: %d\n", i
);
4516 udev
->ep0
.desc
.wMaxPacketSize
= cpu_to_le16(i
);
4517 usb_ep0_reinit(udev
);
4520 retval
= usb_get_device_descriptor(udev
, USB_DT_DEVICE_SIZE
);
4521 if (retval
< (signed)sizeof(udev
->descriptor
)) {
4522 if (retval
!= -ENODEV
)
4523 dev_err(&udev
->dev
, "device descriptor read/all, error %d\n",
4530 if (udev
->wusb
== 0 && le16_to_cpu(udev
->descriptor
.bcdUSB
) >= 0x0201) {
4531 retval
= usb_get_bos_descriptor(udev
);
4533 udev
->lpm_capable
= usb_device_supports_lpm(udev
);
4534 usb_set_lpm_parameters(udev
);
4539 /* notify HCD that we have a device connected and addressed */
4540 if (hcd
->driver
->update_device
)
4541 hcd
->driver
->update_device(hcd
, udev
);
4544 hub_port_disable(hub
, port1
, 0);
4545 update_devnum(udev
, devnum
); /* for disconnect processing */
4547 mutex_unlock(&usb_address0_mutex
);
4552 check_highspeed (struct usb_hub
*hub
, struct usb_device
*udev
, int port1
)
4554 struct usb_qualifier_descriptor
*qual
;
4557 qual
= kmalloc (sizeof *qual
, GFP_KERNEL
);
4561 status
= usb_get_descriptor (udev
, USB_DT_DEVICE_QUALIFIER
, 0,
4562 qual
, sizeof *qual
);
4563 if (status
== sizeof *qual
) {
4564 dev_info(&udev
->dev
, "not running at top speed; "
4565 "connect to a high speed hub\n");
4566 /* hub LEDs are probably harder to miss than syslog */
4567 if (hub
->has_indicators
) {
4568 hub
->indicator
[port1
-1] = INDICATOR_GREEN_BLINK
;
4569 schedule_delayed_work (&hub
->leds
, 0);
4576 hub_power_remaining (struct usb_hub
*hub
)
4578 struct usb_device
*hdev
= hub
->hdev
;
4582 if (!hub
->limited_power
)
4585 remaining
= hdev
->bus_mA
- hub
->descriptor
->bHubContrCurrent
;
4586 for (port1
= 1; port1
<= hdev
->maxchild
; ++port1
) {
4587 struct usb_device
*udev
= hub
->ports
[port1
- 1]->child
;
4593 if (hub_is_superspeed(udev
))
4599 * Unconfigured devices may not use more than one unit load,
4600 * or 8mA for OTG ports
4602 if (udev
->actconfig
)
4603 delta
= usb_get_max_power(udev
, udev
->actconfig
);
4604 else if (port1
!= udev
->bus
->otg_port
|| hdev
->parent
)
4608 if (delta
> hub
->mA_per_port
)
4609 dev_warn(&udev
->dev
,
4610 "%dmA is over %umA budget for port %d!\n",
4611 delta
, hub
->mA_per_port
, port1
);
4614 if (remaining
< 0) {
4615 #if defined(CONFIG_USBIF_COMPLIANCE) && defined(CONFIG_USB_XHCI_HCD)
4616 usbif_u3h_send_event("DEV_OVER_CURRENT");
4618 dev_warn(hub
->intfdev
, "%dmA over power budget!\n",
4625 /* Handle physical or logical connection change events.
4626 * This routine is called when:
4627 * a port connection-change occurs;
4628 * a port enable-change occurs (often caused by EMI);
4629 * usb_reset_and_verify_device() encounters changed descriptors (as from
4630 * a firmware download)
4631 * caller already locked the hub
4633 static void hub_port_connect_change(struct usb_hub
*hub
, int port1
,
4634 u16 portstatus
, u16 portchange
)
4636 struct usb_device
*hdev
= hub
->hdev
;
4637 struct device
*hub_dev
= hub
->intfdev
;
4638 struct usb_hcd
*hcd
= bus_to_hcd(hdev
->bus
);
4639 unsigned wHubCharacteristics
=
4640 le16_to_cpu(hub
->descriptor
->wHubCharacteristics
);
4641 struct usb_device
*udev
;
4647 "port %d, status %04x, change %04x, %s\n",
4648 port1
, portstatus
, portchange
, portspeed(hub
, portstatus
));
4650 if (hub
->has_indicators
) {
4651 set_port_led(hub
, port1
, HUB_LED_AUTO
);
4652 hub
->indicator
[port1
-1] = INDICATOR_AUTO
;
4655 #ifdef CONFIG_USB_OTG
4656 /* during HNP, don't repeat the debounce */
4657 if (hdev
->bus
->is_b_host
)
4658 portchange
&= ~(USB_PORT_STAT_C_CONNECTION
|
4659 USB_PORT_STAT_C_ENABLE
);
4662 /* Try to resuscitate an existing device */
4663 udev
= hub
->ports
[port1
- 1]->child
;
4664 if ((portstatus
& USB_PORT_STAT_CONNECTION
) && udev
&&
4665 udev
->state
!= USB_STATE_NOTATTACHED
) {
4666 usb_lock_device(udev
);
4667 if (portstatus
& USB_PORT_STAT_ENABLE
) {
4668 status
= 0; /* Nothing to do */
4670 #ifdef CONFIG_PM_RUNTIME
4671 } else if (udev
->state
== USB_STATE_SUSPENDED
&&
4672 udev
->persist_enabled
) {
4673 /* For a suspended device, treat this as a
4674 * remote wakeup event.
4676 status
= usb_remote_wakeup(udev
);
4680 status
= -ENODEV
; /* Don't resuscitate */
4682 usb_unlock_device(udev
);
4685 clear_bit(port1
, hub
->change_bits
);
4690 /* Disconnect any existing devices under this port */
4692 if (hcd
->phy
&& !hdev
->parent
&&
4693 !(portstatus
& USB_PORT_STAT_CONNECTION
))
4694 usb_phy_notify_disconnect(hcd
->phy
, udev
->speed
);
4695 usb_disconnect(&hub
->ports
[port1
- 1]->child
);
4697 clear_bit(port1
, hub
->change_bits
);
4699 /* We can forget about a "removed" device when there's a physical
4700 * disconnect or the connect status changes.
4702 if (!(portstatus
& USB_PORT_STAT_CONNECTION
) ||
4703 (portchange
& USB_PORT_STAT_C_CONNECTION
))
4704 clear_bit(port1
, hub
->removed_bits
);
4706 if (portchange
& (USB_PORT_STAT_C_CONNECTION
|
4707 USB_PORT_STAT_C_ENABLE
)) {
4708 status
= hub_port_debounce_be_stable(hub
, port1
);
4710 if (status
!= -ENODEV
&& printk_ratelimit())
4711 dev_err(hub_dev
, "connect-debounce failed, "
4712 "port %d disabled\n", port1
);
4713 portstatus
&= ~USB_PORT_STAT_CONNECTION
;
4715 portstatus
= status
;
4719 /* Return now if debouncing failed or nothing is connected or
4720 * the device was "removed".
4722 if (!(portstatus
& USB_PORT_STAT_CONNECTION
) ||
4723 test_bit(port1
, hub
->removed_bits
)) {
4725 /* maybe switch power back on (e.g. root hub was reset) */
4726 if ((wHubCharacteristics
& HUB_CHAR_LPSM
) < 2
4727 && !port_is_power_on(hub
, portstatus
))
4728 set_port_feature(hdev
, port1
, USB_PORT_FEAT_POWER
);
4730 if (portstatus
& USB_PORT_STAT_ENABLE
)
4734 if (hub_is_superspeed(hub
->hdev
))
4740 for (i
= 0; i
< SET_CONFIG_TRIES
; i
++) {
4742 /* reallocate for each attempt, since references
4743 * to the previous one can escape in various ways
4745 udev
= usb_alloc_dev(hdev
, hdev
->bus
, port1
);
4748 "couldn't allocate port %d usb_device\n",
4753 usb_set_device_state(udev
, USB_STATE_POWERED
);
4754 udev
->bus_mA
= hub
->mA_per_port
;
4755 udev
->level
= hdev
->level
+ 1;
4756 udev
->wusb
= hub_is_wusb(hub
);
4758 /* Only USB 3.0 devices are connected to SuperSpeed hubs. */
4759 if (hub_is_superspeed(hub
->hdev
))
4760 udev
->speed
= USB_SPEED_SUPER
;
4762 udev
->speed
= USB_SPEED_UNKNOWN
;
4764 choose_devnum(udev
);
4765 if (udev
->devnum
<= 0) {
4766 status
= -ENOTCONN
; /* Don't retry */
4770 /* reset (non-USB 3.0 devices) and get descriptor */
4772 status
= hub_port_init(hub
, udev
, port1
, i
);
4780 usb_detect_quirks(udev
);
4781 if (udev
->quirks
& USB_QUIRK_DELAY_INIT
)
4784 /* consecutive bus-powered hubs aren't reliable; they can
4785 * violate the voltage drop budget. if the new child has
4786 * a "powered" LED, users should notice we didn't enable it
4787 * (without reading syslog), even without per-port LEDs
4790 if (udev
->descriptor
.bDeviceClass
== USB_CLASS_HUB
4791 && udev
->bus_mA
<= unit_load
) {
4794 status
= usb_get_status(udev
, USB_RECIP_DEVICE
, 0,
4797 dev_dbg(&udev
->dev
, "get status %d ?\n", status
);
4800 le16_to_cpus(&devstat
);
4801 if ((devstat
& (1 << USB_DEVICE_SELF_POWERED
)) == 0) {
4803 "can't connect bus-powered hub "
4805 if (hub
->has_indicators
) {
4806 hub
->indicator
[port1
-1] =
4807 INDICATOR_AMBER_BLINK
;
4808 schedule_delayed_work (&hub
->leds
, 0);
4810 status
= -ENOTCONN
; /* Don't retry */
4815 /* check for devices running slower than they could */
4816 if (le16_to_cpu(udev
->descriptor
.bcdUSB
) >= 0x0200
4817 && udev
->speed
== USB_SPEED_FULL
4818 && highspeed_hubs
!= 0)
4819 check_highspeed (hub
, udev
, port1
);
4821 /* Store the parent's children[] pointer. At this point
4822 * udev becomes globally accessible, although presumably
4823 * no one will look at it until hdev is unlocked.
4827 /* We mustn't add new devices if the parent hub has
4828 * been disconnected; we would race with the
4829 * recursively_mark_NOTATTACHED() routine.
4831 spin_lock_irq(&device_state_lock
);
4832 if (hdev
->state
== USB_STATE_NOTATTACHED
)
4835 hub
->ports
[port1
- 1]->child
= udev
;
4836 spin_unlock_irq(&device_state_lock
);
4838 /* Run it through the hoops (find a driver, etc) */
4840 status
= usb_new_device(udev
);
4842 spin_lock_irq(&device_state_lock
);
4843 hub
->ports
[port1
- 1]->child
= NULL
;
4844 spin_unlock_irq(&device_state_lock
);
4846 #ifdef CONFIG_MTK_DT_USB_SUPPORT
4848 MYDBG("get new device !!!, BUILD TIME : %s, g_dsda_dev : %p\n", __TIME__
, g_dsda_dev
);
4855 status
= hub_power_remaining(hub
);
4857 dev_dbg(hub_dev
, "%dmA power budget left\n", status
);
4862 hub_port_disable(hub
, port1
, 1);
4864 usb_ep0_reinit(udev
);
4865 release_devnum(udev
);
4868 if ((status
== -ENOTCONN
) || (status
== -ENOTSUPP
))
4871 if (hub
->hdev
->parent
||
4872 !hcd
->driver
->port_handed_over
||
4873 !(hcd
->driver
->port_handed_over
)(hcd
, port1
)) {
4874 if (status
!= -ENOTCONN
&& status
!= -ENODEV
)
4875 dev_err(hub_dev
, "unable to enumerate USB device on port %d\n",
4880 hub_port_disable(hub
, port1
, 1);
4881 if (hcd
->driver
->relinquish_port
&& !hub
->hdev
->parent
)
4882 hcd
->driver
->relinquish_port(hcd
, port1
);
4885 /* Returns 1 if there was a remote wakeup and a connect status change. */
4886 static int hub_handle_remote_wakeup(struct usb_hub
*hub
, unsigned int port
,
4887 u16 portstatus
, u16 portchange
)
4889 struct usb_device
*hdev
;
4890 struct usb_device
*udev
;
4891 int connect_change
= 0;
4895 udev
= hub
->ports
[port
- 1]->child
;
4896 if (!hub_is_superspeed(hdev
)) {
4897 if (!(portchange
& USB_PORT_STAT_C_SUSPEND
))
4899 usb_clear_port_feature(hdev
, port
, USB_PORT_FEAT_C_SUSPEND
);
4901 if (!udev
|| udev
->state
!= USB_STATE_SUSPENDED
||
4902 (portstatus
& USB_PORT_STAT_LINK_STATE
) !=
4908 /* TRSMRCY = 10 msec */
4911 usb_lock_device(udev
);
4912 ret
= usb_remote_wakeup(udev
);
4913 usb_unlock_device(udev
);
4918 hub_port_disable(hub
, port
, 1);
4920 dev_dbg(hub
->intfdev
, "resume on port %d, status %d\n",
4922 return connect_change
;
4925 static void hub_events(void)
4927 struct list_head
*tmp
;
4928 struct usb_device
*hdev
;
4929 struct usb_interface
*intf
;
4930 struct usb_hub
*hub
;
4931 struct device
*hub_dev
;
4937 int connect_change
, wakeup_change
;
4940 * We restart the list every time to avoid a deadlock with
4941 * deleting hubs downstream from this one. This should be
4942 * safe since we delete the hub from the event list.
4943 * Not the most efficient, but avoids deadlocks.
4947 /* Grab the first entry at the beginning of the list */
4948 spin_lock_irq(&hub_event_lock
);
4949 if (list_empty(&hub_event_list
)) {
4950 spin_unlock_irq(&hub_event_lock
);
4954 tmp
= hub_event_list
.next
;
4957 hub
= list_entry(tmp
, struct usb_hub
, event_list
);
4958 kref_get(&hub
->kref
);
4959 spin_unlock_irq(&hub_event_lock
);
4962 hub_dev
= hub
->intfdev
;
4963 intf
= to_usb_interface(hub_dev
);
4964 dev_dbg(hub_dev
, "state %d ports %d chg %04x evt %04x\n",
4965 hdev
->state
, hub
->descriptor
4966 ? hub
->descriptor
->bNbrPorts
4968 /* NOTE: expects max 15 ports... */
4969 (u16
) hub
->change_bits
[0],
4970 (u16
) hub
->event_bits
[0]);
4972 /* Lock the device, then check to see if we were
4973 * disconnected while waiting for the lock to succeed. */
4974 usb_lock_device(hdev
);
4975 if (unlikely(hub
->disconnected
))
4976 goto loop_disconnected
;
4978 /* If the hub has died, clean up after it */
4979 if (hdev
->state
== USB_STATE_NOTATTACHED
) {
4980 hub
->error
= -ENODEV
;
4981 hub_quiesce(hub
, HUB_DISCONNECT
);
4986 ret
= usb_autopm_get_interface(intf
);
4988 dev_dbg(hub_dev
, "Can't autoresume: %d\n", ret
);
4992 /* If this is an inactive hub, do nothing */
4997 dev_dbg (hub_dev
, "resetting for error %d\n",
5001 ret
= usb_reset_device(hdev
);
5004 "error resetting hub: %d\n", ret
);
5012 /* deal with port status changes */
5013 for (i
= 1; i
<= hub
->descriptor
->bNbrPorts
; i
++) {
5014 if (test_bit(i
, hub
->busy_bits
))
5016 connect_change
= test_bit(i
, hub
->change_bits
);
5017 wakeup_change
= test_and_clear_bit(i
, hub
->wakeup_bits
);
5018 if (!test_and_clear_bit(i
, hub
->event_bits
) &&
5019 !connect_change
&& !wakeup_change
)
5022 ret
= hub_port_status(hub
, i
,
5023 &portstatus
, &portchange
);
5027 if (portchange
& USB_PORT_STAT_C_CONNECTION
) {
5028 usb_clear_port_feature(hdev
, i
,
5029 USB_PORT_FEAT_C_CONNECTION
);
5033 if (portchange
& USB_PORT_STAT_C_ENABLE
) {
5034 if (!connect_change
)
5036 "port %d enable change, "
5039 usb_clear_port_feature(hdev
, i
,
5040 USB_PORT_FEAT_C_ENABLE
);
5043 * EM interference sometimes causes badly
5044 * shielded USB devices to be shutdown by
5045 * the hub, this hack enables them again.
5046 * Works at least with mouse driver.
5048 if (!(portstatus
& USB_PORT_STAT_ENABLE
)
5050 && hub
->ports
[i
- 1]->child
) {
5053 "disabled by hub (EMI?), "
5060 if (hub_handle_remote_wakeup(hub
, i
,
5061 portstatus
, portchange
))
5064 if (portchange
& USB_PORT_STAT_C_OVERCURRENT
) {
5068 dev_dbg(hub_dev
, "over-current change on port "
5070 usb_clear_port_feature(hdev
, i
,
5071 USB_PORT_FEAT_C_OVER_CURRENT
);
5072 msleep(100); /* Cool down */
5073 hub_power_on(hub
, true);
5074 hub_port_status(hub
, i
, &status
, &unused
);
5075 if (status
& USB_PORT_STAT_OVERCURRENT
)
5076 dev_err(hub_dev
, "over-current "
5077 "condition on port %d\n", i
);
5080 if (portchange
& USB_PORT_STAT_C_RESET
) {
5082 "reset change on port %d\n",
5084 usb_clear_port_feature(hdev
, i
,
5085 USB_PORT_FEAT_C_RESET
);
5087 if ((portchange
& USB_PORT_STAT_C_BH_RESET
) &&
5088 hub_is_superspeed(hub
->hdev
)) {
5090 "warm reset change on port %d\n",
5092 usb_clear_port_feature(hdev
, i
,
5093 USB_PORT_FEAT_C_BH_PORT_RESET
);
5095 if (portchange
& USB_PORT_STAT_C_LINK_STATE
) {
5096 usb_clear_port_feature(hub
->hdev
, i
,
5097 USB_PORT_FEAT_C_PORT_LINK_STATE
);
5099 if (portchange
& USB_PORT_STAT_C_CONFIG_ERROR
) {
5101 "config error on port %d\n",
5103 usb_clear_port_feature(hub
->hdev
, i
,
5104 USB_PORT_FEAT_C_PORT_CONFIG_ERROR
);
5107 /* Warm reset a USB3 protocol port if it's in
5108 * SS.Inactive state.
5110 if (hub_port_warm_reset_required(hub
, portstatus
)) {
5112 struct usb_device
*udev
=
5113 hub
->ports
[i
- 1]->child
;
5115 dev_dbg(hub_dev
, "warm reset port %d\n", i
);
5117 !(portstatus
& USB_PORT_STAT_CONNECTION
) ||
5118 udev
->state
== USB_STATE_NOTATTACHED
) {
5119 status
= hub_port_reset(hub
, i
,
5120 NULL
, HUB_BH_RESET_TIME
,
5123 hub_port_disable(hub
, i
, 1);
5125 usb_lock_device(udev
);
5126 status
= usb_reset_device(udev
);
5127 usb_unlock_device(udev
);
5133 hub_port_connect_change(hub
, i
,
5134 portstatus
, portchange
);
5137 /* deal with hub status changes */
5138 if (test_and_clear_bit(0, hub
->event_bits
) == 0)
5140 else if (hub_hub_status(hub
, &hubstatus
, &hubchange
) < 0)
5141 dev_err (hub_dev
, "get_hub_status failed\n");
5143 if (hubchange
& HUB_CHANGE_LOCAL_POWER
) {
5144 dev_dbg (hub_dev
, "power change\n");
5145 clear_hub_feature(hdev
, C_HUB_LOCAL_POWER
);
5146 if (hubstatus
& HUB_STATUS_LOCAL_POWER
)
5147 /* FIXME: Is this always true? */
5148 hub
->limited_power
= 1;
5150 hub
->limited_power
= 0;
5152 if (hubchange
& HUB_CHANGE_OVERCURRENT
) {
5156 dev_dbg(hub_dev
, "over-current change\n");
5157 clear_hub_feature(hdev
, C_HUB_OVER_CURRENT
);
5158 msleep(500); /* Cool down */
5159 hub_power_on(hub
, true);
5160 hub_hub_status(hub
, &status
, &unused
);
5161 if (status
& HUB_STATUS_OVERCURRENT
)
5162 dev_err(hub_dev
, "over-current "
5168 /* Balance the usb_autopm_get_interface() above */
5169 usb_autopm_put_interface_no_suspend(intf
);
5171 /* Balance the usb_autopm_get_interface_no_resume() in
5172 * kick_khubd() and allow autosuspend.
5174 usb_autopm_put_interface(intf
);
5176 usb_unlock_device(hdev
);
5177 kref_put(&hub
->kref
, hub_release
);
5179 } /* end while (1) */
5182 static int hub_thread(void *__unused
)
5184 /* khubd needs to be freezable to avoid intefering with USB-PERSIST
5185 * port handover. Otherwise it might see that a full-speed device
5186 * was gone before the EHCI controller had handed its port over to
5187 * the companion full-speed controller.
5193 wait_event_freezable(khubd_wait
,
5194 !list_empty(&hub_event_list
) ||
5195 kthread_should_stop());
5196 } while (!kthread_should_stop() || !list_empty(&hub_event_list
));
5198 pr_debug("%s: khubd exiting\n", usbcore_name
);
5202 static const struct usb_device_id hub_id_table
[] = {
5203 { .match_flags
= USB_DEVICE_ID_MATCH_VENDOR
5204 | USB_DEVICE_ID_MATCH_INT_CLASS
,
5205 .idVendor
= USB_VENDOR_GENESYS_LOGIC
,
5206 .bInterfaceClass
= USB_CLASS_HUB
,
5207 .driver_info
= HUB_QUIRK_CHECK_PORT_AUTOSUSPEND
},
5208 { .match_flags
= USB_DEVICE_ID_MATCH_DEV_CLASS
,
5209 .bDeviceClass
= USB_CLASS_HUB
},
5210 { .match_flags
= USB_DEVICE_ID_MATCH_INT_CLASS
,
5211 .bInterfaceClass
= USB_CLASS_HUB
},
5212 { } /* Terminating entry */
5215 MODULE_DEVICE_TABLE (usb
, hub_id_table
);
5217 static struct usb_driver hub_driver
= {
5220 .disconnect
= hub_disconnect
,
5221 .suspend
= hub_suspend
,
5222 .resume
= hub_resume
,
5223 .reset_resume
= hub_reset_resume
,
5224 .pre_reset
= hub_pre_reset
,
5225 .post_reset
= hub_post_reset
,
5226 .unlocked_ioctl
= hub_ioctl
,
5227 .id_table
= hub_id_table
,
5228 .supports_autosuspend
= 1,
5231 #if defined(CONFIG_MTK_XHCI) && defined(CONFIG_USB_MTK_DUALMODE)
5232 extern void mtk_hub_event_steal(spinlock_t
*lock
, struct list_head
* list
);
5234 int usb_hub_init(void)
5236 if (usb_register(&hub_driver
) < 0) {
5237 printk(KERN_ERR
"%s: can't register hub driver\n",
5242 #if defined(CONFIG_MTK_XHCI) && defined(CONFIG_USB_MTK_DUALMODE)
5243 mtk_hub_event_steal(&hub_event_lock
, &hub_event_list
);
5246 khubd_task
= kthread_run(hub_thread
, NULL
, "khubd");
5247 if (!IS_ERR(khubd_task
))
5250 /* Fall through if kernel_thread failed */
5251 usb_deregister(&hub_driver
);
5252 printk(KERN_ERR
"%s: can't start khubd\n", usbcore_name
);
5257 void usb_hub_cleanup(void)
5259 kthread_stop(khubd_task
);
5262 * Hub resources are freed for us by usb_deregister. It calls
5263 * usb_driver_purge on every device which in turn calls that
5264 * devices disconnect function if it is using this driver.
5265 * The hub_disconnect function takes care of releasing the
5266 * individual hub resources. -greg
5268 usb_deregister(&hub_driver
);
5269 } /* usb_hub_cleanup() */
5271 static int descriptors_changed(struct usb_device
*udev
,
5272 struct usb_device_descriptor
*old_device_descriptor
)
5276 unsigned serial_len
= 0;
5278 unsigned old_length
;
5282 if (memcmp(&udev
->descriptor
, old_device_descriptor
,
5283 sizeof(*old_device_descriptor
)) != 0)
5286 /* Since the idVendor, idProduct, and bcdDevice values in the
5287 * device descriptor haven't changed, we will assume the
5288 * Manufacturer and Product strings haven't changed either.
5289 * But the SerialNumber string could be different (e.g., a
5290 * different flash card of the same brand).
5293 serial_len
= strlen(udev
->serial
) + 1;
5296 for (index
= 0; index
< udev
->descriptor
.bNumConfigurations
; index
++) {
5297 old_length
= le16_to_cpu(udev
->config
[index
].desc
.wTotalLength
);
5298 len
= max(len
, old_length
);
5301 buf
= kmalloc(len
, GFP_NOIO
);
5303 dev_err(&udev
->dev
, "no mem to re-read configs after reset\n");
5304 /* assume the worst */
5307 for (index
= 0; index
< udev
->descriptor
.bNumConfigurations
; index
++) {
5308 old_length
= le16_to_cpu(udev
->config
[index
].desc
.wTotalLength
);
5309 length
= usb_get_descriptor(udev
, USB_DT_CONFIG
, index
, buf
,
5311 if (length
!= old_length
) {
5312 dev_dbg(&udev
->dev
, "config index %d, error %d\n",
5317 if (memcmp (buf
, udev
->rawdescriptors
[index
], old_length
)
5319 dev_dbg(&udev
->dev
, "config index %d changed (#%d)\n",
5321 ((struct usb_config_descriptor
*) buf
)->
5322 bConfigurationValue
);
5328 if (!changed
&& serial_len
) {
5329 length
= usb_string(udev
, udev
->descriptor
.iSerialNumber
,
5331 if (length
+ 1 != serial_len
) {
5332 dev_dbg(&udev
->dev
, "serial string error %d\n",
5335 } else if (memcmp(buf
, udev
->serial
, length
) != 0) {
5336 dev_dbg(&udev
->dev
, "serial string changed\n");
5346 * usb_reset_and_verify_device - perform a USB port reset to reinitialize a device
5347 * @udev: device to reset (not in SUSPENDED or NOTATTACHED state)
5349 * WARNING - don't use this routine to reset a composite device
5350 * (one with multiple interfaces owned by separate drivers)!
5351 * Use usb_reset_device() instead.
5353 * Do a port reset, reassign the device's address, and establish its
5354 * former operating configuration. If the reset fails, or the device's
5355 * descriptors change from their values before the reset, or the original
5356 * configuration and altsettings cannot be restored, a flag will be set
5357 * telling khubd to pretend the device has been disconnected and then
5358 * re-connected. All drivers will be unbound, and the device will be
5359 * re-enumerated and probed all over again.
5361 * Returns 0 if the reset succeeded, -ENODEV if the device has been
5362 * flagged for logical disconnection, or some other negative error code
5363 * if the reset wasn't even attempted.
5365 * The caller must own the device lock. For example, it's safe to use
5366 * this from a driver probe() routine after downloading new firmware.
5367 * For calls that might not occur during probe(), drivers should lock
5368 * the device using usb_lock_device_for_reset().
5370 * Locking exception: This routine may also be called from within an
5371 * autoresume handler. Such usage won't conflict with other tasks
5372 * holding the device lock because these tasks should always call
5373 * usb_autopm_resume_device(), thereby preventing any unwanted autoresume.
5375 static int usb_reset_and_verify_device(struct usb_device
*udev
)
5377 struct usb_device
*parent_hdev
= udev
->parent
;
5378 struct usb_hub
*parent_hub
;
5379 struct usb_hcd
*hcd
= bus_to_hcd(udev
->bus
);
5380 struct usb_device_descriptor descriptor
= udev
->descriptor
;
5382 int port1
= udev
->portnum
;
5385 if (udev
->state
== USB_STATE_NOTATTACHED
||
5386 udev
->state
== USB_STATE_SUSPENDED
) {
5387 dev_dbg(&udev
->dev
, "device reset not allowed in state %d\n",
5393 /* this requires hcd-specific logic; see ohci_restart() */
5394 dev_dbg(&udev
->dev
, "%s for root hub!\n", __func__
);
5397 parent_hub
= usb_hub_to_struct_hub(parent_hdev
);
5399 /* Disable LPM and LTM while we reset the device and reinstall the alt
5400 * settings. Device-initiated LPM settings, and system exit latency
5401 * settings are cleared when the device is reset, so we have to set
5404 ret
= usb_unlocked_disable_lpm(udev
);
5406 dev_err(&udev
->dev
, "%s Failed to disable LPM\n.", __func__
);
5409 ret
= usb_disable_ltm(udev
);
5411 dev_err(&udev
->dev
, "%s Failed to disable LTM\n.",
5416 set_bit(port1
, parent_hub
->busy_bits
);
5417 for (i
= 0; i
< SET_CONFIG_TRIES
; ++i
) {
5419 /* ep0 maxpacket size may change; let the HCD know about it.
5420 * Other endpoints will be handled by re-enumeration. */
5421 usb_ep0_reinit(udev
);
5422 ret
= hub_port_init(parent_hub
, udev
, port1
, i
);
5423 if (ret
>= 0 || ret
== -ENOTCONN
|| ret
== -ENODEV
)
5426 clear_bit(port1
, parent_hub
->busy_bits
);
5431 /* Device might have changed firmware (DFU or similar) */
5432 if (descriptors_changed(udev
, &descriptor
)) {
5433 dev_info(&udev
->dev
, "device firmware changed\n");
5434 udev
->descriptor
= descriptor
; /* for disconnect() calls */
5438 /* Restore the device's previous configuration */
5439 if (!udev
->actconfig
)
5442 mutex_lock(hcd
->bandwidth_mutex
);
5443 ret
= usb_hcd_alloc_bandwidth(udev
, udev
->actconfig
, NULL
, NULL
);
5445 dev_warn(&udev
->dev
,
5446 "Busted HC? Not enough HCD resources for "
5447 "old configuration.\n");
5448 mutex_unlock(hcd
->bandwidth_mutex
);
5451 ret
= usb_control_msg(udev
, usb_sndctrlpipe(udev
, 0),
5452 USB_REQ_SET_CONFIGURATION
, 0,
5453 udev
->actconfig
->desc
.bConfigurationValue
, 0,
5454 NULL
, 0, USB_CTRL_SET_TIMEOUT
);
5457 "can't restore configuration #%d (error=%d)\n",
5458 udev
->actconfig
->desc
.bConfigurationValue
, ret
);
5459 mutex_unlock(hcd
->bandwidth_mutex
);
5462 mutex_unlock(hcd
->bandwidth_mutex
);
5463 usb_set_device_state(udev
, USB_STATE_CONFIGURED
);
5465 /* Put interfaces back into the same altsettings as before.
5466 * Don't bother to send the Set-Interface request for interfaces
5467 * that were already in altsetting 0; besides being unnecessary,
5468 * many devices can't handle it. Instead just reset the host-side
5471 for (i
= 0; i
< udev
->actconfig
->desc
.bNumInterfaces
; i
++) {
5472 struct usb_host_config
*config
= udev
->actconfig
;
5473 struct usb_interface
*intf
= config
->interface
[i
];
5474 struct usb_interface_descriptor
*desc
;
5476 desc
= &intf
->cur_altsetting
->desc
;
5477 if (desc
->bAlternateSetting
== 0) {
5478 usb_disable_interface(udev
, intf
, true);
5479 usb_enable_interface(udev
, intf
, true);
5482 /* Let the bandwidth allocation function know that this
5483 * device has been reset, and it will have to use
5484 * alternate setting 0 as the current alternate setting.
5486 intf
->resetting_device
= 1;
5487 ret
= usb_set_interface(udev
, desc
->bInterfaceNumber
,
5488 desc
->bAlternateSetting
);
5489 intf
->resetting_device
= 0;
5492 dev_err(&udev
->dev
, "failed to restore interface %d "
5493 "altsetting %d (error=%d)\n",
5494 desc
->bInterfaceNumber
,
5495 desc
->bAlternateSetting
,
5502 /* Now that the alt settings are re-installed, enable LTM and LPM. */
5503 usb_unlocked_enable_lpm(udev
);
5504 usb_enable_ltm(udev
);
5508 /* LPM state doesn't matter when we're about to destroy the device. */
5509 hub_port_logical_disconnect(parent_hub
, port1
);
5514 * usb_reset_device - warn interface drivers and perform a USB port reset
5515 * @udev: device to reset (not in SUSPENDED or NOTATTACHED state)
5517 * Warns all drivers bound to registered interfaces (using their pre_reset
5518 * method), performs the port reset, and then lets the drivers know that
5519 * the reset is over (using their post_reset method).
5521 * Return value is the same as for usb_reset_and_verify_device().
5523 * The caller must own the device lock. For example, it's safe to use
5524 * this from a driver probe() routine after downloading new firmware.
5525 * For calls that might not occur during probe(), drivers should lock
5526 * the device using usb_lock_device_for_reset().
5528 * If an interface is currently being probed or disconnected, we assume
5529 * its driver knows how to handle resets. For all other interfaces,
5530 * if the driver doesn't have pre_reset and post_reset methods then
5531 * we attempt to unbind it and rebind afterward.
5533 int usb_reset_device(struct usb_device
*udev
)
5537 unsigned int noio_flag
;
5538 struct usb_host_config
*config
= udev
->actconfig
;
5541 if (udev
->state
== USB_STATE_NOTATTACHED
||
5542 udev
->state
== USB_STATE_SUSPENDED
) {
5543 dev_dbg(&udev
->dev
, "device reset not allowed in state %d\n",
5549 * Don't allocate memory with GFP_KERNEL in current
5550 * context to avoid possible deadlock if usb mass
5551 * storage interface or usbnet interface(iSCSI case)
5552 * is included in current configuration. The easist
5553 * approach is to do it for every device reset,
5554 * because the device 'memalloc_noio' flag may have
5555 * not been set before reseting the usb device.
5557 noio_flag
= memalloc_noio_save();
5559 /* Prevent autosuspend during the reset */
5560 usb_autoresume_device(udev
);
5563 for (i
= 0; i
< config
->desc
.bNumInterfaces
; ++i
) {
5564 struct usb_interface
*cintf
= config
->interface
[i
];
5565 struct usb_driver
*drv
;
5568 if (cintf
->dev
.driver
) {
5569 drv
= to_usb_driver(cintf
->dev
.driver
);
5570 if (drv
->pre_reset
&& drv
->post_reset
)
5571 unbind
= (drv
->pre_reset
)(cintf
);
5572 else if (cintf
->condition
==
5573 USB_INTERFACE_BOUND
)
5576 usb_forced_unbind_intf(cintf
);
5581 ret
= usb_reset_and_verify_device(udev
);
5584 for (i
= config
->desc
.bNumInterfaces
- 1; i
>= 0; --i
) {
5585 struct usb_interface
*cintf
= config
->interface
[i
];
5586 struct usb_driver
*drv
;
5587 int rebind
= cintf
->needs_binding
;
5589 if (!rebind
&& cintf
->dev
.driver
) {
5590 drv
= to_usb_driver(cintf
->dev
.driver
);
5591 if (drv
->post_reset
)
5592 rebind
= (drv
->post_reset
)(cintf
);
5593 else if (cintf
->condition
==
5594 USB_INTERFACE_BOUND
)
5597 cintf
->needs_binding
= 1;
5600 usb_unbind_and_rebind_marked_interfaces(udev
);
5603 usb_autosuspend_device(udev
);
5604 memalloc_noio_restore(noio_flag
);
5607 EXPORT_SYMBOL_GPL(usb_reset_device
);
5611 * usb_queue_reset_device - Reset a USB device from an atomic context
5612 * @iface: USB interface belonging to the device to reset
5614 * This function can be used to reset a USB device from an atomic
5615 * context, where usb_reset_device() won't work (as it blocks).
5617 * Doing a reset via this method is functionally equivalent to calling
5618 * usb_reset_device(), except for the fact that it is delayed to a
5619 * workqueue. This means that any drivers bound to other interfaces
5620 * might be unbound, as well as users from usbfs in user space.
5624 * - Scheduling two resets at the same time from two different drivers
5625 * attached to two different interfaces of the same device is
5626 * possible; depending on how the driver attached to each interface
5627 * handles ->pre_reset(), the second reset might happen or not.
5629 * - If a driver is unbound and it had a pending reset, the reset will
5632 * - This function can be called during .probe() or .disconnect()
5633 * times. On return from .disconnect(), any pending resets will be
5636 * There is no no need to lock/unlock the @reset_ws as schedule_work()
5639 * NOTE: We don't do any reference count tracking because it is not
5640 * needed. The lifecycle of the work_struct is tied to the
5641 * usb_interface. Before destroying the interface we cancel the
5642 * work_struct, so the fact that work_struct is queued and or
5643 * running means the interface (and thus, the device) exist and
5646 void usb_queue_reset_device(struct usb_interface
*iface
)
5648 schedule_work(&iface
->reset_ws
);
5650 EXPORT_SYMBOL_GPL(usb_queue_reset_device
);
5653 * usb_hub_find_child - Get the pointer of child device
5654 * attached to the port which is specified by @port1.
5655 * @hdev: USB device belonging to the usb hub
5656 * @port1: port num to indicate which port the child device
5659 * USB drivers call this function to get hub's child device
5662 * Return NULL if input param is invalid and
5663 * child's usb_device pointer if non-NULL.
5665 struct usb_device
*usb_hub_find_child(struct usb_device
*hdev
,
5668 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
5670 if (port1
< 1 || port1
> hdev
->maxchild
)
5672 return hub
->ports
[port1
- 1]->child
;
5674 EXPORT_SYMBOL_GPL(usb_hub_find_child
);
5677 * usb_set_hub_port_connect_type - set hub port connect type.
5678 * @hdev: USB device belonging to the usb hub
5679 * @port1: port num of the port
5680 * @type: connect type of the port
5682 void usb_set_hub_port_connect_type(struct usb_device
*hdev
, int port1
,
5683 enum usb_port_connect_type type
)
5685 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
5687 hub
->ports
[port1
- 1]->connect_type
= type
;
5691 * usb_get_hub_port_connect_type - Get the port's connect type
5692 * @hdev: USB device belonging to the usb hub
5693 * @port1: port num of the port
5695 * Return connect type of the port and if input params are
5696 * invalid, return USB_PORT_CONNECT_TYPE_UNKNOWN.
5698 enum usb_port_connect_type
5699 usb_get_hub_port_connect_type(struct usb_device
*hdev
, int port1
)
5701 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
5703 return hub
->ports
[port1
- 1]->connect_type
;
5706 void usb_hub_adjust_deviceremovable(struct usb_device
*hdev
,
5707 struct usb_hub_descriptor
*desc
)
5709 enum usb_port_connect_type connect_type
;
5712 if (!hub_is_superspeed(hdev
)) {
5713 for (i
= 1; i
<= hdev
->maxchild
; i
++) {
5714 connect_type
= usb_get_hub_port_connect_type(hdev
, i
);
5716 if (connect_type
== USB_PORT_CONNECT_TYPE_HARD_WIRED
) {
5717 u8 mask
= 1 << (i
%8);
5719 if (!(desc
->u
.hs
.DeviceRemovable
[i
/8] & mask
)) {
5720 dev_dbg(&hdev
->dev
, "usb port%d's DeviceRemovable is changed to 1 according to platform information.\n",
5722 desc
->u
.hs
.DeviceRemovable
[i
/8] |= mask
;
5727 u16 port_removable
= le16_to_cpu(desc
->u
.ss
.DeviceRemovable
);
5729 for (i
= 1; i
<= hdev
->maxchild
; i
++) {
5730 connect_type
= usb_get_hub_port_connect_type(hdev
, i
);
5732 if (connect_type
== USB_PORT_CONNECT_TYPE_HARD_WIRED
) {
5735 if (!(port_removable
& mask
)) {
5736 dev_dbg(&hdev
->dev
, "usb port%d's DeviceRemovable is changed to 1 according to platform information.\n",
5738 port_removable
|= mask
;
5743 desc
->u
.ss
.DeviceRemovable
= cpu_to_le16(port_removable
);
5749 * usb_get_hub_port_acpi_handle - Get the usb port's acpi handle
5750 * @hdev: USB device belonging to the usb hub
5751 * @port1: port num of the port
5753 * Return port's acpi handle if successful, NULL if params are
5756 acpi_handle
usb_get_hub_port_acpi_handle(struct usb_device
*hdev
,
5759 struct usb_hub
*hub
= usb_hub_to_struct_hub(hdev
);
5761 return DEVICE_ACPI_HANDLE(&hub
->ports
[port1
- 1]->dev
);