2 * Copyright (C) 2001-2004 by David Brownell
4 * This program is free software; you can redistribute it and/or modify it
5 * under the terms of the GNU General Public License as published by the
6 * Free Software Foundation; either version 2 of the License, or (at your
7 * option) any later version.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
11 * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software Foundation,
16 * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
19 /* this file is part of ehci-hcd.c */
21 /*-------------------------------------------------------------------------*/
24 * EHCI Root Hub ... the nonsharable stuff
26 * Registers don't need cpu_to_le32, that happens transparently
29 /*-------------------------------------------------------------------------*/
30 #include <linux/usb/otg.h>
32 #define PORT_WAKE_BITS (PORT_WKOC_E|PORT_WKDISC_E|PORT_WKCONN_E)
36 static int ehci_hub_control(
45 /* After a power loss, ports that were owned by the companion must be
46 * reset so that the companion can still own them.
48 static void ehci_handover_companion_ports(struct ehci_hcd
*ehci
)
54 struct usb_hcd
*hcd
= ehci_to_hcd(ehci
);
56 if (!ehci
->owned_ports
)
59 /* Give the connections some time to appear */
62 port
= HCS_N_PORTS(ehci
->hcs_params
);
64 if (test_bit(port
, &ehci
->owned_ports
)) {
65 reg
= &ehci
->regs
->port_status
[port
];
66 status
= ehci_readl(ehci
, reg
) & ~PORT_RWC_BITS
;
68 /* Port already owned by companion? */
69 if (status
& PORT_OWNER
)
70 clear_bit(port
, &ehci
->owned_ports
);
71 else if (test_bit(port
, &ehci
->companion_ports
))
72 ehci_writel(ehci
, status
& ~PORT_PE
, reg
);
74 ehci_hub_control(hcd
, SetPortFeature
,
75 USB_PORT_FEAT_RESET
, port
+ 1,
80 if (!ehci
->owned_ports
)
82 msleep(90); /* Wait for resets to complete */
84 port
= HCS_N_PORTS(ehci
->hcs_params
);
86 if (test_bit(port
, &ehci
->owned_ports
)) {
87 ehci_hub_control(hcd
, GetPortStatus
,
89 (char *) &buf
, sizeof(buf
));
91 /* The companion should now own the port,
92 * but if something went wrong the port must not
95 reg
= &ehci
->regs
->port_status
[port
];
96 status
= ehci_readl(ehci
, reg
) & ~PORT_RWC_BITS
;
97 if (status
& PORT_OWNER
)
98 ehci_writel(ehci
, status
| PORT_CSC
, reg
);
100 ehci_dbg(ehci
, "failed handover port %d: %x\n",
102 ehci_writel(ehci
, status
& ~PORT_PE
, reg
);
107 ehci
->owned_ports
= 0;
110 static int ehci_port_change(struct ehci_hcd
*ehci
)
112 int i
= HCS_N_PORTS(ehci
->hcs_params
);
114 /* First check if the controller indicates a change event */
116 if (ehci_readl(ehci
, &ehci
->regs
->status
) & STS_PCD
)
120 * Not all controllers appear to update this while going from D3 to D0,
121 * so check the individual port status registers as well
125 if (ehci_readl(ehci
, &ehci
->regs
->port_status
[i
]) & PORT_CSC
)
131 static void ehci_adjust_port_wakeup_flags(struct ehci_hcd
*ehci
,
132 bool suspending
, bool do_wakeup
)
138 /* If remote wakeup is enabled for the root hub but disabled
139 * for the controller, we must adjust all the port wakeup flags
140 * when the controller is suspended or resumed. In all other
141 * cases they don't need to be changed.
143 if (!ehci_to_hcd(ehci
)->self
.root_hub
->do_remote_wakeup
|| do_wakeup
)
146 spin_lock_irqsave(&ehci
->lock
, flags
);
148 /* clear phy low-power mode before changing wakeup flags */
149 if (ehci
->has_hostpc
) {
150 port
= HCS_N_PORTS(ehci
->hcs_params
);
152 u32 __iomem
*hostpc_reg
= &ehci
->regs
->hostpc
[port
];
154 temp
= ehci_readl(ehci
, hostpc_reg
);
155 ehci_writel(ehci
, temp
& ~HOSTPC_PHCD
, hostpc_reg
);
157 spin_unlock_irqrestore(&ehci
->lock
, flags
);
159 spin_lock_irqsave(&ehci
->lock
, flags
);
162 port
= HCS_N_PORTS(ehci
->hcs_params
);
164 u32 __iomem
*reg
= &ehci
->regs
->port_status
[port
];
165 u32 t1
= ehci_readl(ehci
, reg
) & ~PORT_RWC_BITS
;
166 u32 t2
= t1
& ~PORT_WAKE_BITS
;
168 /* If we are suspending the controller, clear the flags.
169 * If we are resuming the controller, set the wakeup flags.
172 if (t1
& PORT_CONNECT
)
173 t2
|= PORT_WKOC_E
| PORT_WKDISC_E
;
175 t2
|= PORT_WKOC_E
| PORT_WKCONN_E
;
177 ehci_vdbg(ehci
, "port %d, %08x -> %08x\n",
179 ehci_writel(ehci
, t2
, reg
);
182 /* enter phy low-power mode again */
183 if (ehci
->has_hostpc
) {
184 port
= HCS_N_PORTS(ehci
->hcs_params
);
186 u32 __iomem
*hostpc_reg
= &ehci
->regs
->hostpc
[port
];
188 temp
= ehci_readl(ehci
, hostpc_reg
);
189 ehci_writel(ehci
, temp
| HOSTPC_PHCD
, hostpc_reg
);
193 /* Does the root hub have a port wakeup pending? */
194 if (!suspending
&& ehci_port_change(ehci
))
195 usb_hcd_resume_root_hub(ehci_to_hcd(ehci
));
197 spin_unlock_irqrestore(&ehci
->lock
, flags
);
200 static int ehci_bus_suspend (struct usb_hcd
*hcd
)
202 struct ehci_hcd
*ehci
= hcd_to_ehci (hcd
);
207 ehci_dbg(ehci
, "suspend root hub\n");
209 if (time_before (jiffies
, ehci
->next_statechange
))
211 del_timer_sync(&ehci
->watchdog
);
212 del_timer_sync(&ehci
->iaa_watchdog
);
214 spin_lock_irq (&ehci
->lock
);
216 /* Once the controller is stopped, port resumes that are already
217 * in progress won't complete. Hence if remote wakeup is enabled
218 * for the root hub and any ports are in the middle of a resume or
219 * remote wakeup, we must fail the suspend.
221 if (hcd
->self
.root_hub
->do_remote_wakeup
) {
222 if (ehci
->resuming_ports
) {
223 spin_unlock_irq(&ehci
->lock
);
224 ehci_dbg(ehci
, "suspend failed because a port is resuming\n");
229 /* stop schedules, clean any completed work */
230 if (ehci
->rh_state
== EHCI_RH_RUNNING
)
234 /* Unlike other USB host controller types, EHCI doesn't have
235 * any notion of "global" or bus-wide suspend. The driver has
236 * to manually suspend all the active unsuspended ports, and
237 * then manually resume them in the bus_resume() routine.
239 ehci
->bus_suspended
= 0;
240 ehci
->owned_ports
= 0;
242 port
= HCS_N_PORTS(ehci
->hcs_params
);
244 u32 __iomem
*reg
= &ehci
->regs
->port_status
[port
];
245 u32 t1
= ehci_readl(ehci
, reg
) & ~PORT_RWC_BITS
;
246 u32 t2
= t1
& ~PORT_WAKE_BITS
;
248 /* keep track of which ports we suspend */
250 set_bit(port
, &ehci
->owned_ports
);
251 else if ((t1
& PORT_PE
) && !(t1
& PORT_SUSPEND
)) {
253 set_bit(port
, &ehci
->bus_suspended
);
256 /* enable remote wakeup on all ports, if told to do so */
257 if (hcd
->self
.root_hub
->do_remote_wakeup
) {
258 /* only enable appropriate wake bits, otherwise the
259 * hardware can not go phy low power mode. If a race
260 * condition happens here(connection change during bits
261 * set), the port change detection will finally fix it.
263 if (t1
& PORT_CONNECT
)
264 t2
|= PORT_WKOC_E
| PORT_WKDISC_E
;
266 t2
|= PORT_WKOC_E
| PORT_WKCONN_E
;
270 ehci_vdbg (ehci
, "port %d, %08x -> %08x\n",
272 ehci_writel(ehci
, t2
, reg
);
277 if (changed
&& ehci
->has_hostpc
) {
278 spin_unlock_irq(&ehci
->lock
);
279 msleep(5); /* 5 ms for HCD to enter low-power mode */
280 spin_lock_irq(&ehci
->lock
);
282 port
= HCS_N_PORTS(ehci
->hcs_params
);
284 u32 __iomem
*hostpc_reg
= &ehci
->regs
->hostpc
[port
];
287 t3
= ehci_readl(ehci
, hostpc_reg
);
288 ehci_writel(ehci
, t3
| HOSTPC_PHCD
, hostpc_reg
);
289 t3
= ehci_readl(ehci
, hostpc_reg
);
290 ehci_dbg(ehci
, "Port %d phy low-power mode %s\n",
291 port
, (t3
& HOSTPC_PHCD
) ?
292 "succeeded" : "failed");
296 /* Apparently some devices need a >= 1-uframe delay here */
297 if (ehci
->bus_suspended
)
300 /* turn off now-idle HC */
302 ehci
->rh_state
= EHCI_RH_SUSPENDED
;
304 if (ehci
->async_unlink
)
305 end_unlink_async(ehci
);
307 /* allow remote wakeup */
309 if (!hcd
->self
.root_hub
->do_remote_wakeup
)
311 ehci_writel(ehci
, mask
, &ehci
->regs
->intr_enable
);
312 ehci_readl(ehci
, &ehci
->regs
->intr_enable
);
314 ehci
->next_statechange
= jiffies
+ msecs_to_jiffies(10);
315 spin_unlock_irq (&ehci
->lock
);
317 /* ehci_work() may have re-enabled the watchdog timer, which we do not
318 * want, and so we must delete any pending watchdog timer events.
320 del_timer_sync(&ehci
->watchdog
);
325 /* caller has locked the root hub, and should reset/reinit on error */
326 static int ehci_bus_resume (struct usb_hcd
*hcd
)
328 struct ehci_hcd
*ehci
= hcd_to_ehci (hcd
);
332 unsigned long resume_needed
= 0;
334 if (time_before (jiffies
, ehci
->next_statechange
))
336 spin_lock_irq (&ehci
->lock
);
337 if (!HCD_HW_ACCESSIBLE(hcd
)) {
338 spin_unlock_irq(&ehci
->lock
);
342 if (unlikely(ehci
->debug
)) {
343 if (!dbgp_reset_prep())
346 dbgp_external_startup();
349 /* Ideally and we've got a real resume here, and no port's power
350 * was lost. (For PCI, that means Vaux was maintained.) But we
351 * could instead be restoring a swsusp snapshot -- so that BIOS was
352 * the last user of the controller, not reset/pm hardware keeping
353 * state we gave to it.
355 power_okay
= ehci_readl(ehci
, &ehci
->regs
->intr_enable
);
356 ehci_dbg(ehci
, "resume root hub%s\n",
357 power_okay
? "" : " after power loss");
359 /* at least some APM implementations will try to deliver
360 * IRQs right away, so delay them until we're ready.
362 ehci_writel(ehci
, 0, &ehci
->regs
->intr_enable
);
364 /* re-init operational registers */
365 ehci_writel(ehci
, 0, &ehci
->regs
->segment
);
366 ehci_writel(ehci
, ehci
->periodic_dma
, &ehci
->regs
->frame_list
);
367 ehci_writel(ehci
, (u32
) ehci
->async
->qh_dma
, &ehci
->regs
->async_next
);
369 /* restore CMD_RUN, framelist size, and irq threshold */
370 ehci
->command
|= CMD_RUN
;
371 ehci_writel(ehci
, ehci
->command
, &ehci
->regs
->command
);
372 ehci
->rh_state
= EHCI_RH_RUNNING
;
374 /* Some controller/firmware combinations need a delay during which
375 * they set up the port statuses. See Bugzilla #8190. */
376 spin_unlock_irq(&ehci
->lock
);
378 spin_lock_irq(&ehci
->lock
);
380 /* clear phy low-power mode before resume */
381 if (ehci
->bus_suspended
&& ehci
->has_hostpc
) {
382 i
= HCS_N_PORTS(ehci
->hcs_params
);
384 if (test_bit(i
, &ehci
->bus_suspended
)) {
385 u32 __iomem
*hostpc_reg
=
386 &ehci
->regs
->hostpc
[i
];
388 temp
= ehci_readl(ehci
, hostpc_reg
);
389 ehci_writel(ehci
, temp
& ~HOSTPC_PHCD
,
393 spin_unlock_irq(&ehci
->lock
);
395 spin_lock_irq(&ehci
->lock
);
398 /* manually resume the ports we suspended during bus_suspend() */
399 i
= HCS_N_PORTS (ehci
->hcs_params
);
401 temp
= ehci_readl(ehci
, &ehci
->regs
->port_status
[i
]);
402 temp
&= ~(PORT_RWC_BITS
| PORT_WAKE_BITS
);
403 if (test_bit(i
, &ehci
->bus_suspended
) &&
404 (temp
& PORT_SUSPEND
)) {
406 set_bit(i
, &resume_needed
);
408 ehci_writel(ehci
, temp
, &ehci
->regs
->port_status
[i
]);
411 /* msleep for 20ms only if code is trying to resume port */
413 spin_unlock_irq(&ehci
->lock
);
415 spin_lock_irq(&ehci
->lock
);
418 i
= HCS_N_PORTS (ehci
->hcs_params
);
420 temp
= ehci_readl(ehci
, &ehci
->regs
->port_status
[i
]);
421 if (test_bit(i
, &resume_needed
)) {
422 temp
&= ~(PORT_RWC_BITS
| PORT_RESUME
);
423 ehci_writel(ehci
, temp
, &ehci
->regs
->port_status
[i
]);
424 ehci_vdbg (ehci
, "resumed port %d\n", i
+ 1);
428 ehci
->next_statechange
= jiffies
+ msecs_to_jiffies(5);
430 /* Now we can safely re-enable irqs */
431 ehci_writel(ehci
, INTR_MASK
, &ehci
->regs
->intr_enable
);
432 (void) ehci_readl(ehci
, &ehci
->regs
->intr_enable
);
434 spin_unlock_irq (&ehci
->lock
);
435 ehci_handover_companion_ports(ehci
);
441 #define ehci_bus_suspend NULL
442 #define ehci_bus_resume NULL
444 #endif /* CONFIG_PM */
446 /*-------------------------------------------------------------------------*/
449 * Sets the owner of a port
451 static void set_owner(struct ehci_hcd
*ehci
, int portnum
, int new_owner
)
453 u32 __iomem
*status_reg
;
457 status_reg
= &ehci
->regs
->port_status
[portnum
];
460 * The controller won't set the OWNER bit if the port is
461 * enabled, so this loop will sometimes require at least two
462 * iterations: one to disable the port and one to set OWNER.
464 for (try = 4; try > 0; --try) {
465 spin_lock_irq(&ehci
->lock
);
466 port_status
= ehci_readl(ehci
, status_reg
);
467 if ((port_status
& PORT_OWNER
) == new_owner
468 || (port_status
& (PORT_OWNER
| PORT_CONNECT
))
472 port_status
^= PORT_OWNER
;
473 port_status
&= ~(PORT_PE
| PORT_RWC_BITS
);
474 ehci_writel(ehci
, port_status
, status_reg
);
476 spin_unlock_irq(&ehci
->lock
);
482 /*-------------------------------------------------------------------------*/
484 static int check_reset_complete (
485 struct ehci_hcd
*ehci
,
487 u32 __iomem
*status_reg
,
490 if (!(port_status
& PORT_CONNECT
))
493 /* if reset finished and it's still not enabled -- handoff */
494 if (!(port_status
& PORT_PE
)) {
496 /* with integrated TT, there's nobody to hand it to! */
497 if (ehci_is_TDI(ehci
)) {
499 "Failed to enable port %d on root hub TT\n",
504 ehci_dbg (ehci
, "port %d full speed --> companion\n",
507 // what happens if HCS_N_CC(params) == 0 ?
508 port_status
|= PORT_OWNER
;
509 port_status
&= ~PORT_RWC_BITS
;
510 ehci_writel(ehci
, port_status
, status_reg
);
512 /* ensure 440EPX ohci controller state is operational */
513 if (ehci
->has_amcc_usb23
)
514 set_ohci_hcfs(ehci
, 1);
516 ehci_dbg(ehci
, "port %d reset complete, port enabled\n",
518 /* ensure 440EPx ohci controller state is suspended */
519 if (ehci
->has_amcc_usb23
)
520 set_ohci_hcfs(ehci
, 0);
526 /*-------------------------------------------------------------------------*/
529 /* build "status change" packet (one or two bytes) from HC registers */
532 ehci_hub_status_data (struct usb_hcd
*hcd
, char *buf
)
534 struct ehci_hcd
*ehci
= hcd_to_ehci (hcd
);
537 int ports
, i
, retval
= 1;
541 /* init status to no-changes */
543 ports
= HCS_N_PORTS (ehci
->hcs_params
);
549 /* Inform the core about resumes-in-progress by returning
550 * a non-zero value even if there are no status changes.
552 status
= ehci
->resuming_ports
;
554 /* Some boards (mostly VIA?) report bogus overcurrent indications,
555 * causing massive log spam unless we completely ignore them. It
556 * may be relevant that VIA VT8235 controllers, where PORT_POWER is
557 * always set, seem to clear PORT_OCC and PORT_CSC when writing to
558 * PORT_POWER; that's surprising, but maybe within-spec.
561 mask
= PORT_CSC
| PORT_PEC
| PORT_OCC
;
563 mask
= PORT_CSC
| PORT_PEC
;
564 // PORT_RESUME from hardware ~= PORT_STAT_C_SUSPEND
566 /* no hub change reports (bit 0) for now (power, ...) */
568 /* port N changes (bit N)? */
569 spin_lock_irqsave (&ehci
->lock
, flags
);
571 /* get per-port change detect bits */
573 ppcd
= ehci_readl(ehci
, &ehci
->regs
->status
) >> 16;
575 for (i
= 0; i
< ports
; i
++) {
576 /* leverage per-port change bits feature */
577 if (ehci
->has_ppcd
&& !(ppcd
& (1 << i
)))
579 temp
= ehci_readl(ehci
, &ehci
->regs
->port_status
[i
]);
582 * Return status information even for ports with OWNER set.
583 * Otherwise khubd wouldn't see the disconnect event when a
584 * high-speed device is switched over to the companion
585 * controller by the user.
588 if ((temp
& mask
) != 0 || test_bit(i
, &ehci
->port_c_suspend
)
589 || (ehci
->reset_done
[i
] && time_after_eq(
590 jiffies
, ehci
->reset_done
[i
]))) {
592 buf
[0] |= 1 << (i
+ 1);
594 buf
[1] |= 1 << (i
- 7);
598 /* FIXME autosuspend idle root hubs */
599 spin_unlock_irqrestore (&ehci
->lock
, flags
);
600 return status
? retval
: 0;
603 /*-------------------------------------------------------------------------*/
606 ehci_hub_descriptor (
607 struct ehci_hcd
*ehci
,
608 struct usb_hub_descriptor
*desc
610 int ports
= HCS_N_PORTS (ehci
->hcs_params
);
613 desc
->bDescriptorType
= 0x29;
614 desc
->bPwrOn2PwrGood
= 10; /* ehci 1.0, 2.3.9 says 20ms max */
615 desc
->bHubContrCurrent
= 0;
617 desc
->bNbrPorts
= ports
;
618 temp
= 1 + (ports
/ 8);
619 desc
->bDescLength
= 7 + 2 * temp
;
621 /* two bitmaps: ports removable, and usb 1.0 legacy PortPwrCtrlMask */
622 memset(&desc
->u
.hs
.DeviceRemovable
[0], 0, temp
);
623 memset(&desc
->u
.hs
.DeviceRemovable
[temp
], 0xff, temp
);
625 temp
= 0x0008; /* per-port overcurrent reporting */
626 if (HCS_PPC (ehci
->hcs_params
))
627 temp
|= 0x0001; /* per-port power control */
629 temp
|= 0x0002; /* no power switching */
631 // re-enable when we support USB_PORT_FEAT_INDICATOR below.
632 if (HCS_INDICATOR (ehci
->hcs_params
))
633 temp
|= 0x0080; /* per-port indicators (LEDs) */
635 desc
->wHubCharacteristics
= cpu_to_le16(temp
);
638 /*-------------------------------------------------------------------------*/
640 static int ehci_hub_control (
648 struct ehci_hcd
*ehci
= hcd_to_ehci (hcd
);
649 int ports
= HCS_N_PORTS (ehci
->hcs_params
);
650 u32 __iomem
*status_reg
= &ehci
->regs
->port_status
[
651 (wIndex
& 0xff) - 1];
652 u32 __iomem
*hostpc_reg
= &ehci
->regs
->hostpc
[(wIndex
& 0xff) - 1];
653 u32 temp
, temp1
, status
;
659 * FIXME: support SetPortFeatures USB_PORT_FEAT_INDICATOR.
660 * HCS_INDICATOR may say we can change LEDs to off/amber/green.
661 * (track current state ourselves) ... blink for diagnostics,
662 * power, "this is the one", etc. EHCI spec supports this.
665 spin_lock_irqsave (&ehci
->lock
, flags
);
667 case ClearHubFeature
:
669 case C_HUB_LOCAL_POWER
:
670 case C_HUB_OVER_CURRENT
:
671 /* no hub-wide feature/status flags */
677 case ClearPortFeature
:
678 if (!wIndex
|| wIndex
> ports
)
681 temp
= ehci_readl(ehci
, status_reg
);
682 temp
&= ~PORT_RWC_BITS
;
685 * Even if OWNER is set, so the port is owned by the
686 * companion controller, khubd needs to be able to clear
687 * the port-change status bits (especially
688 * USB_PORT_STAT_C_CONNECTION).
692 case USB_PORT_FEAT_ENABLE
:
693 ehci_writel(ehci
, temp
& ~PORT_PE
, status_reg
);
695 case USB_PORT_FEAT_C_ENABLE
:
696 ehci_writel(ehci
, temp
| PORT_PEC
, status_reg
);
698 case USB_PORT_FEAT_SUSPEND
:
699 if (temp
& PORT_RESET
)
701 if (ehci
->no_selective_suspend
)
703 #ifdef CONFIG_USB_OTG
704 if ((hcd
->self
.otg_port
== (wIndex
+ 1))
705 && hcd
->self
.b_hnp_enable
) {
706 otg_start_hnp(hcd
->phy
->otg
);
710 if (!(temp
& PORT_SUSPEND
))
712 if ((temp
& PORT_PE
) == 0)
715 /* clear phy low-power mode before resume */
716 if (ehci
->has_hostpc
) {
717 temp1
= ehci_readl(ehci
, hostpc_reg
);
718 ehci_writel(ehci
, temp1
& ~HOSTPC_PHCD
,
720 spin_unlock_irqrestore(&ehci
->lock
, flags
);
721 msleep(5);/* wait to leave low-power mode */
722 spin_lock_irqsave(&ehci
->lock
, flags
);
724 /* resume signaling for 20 msec */
725 temp
&= ~PORT_WAKE_BITS
;
726 ehci_writel(ehci
, temp
| PORT_RESUME
, status_reg
);
727 ehci
->reset_done
[wIndex
] = jiffies
728 + msecs_to_jiffies(20);
730 case USB_PORT_FEAT_C_SUSPEND
:
731 clear_bit(wIndex
, &ehci
->port_c_suspend
);
733 case USB_PORT_FEAT_POWER
:
734 if (HCS_PPC (ehci
->hcs_params
))
735 ehci_writel(ehci
, temp
& ~PORT_POWER
,
738 case USB_PORT_FEAT_C_CONNECTION
:
740 /* clear PORTSC bits on disconnect */
742 temp
&= ~PORT_DEV_ADDR
;
744 ehci_writel(ehci
, temp
| PORT_CSC
, status_reg
);
746 case USB_PORT_FEAT_C_OVER_CURRENT
:
747 ehci_writel(ehci
, temp
| PORT_OCC
, status_reg
);
749 case USB_PORT_FEAT_C_RESET
:
750 /* GetPortStatus clears reset */
755 ehci_readl(ehci
, &ehci
->regs
->command
); /* unblock posted write */
757 case GetHubDescriptor
:
758 ehci_hub_descriptor (ehci
, (struct usb_hub_descriptor
*)
762 /* no hub-wide feature/status flags */
764 //cpu_to_le32s ((u32 *) buf);
767 if (!wIndex
|| wIndex
> ports
)
771 temp
= ehci_readl(ehci
, status_reg
);
775 status
|= USB_PORT_STAT_C_CONNECTION
<< 16;
777 status
|= USB_PORT_STAT_C_ENABLE
<< 16;
779 if ((temp
& PORT_OCC
) && !ignore_oc
){
780 status
|= USB_PORT_STAT_C_OVERCURRENT
<< 16;
783 * Hubs should disable port power on over-current.
784 * However, not all EHCI implementations do this
785 * automatically, even if they _do_ support per-port
786 * power switching; they're allowed to just limit the
787 * current. khubd will turn the power back on.
789 if ((temp
& PORT_OC
) && HCS_PPC(ehci
->hcs_params
)) {
791 temp
& ~(PORT_RWC_BITS
| PORT_POWER
),
793 temp
= ehci_readl(ehci
, status_reg
);
797 /* whoever resumes must GetPortStatus to complete it!! */
798 if (temp
& PORT_RESUME
) {
800 /* Remote Wakeup received? */
801 if (!ehci
->reset_done
[wIndex
]) {
802 /* resume signaling for 20 msec */
803 ehci
->reset_done
[wIndex
] = jiffies
804 + msecs_to_jiffies(20);
805 /* check the port again */
806 mod_timer(&ehci_to_hcd(ehci
)->rh_timer
,
807 ehci
->reset_done
[wIndex
]);
810 /* resume completed? */
811 else if (time_after_eq(jiffies
,
812 ehci
->reset_done
[wIndex
])) {
813 clear_bit(wIndex
, &ehci
->suspended_ports
);
814 set_bit(wIndex
, &ehci
->port_c_suspend
);
815 ehci
->reset_done
[wIndex
] = 0;
817 /* stop resume signaling */
818 temp
= ehci_readl(ehci
, status_reg
);
820 temp
& ~(PORT_RWC_BITS
| PORT_RESUME
),
822 clear_bit(wIndex
, &ehci
->resuming_ports
);
823 retval
= handshake(ehci
, status_reg
,
824 PORT_RESUME
, 0, 2000 /* 2msec */);
827 "port %d resume error %d\n",
831 temp
&= ~(PORT_SUSPEND
|PORT_RESUME
|(3<<10));
835 /* whoever resets must GetPortStatus to complete it!! */
836 if ((temp
& PORT_RESET
)
837 && time_after_eq(jiffies
,
838 ehci
->reset_done
[wIndex
])) {
839 status
|= USB_PORT_STAT_C_RESET
<< 16;
840 ehci
->reset_done
[wIndex
] = 0;
841 clear_bit(wIndex
, &ehci
->resuming_ports
);
843 /* force reset to complete */
844 ehci_writel(ehci
, temp
& ~(PORT_RWC_BITS
| PORT_RESET
),
846 /* REVISIT: some hardware needs 550+ usec to clear
847 * this bit; seems too long to spin routinely...
849 retval
= handshake(ehci
, status_reg
,
850 PORT_RESET
, 0, 1000);
852 ehci_err (ehci
, "port %d reset error %d\n",
857 /* see what we found out */
858 temp
= check_reset_complete (ehci
, wIndex
, status_reg
,
859 ehci_readl(ehci
, status_reg
));
862 if (!(temp
& (PORT_RESUME
|PORT_RESET
))) {
863 ehci
->reset_done
[wIndex
] = 0;
864 clear_bit(wIndex
, &ehci
->resuming_ports
);
867 /* transfer dedicated ports to the companion hc */
868 if ((temp
& PORT_CONNECT
) &&
869 test_bit(wIndex
, &ehci
->companion_ports
)) {
870 temp
&= ~PORT_RWC_BITS
;
872 ehci_writel(ehci
, temp
, status_reg
);
873 ehci_dbg(ehci
, "port %d --> companion\n", wIndex
+ 1);
874 temp
= ehci_readl(ehci
, status_reg
);
878 * Even if OWNER is set, there's no harm letting khubd
879 * see the wPortStatus values (they should all be 0 except
880 * for PORT_POWER anyway).
883 if (temp
& PORT_CONNECT
) {
884 status
|= USB_PORT_STAT_CONNECTION
;
885 // status may be from integrated TT
886 if (ehci
->has_hostpc
) {
887 temp1
= ehci_readl(ehci
, hostpc_reg
);
888 status
|= ehci_port_speed(ehci
, temp1
);
890 status
|= ehci_port_speed(ehci
, temp
);
893 status
|= USB_PORT_STAT_ENABLE
;
895 /* maybe the port was unsuspended without our knowledge */
896 if (temp
& (PORT_SUSPEND
|PORT_RESUME
)) {
897 status
|= USB_PORT_STAT_SUSPEND
;
898 } else if (test_bit(wIndex
, &ehci
->suspended_ports
)) {
899 clear_bit(wIndex
, &ehci
->suspended_ports
);
900 clear_bit(wIndex
, &ehci
->resuming_ports
);
901 ehci
->reset_done
[wIndex
] = 0;
903 set_bit(wIndex
, &ehci
->port_c_suspend
);
907 status
|= USB_PORT_STAT_OVERCURRENT
;
908 if (temp
& PORT_RESET
)
909 status
|= USB_PORT_STAT_RESET
;
910 if (temp
& PORT_POWER
)
911 status
|= USB_PORT_STAT_POWER
;
912 if (test_bit(wIndex
, &ehci
->port_c_suspend
))
913 status
|= USB_PORT_STAT_C_SUSPEND
<< 16;
915 #ifndef VERBOSE_DEBUG
916 if (status
& ~0xffff) /* only if wPortChange is interesting */
918 dbg_port (ehci
, "GetStatus", wIndex
+ 1, temp
);
919 put_unaligned_le32(status
, buf
);
923 case C_HUB_LOCAL_POWER
:
924 case C_HUB_OVER_CURRENT
:
925 /* no hub-wide feature/status flags */
932 selector
= wIndex
>> 8;
934 if (unlikely(ehci
->debug
)) {
935 /* If the debug port is active any port
936 * feature requests should get denied */
937 if (wIndex
== HCS_DEBUG_PORT(ehci
->hcs_params
) &&
938 (readl(&ehci
->debug
->control
) & DBGP_ENABLED
)) {
943 if (!wIndex
|| wIndex
> ports
)
946 temp
= ehci_readl(ehci
, status_reg
);
947 if (temp
& PORT_OWNER
)
950 temp
&= ~PORT_RWC_BITS
;
952 case USB_PORT_FEAT_SUSPEND
:
953 if (ehci
->no_selective_suspend
)
955 if ((temp
& PORT_PE
) == 0
956 || (temp
& PORT_RESET
) != 0)
959 /* After above check the port must be connected.
960 * Set appropriate bit thus could put phy into low power
961 * mode if we have hostpc feature
963 temp
&= ~PORT_WKCONN_E
;
964 temp
|= PORT_WKDISC_E
| PORT_WKOC_E
;
965 ehci_writel(ehci
, temp
| PORT_SUSPEND
, status_reg
);
966 if (ehci
->has_hostpc
) {
967 spin_unlock_irqrestore(&ehci
->lock
, flags
);
968 msleep(5);/* 5ms for HCD enter low pwr mode */
969 spin_lock_irqsave(&ehci
->lock
, flags
);
970 temp1
= ehci_readl(ehci
, hostpc_reg
);
971 ehci_writel(ehci
, temp1
| HOSTPC_PHCD
,
973 temp1
= ehci_readl(ehci
, hostpc_reg
);
974 ehci_dbg(ehci
, "Port%d phy low pwr mode %s\n",
975 wIndex
, (temp1
& HOSTPC_PHCD
) ?
976 "succeeded" : "failed");
978 set_bit(wIndex
, &ehci
->suspended_ports
);
980 case USB_PORT_FEAT_POWER
:
981 if (HCS_PPC (ehci
->hcs_params
))
982 ehci_writel(ehci
, temp
| PORT_POWER
,
985 case USB_PORT_FEAT_RESET
:
986 if (temp
& PORT_RESUME
)
988 /* line status bits may report this as low speed,
989 * which can be fine if this root hub has a
990 * transaction translator built in.
992 if ((temp
& (PORT_PE
|PORT_CONNECT
)) == PORT_CONNECT
993 && !ehci_is_TDI(ehci
)
994 && PORT_USB11 (temp
)) {
996 "port %d low speed --> companion\n",
1000 ehci_vdbg (ehci
, "port %d reset\n", wIndex
+ 1);
1005 * caller must wait, then call GetPortStatus
1006 * usb 2.0 spec says 50 ms resets on root
1008 ehci
->reset_done
[wIndex
] = jiffies
1009 + msecs_to_jiffies (50);
1011 ehci_writel(ehci
, temp
, status_reg
);
1014 /* For downstream facing ports (these): one hub port is put
1015 * into test mode according to USB2 11.24.2.13, then the hub
1016 * must be reset (which for root hub now means rmmod+modprobe,
1017 * or else system reboot). See EHCI 2.3.9 and 4.14 for info
1018 * about the EHCI-specific stuff.
1020 case USB_PORT_FEAT_TEST
:
1021 if (!selector
|| selector
> 5)
1025 /* Put all enabled ports into suspend */
1028 &ehci
->regs
->port_status
[ports
];
1030 temp
= ehci_readl(ehci
, sreg
) & ~PORT_RWC_BITS
;
1032 ehci_writel(ehci
, temp
| PORT_SUSPEND
,
1036 temp
= ehci_readl(ehci
, status_reg
);
1037 temp
|= selector
<< 16;
1038 ehci_writel(ehci
, temp
, status_reg
);
1044 ehci_readl(ehci
, &ehci
->regs
->command
); /* unblock posted writes */
1049 /* "stall" on error */
1053 spin_unlock_irqrestore (&ehci
->lock
, flags
);
1057 static void __maybe_unused
ehci_relinquish_port(struct usb_hcd
*hcd
,
1060 struct ehci_hcd
*ehci
= hcd_to_ehci(hcd
);
1062 if (ehci_is_TDI(ehci
))
1064 set_owner(ehci
, --portnum
, PORT_OWNER
);
1067 static int __maybe_unused
ehci_port_handed_over(struct usb_hcd
*hcd
,
1070 struct ehci_hcd
*ehci
= hcd_to_ehci(hcd
);
1073 if (ehci_is_TDI(ehci
))
1075 reg
= &ehci
->regs
->port_status
[portnum
- 1];
1076 return ehci_readl(ehci
, reg
) & PORT_OWNER
;