|
@@ -0,0 +1,101 @@
|
|
|
|
|
+--- a/drivers/usb/host/ehci-hcd.c
|
|
|
|
|
++++ b/drivers/usb/host/ehci-hcd.c
|
|
|
|
|
+@@ -249,6 +249,37 @@ static int ehci_reset (struct ehci_hcd *
|
|
|
|
|
+ command |= CMD_RESET;
|
|
|
|
|
+ dbg_cmd (ehci, "reset", command);
|
|
|
|
|
+ ehci_writel(ehci, command, &ehci->regs->command);
|
|
|
|
|
++
|
|
|
|
|
++ if (ehci->qca_force_host_mode) {
|
|
|
|
|
++ u32 usbmode;
|
|
|
|
|
++
|
|
|
|
|
++ udelay(1000);
|
|
|
|
|
++
|
|
|
|
|
++ usbmode = ehci_readl(ehci, &ehci->regs->usbmode);
|
|
|
|
|
++ usbmode |= USBMODE_CM_HC | (1 << 4);
|
|
|
|
|
++ ehci_writel(ehci, usbmode, &ehci->regs->usbmode);
|
|
|
|
|
++
|
|
|
|
|
++ ehci_dbg(ehci, "forced host mode, usbmode: %08x\n",
|
|
|
|
|
++ ehci_readl(ehci, &ehci->regs->usbmode));
|
|
|
|
|
++ }
|
|
|
|
|
++
|
|
|
|
|
++ if (ehci->qca_force_16bit_ptw) {
|
|
|
|
|
++ u32 port_status;
|
|
|
|
|
++
|
|
|
|
|
++ udelay(1000);
|
|
|
|
|
++
|
|
|
|
|
++ /* enable 16-bit UTMI interface */
|
|
|
|
|
++ port_status = ehci_readl(ehci, &ehci->regs->port_status[0]);
|
|
|
|
|
++ port_status |= BIT(28);
|
|
|
|
|
++ ehci_writel(ehci, port_status, &ehci->regs->port_status[0]);
|
|
|
|
|
++
|
|
|
|
|
++ ehci_dbg(ehci, "16-bit UTMI interface enabled, status: %08x\n",
|
|
|
|
|
++ ehci_readl(ehci, &ehci->regs->port_status[0]));
|
|
|
|
|
++ }
|
|
|
|
|
++
|
|
|
|
|
++ if (ehci->reset_notifier)
|
|
|
|
|
++ ehci->reset_notifier(ehci_to_hcd(ehci));
|
|
|
|
|
++
|
|
|
|
|
+ ehci->rh_state = EHCI_RH_HALTED;
|
|
|
|
|
+ ehci->next_statechange = jiffies;
|
|
|
|
|
+ retval = handshake (ehci, &ehci->regs->command,
|
|
|
|
|
+--- a/drivers/usb/host/ehci.h
|
|
|
|
|
++++ b/drivers/usb/host/ehci.h
|
|
|
|
|
+@@ -201,6 +201,10 @@ struct ehci_hcd { /* one per controlle
|
|
|
|
|
+ unsigned has_synopsys_hc_bug:1; /* Synopsys HC */
|
|
|
|
|
+ unsigned frame_index_bug:1; /* MosChip (AKA NetMos) */
|
|
|
|
|
+ unsigned ignore_oc:1;
|
|
|
|
|
++ unsigned qca_force_host_mode:1;
|
|
|
|
|
++ unsigned qca_force_16bit_ptw:1; /* force 16 bit UTMI */
|
|
|
|
|
++
|
|
|
|
|
++ void (*reset_notifier)(struct usb_hcd *hcd);
|
|
|
|
|
+
|
|
|
|
|
+ /* required for usb32 quirk */
|
|
|
|
|
+ #define OHCI_CTRL_HCFS (3 << 6)
|
|
|
|
|
+--- a/include/linux/usb/ehci_pdriver.h
|
|
|
|
|
++++ b/include/linux/usb/ehci_pdriver.h
|
|
|
|
|
+@@ -43,6 +43,8 @@ struct usb_ehci_pdata {
|
|
|
|
|
+ unsigned big_endian_mmio:1;
|
|
|
|
|
+ unsigned no_io_watchdog:1;
|
|
|
|
|
+ unsigned ignore_oc:1;
|
|
|
|
|
++ unsigned qca_force_host_mode:1;
|
|
|
|
|
++ unsigned qca_force_16bit_ptw:1;
|
|
|
|
|
+
|
|
|
|
|
+ /* Turn on all power and clocks */
|
|
|
|
|
+ int (*power_on)(struct platform_device *pdev);
|
|
|
|
|
+@@ -51,6 +53,7 @@ struct usb_ehci_pdata {
|
|
|
|
|
+ /* Turn on only VBUS suspend power and hotplug detection,
|
|
|
|
|
+ * turn off everything else */
|
|
|
|
|
+ void (*power_suspend)(struct platform_device *pdev);
|
|
|
|
|
++ void (*reset_notifier)(struct platform_device *pdev);
|
|
|
|
|
+ };
|
|
|
|
|
+
|
|
|
|
|
+ #endif /* __USB_CORE_EHCI_PDRIVER_H */
|
|
|
|
|
+--- a/drivers/usb/host/ehci-platform.c
|
|
|
|
|
++++ b/drivers/usb/host/ehci-platform.c
|
|
|
|
|
+@@ -33,6 +33,14 @@
|
|
|
|
|
+
|
|
|
|
|
+ static const char hcd_name[] = "ehci-platform";
|
|
|
|
|
+
|
|
|
|
|
++static void ehci_platform_reset_notifier(struct usb_hcd *hcd)
|
|
|
|
|
++{
|
|
|
|
|
++ struct platform_device *pdev = to_platform_device(hcd->self.controller);
|
|
|
|
|
++ struct usb_ehci_pdata *pdata = pdev->dev.platform_data;
|
|
|
|
|
++
|
|
|
|
|
++ pdata->reset_notifier(pdev);
|
|
|
|
|
++}
|
|
|
|
|
++
|
|
|
|
|
+ static int ehci_platform_reset(struct usb_hcd *hcd)
|
|
|
|
|
+ {
|
|
|
|
|
+ struct platform_device *pdev = to_platform_device(hcd->self.controller);
|
|
|
|
|
+@@ -45,6 +53,11 @@ static int ehci_platform_reset(struct us
|
|
|
|
|
+ ehci->big_endian_desc = pdata->big_endian_desc;
|
|
|
|
|
+ ehci->big_endian_mmio = pdata->big_endian_mmio;
|
|
|
|
|
+ ehci->ignore_oc = pdata->ignore_oc;
|
|
|
|
|
++ ehci->qca_force_host_mode = pdata->qca_force_host_mode;
|
|
|
|
|
++ ehci->qca_force_16bit_ptw = pdata->qca_force_16bit_ptw;
|
|
|
|
|
++
|
|
|
|
|
++ if (pdata->reset_notifier)
|
|
|
|
|
++ ehci->reset_notifier = ehci_platform_reset_notifier;
|
|
|
|
|
+
|
|
|
|
|
+ ehci->caps = hcd->regs + pdata->caps_offset;
|
|
|
|
|
+ retval = ehci_setup(hcd);
|