[PATCH] libpayload: Implement EHCI reset function
Added ehci_reset() function to do a full reset of
the host controller
Change-Id: Ia48db8462ebbb8f260813eb6ba8349d002c4678b
Signed-off-by: Anton Kochkov <a.kochkov@securitycode.ru>
Reviewed-on: http://review.coreboot.org/1814
Tested-by: build bot (Jenkins)
Reviewed-by: Ronald G. Minnich <rminnich@gmail.com>
diff --git a/payloads/libpayload/drivers/usb/ehci.c b/payloads/libpayload/drivers/usb/ehci.c
index 29b399a..2ac1480 100644
--- a/payloads/libpayload/drivers/usb/ehci.c
+++ b/payloads/libpayload/drivers/usb/ehci.c
@@ -51,7 +51,21 @@
static void ehci_reset (hci_t *controller)
{
-
+ short count = 0;
+ ehci_stop(controller);
+ /* wait 10 ms just to be shure */
+ mdelay(10);
+ if (EHCI_INST(controller)->operation->usbsts & HC_OP_HC_HALTED) {
+ EHCI_INST(controller)->operation->usbcmd = HC_OP_HC_RESET;
+ /* wait 100 ms */
+ for (count = 0; count < 10; count++) {
+ mdelay(10);
+ if (!(EHCI_INST(controller)->operation->usbcmd & HC_OP_HC_RESET)) {
+ return;
+ }
+ }
+ }
+ usb_debug("ehci_reset(): reset failed!\n");
}
static int ehci_set_periodic_schedule(ehci_t *ehcic, int enable)