usb: dwc3: omap: distinguish between SW and HW modes

[deliverable/linux.git] / drivers / usb / dwc3 / dwc3-omap.c

diff --git a/drivers/usb/dwc3/dwc3-omap.c b/drivers/usb/dwc3/dwc3-omap.c
index 17d1822f768708d9a203b4f53a75c31e6ec71eab..ddbf38a940172f0deacdc23e0e2a1111dca52a60 100644 (file)
--- a/drivers/usb/dwc3/dwc3-omap.c
+++ b/drivers/usb/dwc3/dwc3-omap.c
@@ -42,6 +42,7 @@
 #include <linux/interrupt.h>
 #include <linux/spinlock.h>
 #include <linux/platform_device.h>
+#include <linux/platform_data/dwc3-omap.h>
 #include <linux/dma-mapping.h>
 #include <linux/ioport.h>
 #include <linux/io.h>
@@ -193,6 +194,7 @@ static irqreturn_t dwc3_omap_interrupt(int irq, void *_omap)
 
 static int __devinit dwc3_omap_probe(struct platform_device *pdev)
 {
+       struct dwc3_omap_data   *pdata = pdev->dev.platform_data;
        struct platform_device  *dwc3;
        struct dwc3_omap        *omap;
        struct resource         *res;
@@ -258,6 +260,26 @@ static int __devinit dwc3_omap_probe(struct platform_device *pdev)
        omap->base      = base;
        omap->dwc3      = dwc3;
 
+       reg = dwc3_readl(omap->base, USBOTGSS_UTMI_OTG_STATUS);
+
+       if (!pdata) {
+               dev_dbg(&pdev->dev, "missing platform data\n");
+       } else {
+               switch (pdata->utmi_mode) {
+               case DWC3_OMAP_UTMI_MODE_SW:
+                       reg |= USBOTGSS_UTMI_OTG_STATUS_SW_MODE;
+                       break;
+               case DWC3_OMAP_UTMI_MODE_HW:
+                       reg &= ~USBOTGSS_UTMI_OTG_STATUS_SW_MODE;
+                       break;
+               default:
+                       dev_dbg(&pdev->dev, "UNKNOWN utmi mode %d\n",
+                                       pdata->utmi_mode);
+               }
+       }
+
+       dwc3_writel(omap->base, USBOTGSS_UTMI_OTG_STATUS, reg);
+
        /* check the DMA Status */
        reg = dwc3_readl(omap->base, USBOTGSS_SYSCONFIG);
        omap->dma_status = !!(reg & USBOTGSS_SYSCONFIG_DMADISABLE);