mirror of
https://github.com/AsahiLinux/u-boot
synced 2024-11-25 06:00:43 +00:00
usb: ehci: Fix test mode for connected ports
The EHCI controller has some very specific requirements for the USB 2.0 port test modes, which were not closely followed in the initial test mode commit. It demands that the host controller is completely shut down (all ports suspended, Run/Stop bit unset) when activating test mode, and will not work on an already enumerated port. This patch fixes that by introducing a new ehci_shutdown() function that closely follows the procedure listed in EHCI 4.14. Also, when we have such a function anyway, we might as well also use it in usb_lowlevel_stop() to make the normal host controller shutdown cleaner. Signed-off-by: Julius Werner <jwerner@chromium.org> Acked-by: Simon Glass <sjg@chromium.org>
This commit is contained in:
parent
4585fc5863
commit
5077f96f10
1 changed files with 38 additions and 0 deletions
|
@ -36,6 +36,12 @@
|
|||
#define CONFIG_USB_MAX_CONTROLLER_COUNT 1
|
||||
#endif
|
||||
|
||||
/*
|
||||
* EHCI spec page 20 says that the HC may take up to 16 uFrames (= 4ms) to halt.
|
||||
* Let's time out after 8 to have a little safety margin on top of that.
|
||||
*/
|
||||
#define HCHALT_TIMEOUT (8 * 1000)
|
||||
|
||||
static struct ehci_ctrl ehcic[CONFIG_USB_MAX_CONTROLLER_COUNT];
|
||||
|
||||
#define ALIGN_END_ADDR(type, ptr, size) \
|
||||
|
@ -190,6 +196,36 @@ out:
|
|||
return ret;
|
||||
}
|
||||
|
||||
static int ehci_shutdown(struct ehci_ctrl *ctrl)
|
||||
{
|
||||
int i, ret = 0;
|
||||
uint32_t cmd, reg;
|
||||
|
||||
cmd = ehci_readl(&ctrl->hcor->or_usbcmd);
|
||||
cmd &= ~(CMD_PSE | CMD_ASE);
|
||||
ehci_writel(&ctrl->hcor->or_usbcmd, cmd);
|
||||
ret = handshake(&ctrl->hcor->or_usbsts, STS_ASS | STS_PSS, 0,
|
||||
100 * 1000);
|
||||
|
||||
if (!ret) {
|
||||
for (i = 0; i < CONFIG_SYS_USB_EHCI_MAX_ROOT_PORTS; i++) {
|
||||
reg = ehci_readl(&ctrl->hcor->or_portsc[i]);
|
||||
reg |= EHCI_PS_SUSP;
|
||||
ehci_writel(&ctrl->hcor->or_portsc[i], reg);
|
||||
}
|
||||
|
||||
cmd &= ~CMD_RUN;
|
||||
ehci_writel(&ctrl->hcor->or_usbcmd, cmd);
|
||||
ret = handshake(&ctrl->hcor->or_usbsts, STS_HALT, STS_HALT,
|
||||
HCHALT_TIMEOUT);
|
||||
}
|
||||
|
||||
if (ret)
|
||||
puts("EHCI failed to shut down host controller.\n");
|
||||
|
||||
return ret;
|
||||
}
|
||||
|
||||
static int ehci_td_buffer(struct qTD *td, void *buf, size_t sz)
|
||||
{
|
||||
uint32_t delta, next;
|
||||
|
@ -808,6 +844,7 @@ ehci_submit_root(struct usb_device *dev, unsigned long pipe, void *buffer,
|
|||
}
|
||||
break;
|
||||
case USB_PORT_FEAT_TEST:
|
||||
ehci_shutdown(ctrl);
|
||||
reg &= ~(0xf << 16);
|
||||
reg |= ((le16_to_cpu(req->index) >> 8) & 0xf) << 16;
|
||||
ehci_writel(status_reg, reg);
|
||||
|
@ -878,6 +915,7 @@ unknown:
|
|||
|
||||
int usb_lowlevel_stop(int index)
|
||||
{
|
||||
ehci_shutdown(&ehcic[index]);
|
||||
return ehci_hcd_stop(index);
|
||||
}
|
||||
|
||||
|
|
Loading…
Reference in a new issue