diff --git a/arch/arm/mach-imx/mx8m/soc.c b/arch/arm/mach-imx/mx8m/soc.c index 46873aa8ddf31cc528fe9a798a6cb92782093e6f..593a7dfb111b375d6b9e6065a9cf32d5da521d4f 100644 --- a/arch/arm/mach-imx/mx8m/soc.c +++ b/arch/arm/mach-imx/mx8m/soc.c @@ -224,3 +224,22 @@ void reset_cpu(ulong addr) */ } } + +#ifdef CONFIG_USB_XHCI_IMX8M +#define FSL_SIP_GPC 0xC2000000 +#define FSL_SIP_CONFIG_GPC_PM_DOMAIN 0x03 +int imx8m_usb_power(int usb_id, bool on) +{ + unsigned long ret; + + if (usb_id > 1) + return -EINVAL; + + ret = call_imx_sip(FSL_SIP_GPC, + FSL_SIP_CONFIG_GPC_PM_DOMAIN, 2 + usb_id, on, 0); + if (ret) + return -EPERM; + + return 0; +} +#endif diff --git a/drivers/usb/host/xhci-imx8m.c b/drivers/usb/host/xhci-imx8m.c index 1c63550a8f6c9f57e0016266384042328ed1e522..40f0518bc5bb12c71cedc940c34725665b6215af 100644 --- a/drivers/usb/host/xhci-imx8m.c +++ b/drivers/usb/host/xhci-imx8m.c @@ -42,8 +42,14 @@ struct imx8m_xhci { struct imx8m_usbmix *usbmix_reg; }; +struct imx8m_usbctrl_data { + u32 usb_id; + unsigned long ctr_addr; +}; static struct imx8m_xhci imx8m_xhci; -unsigned long ctr_addr[] = {USB2_BASE_ADDR}; +static struct imx8m_usbctrl_data ctr_data[] = { + {1, USB2_BASE_ADDR}, +}; static void imx8m_usb_phy_init(struct imx8m_usbmix *usbmix_reg) { @@ -107,13 +113,14 @@ int xhci_hcd_init(int index, struct xhci_hccr **hccr, struct xhci_hcor **hcor) struct imx8m_xhci *ctx = &imx8m_xhci; int ret = 0; - ctx->hcd = (struct xhci_hccr *)ctr_addr[index]; + ctx->hcd = (struct xhci_hccr *)(ctr_data[index].ctr_addr); ctx->dwc3_reg = (struct dwc3 *)((char *)(ctx->hcd) + DWC3_REG_OFFSET); ctx->usbmix_reg = (struct imx8m_usbmix *)((char *)(ctx->hcd) + USBMIX_PHY_OFFSET); - ret = board_usb_init(index, USB_INIT_HOST); + ret = board_usb_init(ctr_data[index].usb_id, USB_INIT_HOST); if (ret != 0) { + imx8m_usb_power(ctr_data[index].usb_id, false); puts("Failed to initialize board for imx8m USB\n"); return ret; } @@ -137,4 +144,5 @@ int xhci_hcd_init(int index, struct xhci_hccr **hccr, struct xhci_hcor **hcor) void xhci_hcd_stop(int index) { + board_usb_cleanup(ctr_data[index].usb_id, USB_INIT_HOST); }