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 __maybe_unused
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 __maybe_unused
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
;
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);
427 (void) ehci_readl(ehci
, &ehci
->regs
->command
);
429 /* maybe re-activate the schedule(s) */
431 if (ehci
->async
->qh_next
.qh
)
433 if (ehci
->periodic_sched
)
436 ehci
->command
|= temp
;
437 ehci_writel(ehci
, ehci
->command
, &ehci
->regs
->command
);
440 ehci
->next_statechange
= jiffies
+ msecs_to_jiffies(5);
442 /* Now we can safely re-enable irqs */
443 ehci_writel(ehci
, INTR_MASK
, &ehci
->regs
->intr_enable
);
445 spin_unlock_irq (&ehci
->lock
);
446 ehci_handover_companion_ports(ehci
);
452 #define ehci_bus_suspend NULL
453 #define ehci_bus_resume NULL
455 #endif /* CONFIG_PM */
457 /*-------------------------------------------------------------------------*/
460 * Sets the owner of a port
462 static void set_owner(struct ehci_hcd
*ehci
, int portnum
, int new_owner
)
464 u32 __iomem
*status_reg
;
468 status_reg
= &ehci
->regs
->port_status
[portnum
];
471 * The controller won't set the OWNER bit if the port is
472 * enabled, so this loop will sometimes require at least two
473 * iterations: one to disable the port and one to set OWNER.
475 for (try = 4; try > 0; --try) {
476 spin_lock_irq(&ehci
->lock
);
477 port_status
= ehci_readl(ehci
, status_reg
);
478 if ((port_status
& PORT_OWNER
) == new_owner
479 || (port_status
& (PORT_OWNER
| PORT_CONNECT
))
483 port_status
^= PORT_OWNER
;
484 port_status
&= ~(PORT_PE
| PORT_RWC_BITS
);
485 ehci_writel(ehci
, port_status
, status_reg
);
487 spin_unlock_irq(&ehci
->lock
);
493 /*-------------------------------------------------------------------------*/
495 static int check_reset_complete (
496 struct ehci_hcd
*ehci
,
498 u32 __iomem
*status_reg
,
501 if (!(port_status
& PORT_CONNECT
))
504 /* if reset finished and it's still not enabled -- handoff */
505 if (!(port_status
& PORT_PE
)) {
507 /* with integrated TT, there's nobody to hand it to! */
508 if (ehci_is_TDI(ehci
)) {
510 "Failed to enable port %d on root hub TT\n",
515 ehci_dbg (ehci
, "port %d full speed --> companion\n",
518 // what happens if HCS_N_CC(params) == 0 ?
519 port_status
|= PORT_OWNER
;
520 port_status
&= ~PORT_RWC_BITS
;
521 ehci_writel(ehci
, port_status
, status_reg
);
523 /* ensure 440EPX ohci controller state is operational */
524 if (ehci
->has_amcc_usb23
)
525 set_ohci_hcfs(ehci
, 1);
527 ehci_dbg(ehci
, "port %d reset complete, port enabled\n",
529 /* ensure 440EPx ohci controller state is suspended */
530 if (ehci
->has_amcc_usb23
)
531 set_ohci_hcfs(ehci
, 0);
537 /*-------------------------------------------------------------------------*/
540 /* build "status change" packet (one or two bytes) from HC registers */
543 ehci_hub_status_data (struct usb_hcd
*hcd
, char *buf
)
545 struct ehci_hcd
*ehci
= hcd_to_ehci (hcd
);
548 int ports
, i
, retval
= 1;
552 /* init status to no-changes */
554 ports
= HCS_N_PORTS (ehci
->hcs_params
);
560 /* Inform the core about resumes-in-progress by returning
561 * a non-zero value even if there are no status changes.
563 status
= ehci
->resuming_ports
;
565 /* Some boards (mostly VIA?) report bogus overcurrent indications,
566 * causing massive log spam unless we completely ignore them. It
567 * may be relevant that VIA VT8235 controllers, where PORT_POWER is
568 * always set, seem to clear PORT_OCC and PORT_CSC when writing to
569 * PORT_POWER; that's surprising, but maybe within-spec.
572 mask
= PORT_CSC
| PORT_PEC
| PORT_OCC
;
574 mask
= PORT_CSC
| PORT_PEC
;
575 // PORT_RESUME from hardware ~= PORT_STAT_C_SUSPEND
577 /* no hub change reports (bit 0) for now (power, ...) */
579 /* port N changes (bit N)? */
580 spin_lock_irqsave (&ehci
->lock
, flags
);
582 /* get per-port change detect bits */
584 ppcd
= ehci_readl(ehci
, &ehci
->regs
->status
) >> 16;
586 for (i
= 0; i
< ports
; i
++) {
587 /* leverage per-port change bits feature */
588 if (ehci
->has_ppcd
&& !(ppcd
& (1 << i
)))
590 temp
= ehci_readl(ehci
, &ehci
->regs
->port_status
[i
]);
593 * Return status information even for ports with OWNER set.
594 * Otherwise khubd wouldn't see the disconnect event when a
595 * high-speed device is switched over to the companion
596 * controller by the user.
599 if ((temp
& mask
) != 0 || test_bit(i
, &ehci
->port_c_suspend
)
600 || (ehci
->reset_done
[i
] && time_after_eq(
601 jiffies
, ehci
->reset_done
[i
]))) {
603 buf
[0] |= 1 << (i
+ 1);
605 buf
[1] |= 1 << (i
- 7);
609 /* FIXME autosuspend idle root hubs */
610 spin_unlock_irqrestore (&ehci
->lock
, flags
);
611 return status
? retval
: 0;
614 /*-------------------------------------------------------------------------*/
617 ehci_hub_descriptor (
618 struct ehci_hcd
*ehci
,
619 struct usb_hub_descriptor
*desc
621 int ports
= HCS_N_PORTS (ehci
->hcs_params
);
624 desc
->bDescriptorType
= 0x29;
625 desc
->bPwrOn2PwrGood
= 10; /* ehci 1.0, 2.3.9 says 20ms max */
626 desc
->bHubContrCurrent
= 0;
628 desc
->bNbrPorts
= ports
;
629 temp
= 1 + (ports
/ 8);
630 desc
->bDescLength
= 7 + 2 * temp
;
632 /* two bitmaps: ports removable, and usb 1.0 legacy PortPwrCtrlMask */
633 memset(&desc
->u
.hs
.DeviceRemovable
[0], 0, temp
);
634 memset(&desc
->u
.hs
.DeviceRemovable
[temp
], 0xff, temp
);
636 temp
= 0x0008; /* per-port overcurrent reporting */
637 if (HCS_PPC (ehci
->hcs_params
))
638 temp
|= 0x0001; /* per-port power control */
640 temp
|= 0x0002; /* no power switching */
642 // re-enable when we support USB_PORT_FEAT_INDICATOR below.
643 if (HCS_INDICATOR (ehci
->hcs_params
))
644 temp
|= 0x0080; /* per-port indicators (LEDs) */
646 desc
->wHubCharacteristics
= cpu_to_le16(temp
);
649 /*-------------------------------------------------------------------------*/
651 static int ehci_hub_control (
659 struct ehci_hcd
*ehci
= hcd_to_ehci (hcd
);
660 int ports
= HCS_N_PORTS (ehci
->hcs_params
);
661 u32 __iomem
*status_reg
= &ehci
->regs
->port_status
[
662 (wIndex
& 0xff) - 1];
663 u32 __iomem
*hostpc_reg
= &ehci
->regs
->hostpc
[(wIndex
& 0xff) - 1];
664 u32 temp
, temp1
, status
;
670 * FIXME: support SetPortFeatures USB_PORT_FEAT_INDICATOR.
671 * HCS_INDICATOR may say we can change LEDs to off/amber/green.
672 * (track current state ourselves) ... blink for diagnostics,
673 * power, "this is the one", etc. EHCI spec supports this.
676 spin_lock_irqsave (&ehci
->lock
, flags
);
678 case ClearHubFeature
:
680 case C_HUB_LOCAL_POWER
:
681 case C_HUB_OVER_CURRENT
:
682 /* no hub-wide feature/status flags */
688 case ClearPortFeature
:
689 if (!wIndex
|| wIndex
> ports
)
692 temp
= ehci_readl(ehci
, status_reg
);
693 temp
&= ~PORT_RWC_BITS
;
696 * Even if OWNER is set, so the port is owned by the
697 * companion controller, khubd needs to be able to clear
698 * the port-change status bits (especially
699 * USB_PORT_STAT_C_CONNECTION).
703 case USB_PORT_FEAT_ENABLE
:
704 ehci_writel(ehci
, temp
& ~PORT_PE
, status_reg
);
706 case USB_PORT_FEAT_C_ENABLE
:
707 ehci_writel(ehci
, temp
| PORT_PEC
, status_reg
);
709 case USB_PORT_FEAT_SUSPEND
:
710 if (temp
& PORT_RESET
)
712 if (ehci
->no_selective_suspend
)
714 #ifdef CONFIG_USB_OTG
715 if ((hcd
->self
.otg_port
== (wIndex
+ 1))
716 && hcd
->self
.b_hnp_enable
) {
717 otg_start_hnp(hcd
->phy
->otg
);
721 if (!(temp
& PORT_SUSPEND
))
723 if ((temp
& PORT_PE
) == 0)
726 /* clear phy low-power mode before resume */
727 if (ehci
->has_hostpc
) {
728 temp1
= ehci_readl(ehci
, hostpc_reg
);
729 ehci_writel(ehci
, temp1
& ~HOSTPC_PHCD
,
731 spin_unlock_irqrestore(&ehci
->lock
, flags
);
732 msleep(5);/* wait to leave low-power mode */
733 spin_lock_irqsave(&ehci
->lock
, flags
);
735 /* resume signaling for 20 msec */
736 temp
&= ~PORT_WAKE_BITS
;
737 ehci_writel(ehci
, temp
| PORT_RESUME
, status_reg
);
738 ehci
->reset_done
[wIndex
] = jiffies
739 + msecs_to_jiffies(20);
741 case USB_PORT_FEAT_C_SUSPEND
:
742 clear_bit(wIndex
, &ehci
->port_c_suspend
);
744 case USB_PORT_FEAT_POWER
:
745 if (HCS_PPC (ehci
->hcs_params
))
746 ehci_writel(ehci
, temp
& ~PORT_POWER
,
749 case USB_PORT_FEAT_C_CONNECTION
:
751 /* clear PORTSC bits on disconnect */
753 temp
&= ~PORT_DEV_ADDR
;
755 ehci_writel(ehci
, temp
| PORT_CSC
, status_reg
);
757 case USB_PORT_FEAT_C_OVER_CURRENT
:
758 ehci_writel(ehci
, temp
| PORT_OCC
, status_reg
);
760 case USB_PORT_FEAT_C_RESET
:
761 /* GetPortStatus clears reset */
766 ehci_readl(ehci
, &ehci
->regs
->command
); /* unblock posted write */
768 case GetHubDescriptor
:
769 ehci_hub_descriptor (ehci
, (struct usb_hub_descriptor
*)
773 /* no hub-wide feature/status flags */
775 //cpu_to_le32s ((u32 *) buf);
778 if (!wIndex
|| wIndex
> ports
)
782 temp
= ehci_readl(ehci
, status_reg
);
786 status
|= USB_PORT_STAT_C_CONNECTION
<< 16;
788 status
|= USB_PORT_STAT_C_ENABLE
<< 16;
790 if ((temp
& PORT_OCC
) && !ignore_oc
){
791 status
|= USB_PORT_STAT_C_OVERCURRENT
<< 16;
794 * Hubs should disable port power on over-current.
795 * However, not all EHCI implementations do this
796 * automatically, even if they _do_ support per-port
797 * power switching; they're allowed to just limit the
798 * current. khubd will turn the power back on.
800 if ((temp
& PORT_OC
) && HCS_PPC(ehci
->hcs_params
)) {
802 temp
& ~(PORT_RWC_BITS
| PORT_POWER
),
804 temp
= ehci_readl(ehci
, status_reg
);
808 /* whoever resumes must GetPortStatus to complete it!! */
809 if (temp
& PORT_RESUME
) {
811 /* Remote Wakeup received? */
812 if (!ehci
->reset_done
[wIndex
]) {
813 /* resume signaling for 20 msec */
814 ehci
->reset_done
[wIndex
] = jiffies
815 + msecs_to_jiffies(20);
816 /* check the port again */
817 mod_timer(&ehci_to_hcd(ehci
)->rh_timer
,
818 ehci
->reset_done
[wIndex
]);
821 /* resume completed? */
822 else if (time_after_eq(jiffies
,
823 ehci
->reset_done
[wIndex
])) {
824 clear_bit(wIndex
, &ehci
->suspended_ports
);
825 set_bit(wIndex
, &ehci
->port_c_suspend
);
826 ehci
->reset_done
[wIndex
] = 0;
828 /* stop resume signaling */
829 temp
= ehci_readl(ehci
, status_reg
);
831 temp
& ~(PORT_RWC_BITS
| PORT_RESUME
),
833 clear_bit(wIndex
, &ehci
->resuming_ports
);
834 retval
= handshake(ehci
, status_reg
,
835 PORT_RESUME
, 0, 2000 /* 2msec */);
838 "port %d resume error %d\n",
842 temp
&= ~(PORT_SUSPEND
|PORT_RESUME
|(3<<10));
846 /* whoever resets must GetPortStatus to complete it!! */
847 if ((temp
& PORT_RESET
)
848 && time_after_eq(jiffies
,
849 ehci
->reset_done
[wIndex
])) {
850 status
|= USB_PORT_STAT_C_RESET
<< 16;
851 ehci
->reset_done
[wIndex
] = 0;
852 clear_bit(wIndex
, &ehci
->resuming_ports
);
854 /* force reset to complete */
855 ehci_writel(ehci
, temp
& ~(PORT_RWC_BITS
| PORT_RESET
),
857 /* REVISIT: some hardware needs 550+ usec to clear
858 * this bit; seems too long to spin routinely...
860 retval
= handshake(ehci
, status_reg
,
861 PORT_RESET
, 0, 1000);
863 ehci_err (ehci
, "port %d reset error %d\n",
868 /* see what we found out */
869 temp
= check_reset_complete (ehci
, wIndex
, status_reg
,
870 ehci_readl(ehci
, status_reg
));
873 if (!(temp
& (PORT_RESUME
|PORT_RESET
))) {
874 ehci
->reset_done
[wIndex
] = 0;
875 clear_bit(wIndex
, &ehci
->resuming_ports
);
878 /* transfer dedicated ports to the companion hc */
879 if ((temp
& PORT_CONNECT
) &&
880 test_bit(wIndex
, &ehci
->companion_ports
)) {
881 temp
&= ~PORT_RWC_BITS
;
883 ehci_writel(ehci
, temp
, status_reg
);
884 ehci_dbg(ehci
, "port %d --> companion\n", wIndex
+ 1);
885 temp
= ehci_readl(ehci
, status_reg
);
889 * Even if OWNER is set, there's no harm letting khubd
890 * see the wPortStatus values (they should all be 0 except
891 * for PORT_POWER anyway).
894 if (temp
& PORT_CONNECT
) {
895 status
|= USB_PORT_STAT_CONNECTION
;
896 // status may be from integrated TT
897 if (ehci
->has_hostpc
) {
898 temp1
= ehci_readl(ehci
, hostpc_reg
);
899 status
|= ehci_port_speed(ehci
, temp1
);
901 status
|= ehci_port_speed(ehci
, temp
);
904 status
|= USB_PORT_STAT_ENABLE
;
906 /* maybe the port was unsuspended without our knowledge */
907 if (temp
& (PORT_SUSPEND
|PORT_RESUME
)) {
908 status
|= USB_PORT_STAT_SUSPEND
;
909 } else if (test_bit(wIndex
, &ehci
->suspended_ports
)) {
910 clear_bit(wIndex
, &ehci
->suspended_ports
);
911 clear_bit(wIndex
, &ehci
->resuming_ports
);
912 ehci
->reset_done
[wIndex
] = 0;
914 set_bit(wIndex
, &ehci
->port_c_suspend
);
918 status
|= USB_PORT_STAT_OVERCURRENT
;
919 if (temp
& PORT_RESET
)
920 status
|= USB_PORT_STAT_RESET
;
921 if (temp
& PORT_POWER
)
922 status
|= USB_PORT_STAT_POWER
;
923 if (test_bit(wIndex
, &ehci
->port_c_suspend
))
924 status
|= USB_PORT_STAT_C_SUSPEND
<< 16;
926 #ifndef VERBOSE_DEBUG
927 if (status
& ~0xffff) /* only if wPortChange is interesting */
929 dbg_port (ehci
, "GetStatus", wIndex
+ 1, temp
);
930 put_unaligned_le32(status
, buf
);
934 case C_HUB_LOCAL_POWER
:
935 case C_HUB_OVER_CURRENT
:
936 /* no hub-wide feature/status flags */
943 selector
= wIndex
>> 8;
945 if (unlikely(ehci
->debug
)) {
946 /* If the debug port is active any port
947 * feature requests should get denied */
948 if (wIndex
== HCS_DEBUG_PORT(ehci
->hcs_params
) &&
949 (readl(&ehci
->debug
->control
) & DBGP_ENABLED
)) {
954 if (!wIndex
|| wIndex
> ports
)
957 temp
= ehci_readl(ehci
, status_reg
);
958 if (temp
& PORT_OWNER
)
961 temp
&= ~PORT_RWC_BITS
;
963 case USB_PORT_FEAT_SUSPEND
:
964 if (ehci
->no_selective_suspend
)
966 if ((temp
& PORT_PE
) == 0
967 || (temp
& PORT_RESET
) != 0)
970 /* After above check the port must be connected.
971 * Set appropriate bit thus could put phy into low power
972 * mode if we have hostpc feature
974 temp
&= ~PORT_WKCONN_E
;
975 temp
|= PORT_WKDISC_E
| PORT_WKOC_E
;
976 ehci_writel(ehci
, temp
| PORT_SUSPEND
, status_reg
);
977 if (ehci
->has_hostpc
) {
978 spin_unlock_irqrestore(&ehci
->lock
, flags
);
979 msleep(5);/* 5ms for HCD enter low pwr mode */
980 spin_lock_irqsave(&ehci
->lock
, flags
);
981 temp1
= ehci_readl(ehci
, hostpc_reg
);
982 ehci_writel(ehci
, temp1
| HOSTPC_PHCD
,
984 temp1
= ehci_readl(ehci
, hostpc_reg
);
985 ehci_dbg(ehci
, "Port%d phy low pwr mode %s\n",
986 wIndex
, (temp1
& HOSTPC_PHCD
) ?
987 "succeeded" : "failed");
989 set_bit(wIndex
, &ehci
->suspended_ports
);
991 case USB_PORT_FEAT_POWER
:
992 if (HCS_PPC (ehci
->hcs_params
))
993 ehci_writel(ehci
, temp
| PORT_POWER
,
996 case USB_PORT_FEAT_RESET
:
997 if (temp
& PORT_RESUME
)
999 /* line status bits may report this as low speed,
1000 * which can be fine if this root hub has a
1001 * transaction translator built in.
1003 if ((temp
& (PORT_PE
|PORT_CONNECT
)) == PORT_CONNECT
1004 && !ehci_is_TDI(ehci
)
1005 && PORT_USB11 (temp
)) {
1007 "port %d low speed --> companion\n",
1011 ehci_vdbg (ehci
, "port %d reset\n", wIndex
+ 1);
1016 * caller must wait, then call GetPortStatus
1017 * usb 2.0 spec says 50 ms resets on root
1019 ehci
->reset_done
[wIndex
] = jiffies
1020 + msecs_to_jiffies (50);
1022 ehci_writel(ehci
, temp
, status_reg
);
1025 /* For downstream facing ports (these): one hub port is put
1026 * into test mode according to USB2 11.24.2.13, then the hub
1027 * must be reset (which for root hub now means rmmod+modprobe,
1028 * or else system reboot). See EHCI 2.3.9 and 4.14 for info
1029 * about the EHCI-specific stuff.
1031 case USB_PORT_FEAT_TEST
:
1032 if (!selector
|| selector
> 5)
1036 /* Put all enabled ports into suspend */
1039 &ehci
->regs
->port_status
[ports
];
1041 temp
= ehci_readl(ehci
, sreg
) & ~PORT_RWC_BITS
;
1043 ehci_writel(ehci
, temp
| PORT_SUSPEND
,
1047 temp
= ehci_readl(ehci
, status_reg
);
1048 temp
|= selector
<< 16;
1049 ehci_writel(ehci
, temp
, status_reg
);
1055 ehci_readl(ehci
, &ehci
->regs
->command
); /* unblock posted writes */
1060 /* "stall" on error */
1064 spin_unlock_irqrestore (&ehci
->lock
, flags
);
1068 static void __maybe_unused
ehci_relinquish_port(struct usb_hcd
*hcd
,
1071 struct ehci_hcd
*ehci
= hcd_to_ehci(hcd
);
1073 if (ehci_is_TDI(ehci
))
1075 set_owner(ehci
, --portnum
, PORT_OWNER
);
1078 static int __maybe_unused
ehci_port_handed_over(struct usb_hcd
*hcd
,
1081 struct ehci_hcd
*ehci
= hcd_to_ehci(hcd
);
1084 if (ehci_is_TDI(ehci
))
1086 reg
= &ehci
->regs
->port_status
[portnum
- 1];
1087 return ehci_readl(ehci
, reg
) & PORT_OWNER
;