mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
142 lines
3.2 KiB
142 lines
3.2 KiB
// SPDX-License-Identifier: GPL-2.0 |
|
/* |
|
* Cadence USBSS and USBSSP DRD Driver - host side |
|
* |
|
* Copyright (C) 2018-2019 Cadence Design Systems. |
|
* Copyright (C) 2017-2018 NXP |
|
* |
|
* Authors: Peter Chen <[email protected]> |
|
* Pawel Laszczak <[email protected]> |
|
*/ |
|
|
|
#include <linux/platform_device.h> |
|
#include "core.h" |
|
#include "drd.h" |
|
#include "host-export.h" |
|
#include <linux/usb/hcd.h> |
|
#include "../host/xhci.h" |
|
#include "../host/xhci-plat.h" |
|
|
|
#define XECP_PORT_CAP_REG 0x8000 |
|
#define XECP_AUX_CTRL_REG1 0x8120 |
|
|
|
#define CFG_RXDET_P3_EN BIT(15) |
|
#define LPM_2_STB_SWITCH_EN BIT(25) |
|
|
|
static int xhci_cdns3_suspend_quirk(struct usb_hcd *hcd); |
|
|
|
static const struct xhci_plat_priv xhci_plat_cdns3_xhci = { |
|
.quirks = XHCI_SKIP_PHY_INIT | XHCI_AVOID_BEI, |
|
.suspend_quirk = xhci_cdns3_suspend_quirk, |
|
}; |
|
|
|
static int __cdns_host_init(struct cdns *cdns) |
|
{ |
|
struct platform_device *xhci; |
|
int ret; |
|
struct usb_hcd *hcd; |
|
|
|
cdns_drd_host_on(cdns); |
|
|
|
xhci = platform_device_alloc("xhci-hcd", PLATFORM_DEVID_AUTO); |
|
if (!xhci) { |
|
dev_err(cdns->dev, "couldn't allocate xHCI device\n"); |
|
return -ENOMEM; |
|
} |
|
|
|
xhci->dev.parent = cdns->dev; |
|
cdns->host_dev = xhci; |
|
|
|
ret = platform_device_add_resources(xhci, cdns->xhci_res, |
|
CDNS_XHCI_RESOURCES_NUM); |
|
if (ret) { |
|
dev_err(cdns->dev, "couldn't add resources to xHCI device\n"); |
|
goto err1; |
|
} |
|
|
|
cdns->xhci_plat_data = kmemdup(&xhci_plat_cdns3_xhci, |
|
sizeof(struct xhci_plat_priv), GFP_KERNEL); |
|
if (!cdns->xhci_plat_data) { |
|
ret = -ENOMEM; |
|
goto err1; |
|
} |
|
|
|
if (cdns->pdata && (cdns->pdata->quirks & CDNS3_DEFAULT_PM_RUNTIME_ALLOW)) |
|
cdns->xhci_plat_data->quirks |= XHCI_DEFAULT_PM_RUNTIME_ALLOW; |
|
|
|
ret = platform_device_add_data(xhci, cdns->xhci_plat_data, |
|
sizeof(struct xhci_plat_priv)); |
|
if (ret) |
|
goto free_memory; |
|
|
|
ret = platform_device_add(xhci); |
|
if (ret) { |
|
dev_err(cdns->dev, "failed to register xHCI device\n"); |
|
goto free_memory; |
|
} |
|
|
|
/* Glue needs to access xHCI region register for Power management */ |
|
hcd = platform_get_drvdata(xhci); |
|
if (hcd) |
|
cdns->xhci_regs = hcd->regs; |
|
|
|
return 0; |
|
|
|
free_memory: |
|
kfree(cdns->xhci_plat_data); |
|
err1: |
|
platform_device_put(xhci); |
|
return ret; |
|
} |
|
|
|
static int xhci_cdns3_suspend_quirk(struct usb_hcd *hcd) |
|
{ |
|
struct xhci_hcd *xhci = hcd_to_xhci(hcd); |
|
u32 value; |
|
|
|
if (pm_runtime_status_suspended(hcd->self.controller)) |
|
return 0; |
|
|
|
/* set usbcmd.EU3S */ |
|
value = readl(&xhci->op_regs->command); |
|
value |= CMD_PM_INDEX; |
|
writel(value, &xhci->op_regs->command); |
|
|
|
if (hcd->regs) { |
|
value = readl(hcd->regs + XECP_AUX_CTRL_REG1); |
|
value |= CFG_RXDET_P3_EN; |
|
writel(value, hcd->regs + XECP_AUX_CTRL_REG1); |
|
|
|
value = readl(hcd->regs + XECP_PORT_CAP_REG); |
|
value |= LPM_2_STB_SWITCH_EN; |
|
writel(value, hcd->regs + XECP_PORT_CAP_REG); |
|
} |
|
|
|
return 0; |
|
} |
|
|
|
static void cdns_host_exit(struct cdns *cdns) |
|
{ |
|
kfree(cdns->xhci_plat_data); |
|
platform_device_unregister(cdns->host_dev); |
|
cdns->host_dev = NULL; |
|
cdns_drd_host_off(cdns); |
|
} |
|
|
|
int cdns_host_init(struct cdns *cdns) |
|
{ |
|
struct cdns_role_driver *rdrv; |
|
|
|
rdrv = devm_kzalloc(cdns->dev, sizeof(*rdrv), GFP_KERNEL); |
|
if (!rdrv) |
|
return -ENOMEM; |
|
|
|
rdrv->start = __cdns_host_init; |
|
rdrv->stop = cdns_host_exit; |
|
rdrv->state = CDNS_ROLE_STATE_INACTIVE; |
|
rdrv->name = "host"; |
|
|
|
cdns->roles[USB_ROLE_HOST] = rdrv; |
|
|
|
return 0; |
|
}
|
|
|