|
@@ -486,6 +486,22 @@ static void dwc3_cache_hwparams(struct dwc3 *dwc)
|
|
|
parms->hwparams8 = dwc3_readl(dwc->regs, DWC3_GHWPARAMS8);
|
|
|
}
|
|
|
|
|
|
+static int dwc3_core_ulpi_init(struct dwc3 *dwc)
|
|
|
+{
|
|
|
+ int intf;
|
|
|
+ int ret = 0;
|
|
|
+
|
|
|
+ intf = DWC3_GHWPARAMS3_HSPHY_IFC(dwc->hwparams.hwparams3);
|
|
|
+
|
|
|
+ if (intf == DWC3_GHWPARAMS3_HSPHY_IFC_ULPI ||
|
|
|
+ (intf == DWC3_GHWPARAMS3_HSPHY_IFC_UTMI_ULPI &&
|
|
|
+ dwc->hsphy_interface &&
|
|
|
+ !strncmp(dwc->hsphy_interface, "ulpi", 4)))
|
|
|
+ ret = dwc3_ulpi_init(dwc);
|
|
|
+
|
|
|
+ return ret;
|
|
|
+}
|
|
|
+
|
|
|
/**
|
|
|
* dwc3_phy_setup - Configure USB PHY Interface of DWC3 Core
|
|
|
* @dwc: Pointer to our controller context structure
|
|
@@ -497,7 +513,6 @@ static void dwc3_cache_hwparams(struct dwc3 *dwc)
|
|
|
static int dwc3_phy_setup(struct dwc3 *dwc)
|
|
|
{
|
|
|
u32 reg;
|
|
|
- int ret;
|
|
|
|
|
|
reg = dwc3_readl(dwc->regs, DWC3_GUSB3PIPECTL(0));
|
|
|
|
|
@@ -568,9 +583,6 @@ static int dwc3_phy_setup(struct dwc3 *dwc)
|
|
|
}
|
|
|
/* FALLTHROUGH */
|
|
|
case DWC3_GHWPARAMS3_HSPHY_IFC_ULPI:
|
|
|
- ret = dwc3_ulpi_init(dwc);
|
|
|
- if (ret)
|
|
|
- return ret;
|
|
|
/* FALLTHROUGH */
|
|
|
default:
|
|
|
break;
|
|
@@ -727,6 +739,7 @@ static void dwc3_core_setup_global_control(struct dwc3 *dwc)
|
|
|
}
|
|
|
|
|
|
static int dwc3_core_get_phy(struct dwc3 *dwc);
|
|
|
+static int dwc3_core_ulpi_init(struct dwc3 *dwc);
|
|
|
|
|
|
/**
|
|
|
* dwc3_core_init - Low-level initialization of DWC3 Core
|
|
@@ -758,17 +771,27 @@ static int dwc3_core_init(struct dwc3 *dwc)
|
|
|
dwc->maximum_speed = USB_SPEED_HIGH;
|
|
|
}
|
|
|
|
|
|
- ret = dwc3_core_get_phy(dwc);
|
|
|
+ ret = dwc3_phy_setup(dwc);
|
|
|
if (ret)
|
|
|
goto err0;
|
|
|
|
|
|
- ret = dwc3_core_soft_reset(dwc);
|
|
|
- if (ret)
|
|
|
- goto err0;
|
|
|
+ if (!dwc->ulpi_ready) {
|
|
|
+ ret = dwc3_core_ulpi_init(dwc);
|
|
|
+ if (ret)
|
|
|
+ goto err0;
|
|
|
+ dwc->ulpi_ready = true;
|
|
|
+ }
|
|
|
|
|
|
- ret = dwc3_phy_setup(dwc);
|
|
|
+ if (!dwc->phys_ready) {
|
|
|
+ ret = dwc3_core_get_phy(dwc);
|
|
|
+ if (ret)
|
|
|
+ goto err0a;
|
|
|
+ dwc->phys_ready = true;
|
|
|
+ }
|
|
|
+
|
|
|
+ ret = dwc3_core_soft_reset(dwc);
|
|
|
if (ret)
|
|
|
- goto err0;
|
|
|
+ goto err0a;
|
|
|
|
|
|
dwc3_core_setup_global_control(dwc);
|
|
|
dwc3_core_num_eps(dwc);
|
|
@@ -841,6 +864,9 @@ err1:
|
|
|
phy_exit(dwc->usb2_generic_phy);
|
|
|
phy_exit(dwc->usb3_generic_phy);
|
|
|
|
|
|
+err0a:
|
|
|
+ dwc3_ulpi_exit(dwc);
|
|
|
+
|
|
|
err0:
|
|
|
return ret;
|
|
|
}
|
|
@@ -1235,7 +1261,6 @@ err4:
|
|
|
|
|
|
err3:
|
|
|
dwc3_free_event_buffers(dwc);
|
|
|
- dwc3_ulpi_exit(dwc);
|
|
|
|
|
|
err2:
|
|
|
pm_runtime_allow(&pdev->dev);
|