USB: EHCI: Fix test mode sequence
The sequence to put port in test mode is not complete. According EHCI specification all enabled ports must be put in suspend. Signed-off-by: Boris Todorov <boris.st.todorov@gmail.com> Acked-by: Alan Stern <stern@rowland.harvard.edu> Signed-off-by: Greg Kroah-Hartman <gregkh@suse.de>
This commit is contained in:
parent
1862cdd542
commit
77636c86a6
1 changed files with 12 additions and 0 deletions
|
@ -1046,7 +1046,19 @@ static int ehci_hub_control (
|
||||||
if (!selector || selector > 5)
|
if (!selector || selector > 5)
|
||||||
goto error;
|
goto error;
|
||||||
ehci_quiesce(ehci);
|
ehci_quiesce(ehci);
|
||||||
|
|
||||||
|
/* Put all enabled ports into suspend */
|
||||||
|
while (ports--) {
|
||||||
|
u32 __iomem *sreg =
|
||||||
|
&ehci->regs->port_status[ports];
|
||||||
|
|
||||||
|
temp = ehci_readl(ehci, sreg) & ~PORT_RWC_BITS;
|
||||||
|
if (temp & PORT_PE)
|
||||||
|
ehci_writel(ehci, temp | PORT_SUSPEND,
|
||||||
|
sreg);
|
||||||
|
}
|
||||||
ehci_halt(ehci);
|
ehci_halt(ehci);
|
||||||
|
temp = ehci_readl(ehci, status_reg);
|
||||||
temp |= selector << 16;
|
temp |= selector << 16;
|
||||||
ehci_writel(ehci, temp, status_reg);
|
ehci_writel(ehci, temp, status_reg);
|
||||||
break;
|
break;
|
||||||
|
|
Loading…
Add table
Reference in a new issue