1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * Cadence USBSS and USBSSP DRD Driver - host side
4 *
5 * Copyright (C) 2018-2019 Cadence Design Systems.
6 * Copyright (C) 2017-2018 NXP
7 *
8 * Authors: Peter Chen <peter.chen@nxp.com>
9 * Pawel Laszczak <pawell@cadence.com>
10 */
11
12 #include <linux/platform_device.h>
13 #include <linux/slab.h>
14 #include "core.h"
15 #include "drd.h"
16 #include "host-export.h"
17 #include <linux/usb/hcd.h>
18 #include "../host/xhci.h"
19 #include "../host/xhci-plat.h"
20
21 #define XECP_PORT_CAP_REG 0x8000
22 #define XECP_AUX_CTRL_REG1 0x8120
23
24 #define CFG_RXDET_P3_EN BIT(15)
25 #define LPM_2_STB_SWITCH_EN BIT(25)
26
xhci_cdns3_plat_start(struct usb_hcd * hcd)27 static void xhci_cdns3_plat_start(struct usb_hcd *hcd)
28 {
29 struct xhci_hcd *xhci = hcd_to_xhci(hcd);
30 u32 value;
31
32 /* set usbcmd.EU3S */
33 value = readl(&xhci->op_regs->command);
34 value |= CMD_PM_INDEX;
35 writel(value, &xhci->op_regs->command);
36
37 if (hcd->regs) {
38 value = readl(hcd->regs + XECP_AUX_CTRL_REG1);
39 value |= CFG_RXDET_P3_EN;
40 writel(value, hcd->regs + XECP_AUX_CTRL_REG1);
41
42 value = readl(hcd->regs + XECP_PORT_CAP_REG);
43 value |= LPM_2_STB_SWITCH_EN;
44 writel(value, hcd->regs + XECP_PORT_CAP_REG);
45 }
46 }
47
xhci_cdns3_resume_quirk(struct usb_hcd * hcd)48 static int xhci_cdns3_resume_quirk(struct usb_hcd *hcd)
49 {
50 xhci_cdns3_plat_start(hcd);
51 return 0;
52 }
53
54 static const struct xhci_plat_priv xhci_plat_cdns3_xhci = {
55 .quirks = XHCI_SKIP_PHY_INIT | XHCI_AVOID_BEI,
56 .plat_start = xhci_cdns3_plat_start,
57 .resume_quirk = xhci_cdns3_resume_quirk,
58 };
59
__cdns_host_init(struct cdns * cdns)60 static int __cdns_host_init(struct cdns *cdns)
61 {
62 struct platform_device *xhci;
63 int ret;
64 struct usb_hcd *hcd;
65
66 cdns_drd_host_on(cdns);
67
68 xhci = platform_device_alloc("xhci-hcd", PLATFORM_DEVID_AUTO);
69 if (!xhci) {
70 dev_err(cdns->dev, "couldn't allocate xHCI device\n");
71 return -ENOMEM;
72 }
73
74 xhci->dev.parent = cdns->dev;
75 cdns->host_dev = xhci;
76
77 ret = platform_device_add_resources(xhci, cdns->xhci_res,
78 CDNS_XHCI_RESOURCES_NUM);
79 if (ret) {
80 dev_err(cdns->dev, "couldn't add resources to xHCI device\n");
81 goto err1;
82 }
83
84 cdns->xhci_plat_data = kmemdup(&xhci_plat_cdns3_xhci,
85 sizeof(struct xhci_plat_priv), GFP_KERNEL);
86 if (!cdns->xhci_plat_data) {
87 ret = -ENOMEM;
88 goto err1;
89 }
90
91 if (cdns->pdata && (cdns->pdata->quirks & CDNS3_DEFAULT_PM_RUNTIME_ALLOW))
92 cdns->xhci_plat_data->quirks |= XHCI_DEFAULT_PM_RUNTIME_ALLOW;
93
94 ret = platform_device_add_data(xhci, cdns->xhci_plat_data,
95 sizeof(struct xhci_plat_priv));
96 if (ret)
97 goto free_memory;
98
99 ret = platform_device_add(xhci);
100 if (ret) {
101 dev_err(cdns->dev, "failed to register xHCI device\n");
102 goto free_memory;
103 }
104
105 /* Glue needs to access xHCI region register for Power management */
106 hcd = platform_get_drvdata(xhci);
107 if (hcd)
108 cdns->xhci_regs = hcd->regs;
109
110 return 0;
111
112 free_memory:
113 kfree(cdns->xhci_plat_data);
114 err1:
115 platform_device_put(xhci);
116 return ret;
117 }
118
cdns_host_exit(struct cdns * cdns)119 static void cdns_host_exit(struct cdns *cdns)
120 {
121 kfree(cdns->xhci_plat_data);
122 platform_device_unregister(cdns->host_dev);
123 cdns->host_dev = NULL;
124 cdns_drd_host_off(cdns);
125 }
126
cdns_host_init(struct cdns * cdns)127 int cdns_host_init(struct cdns *cdns)
128 {
129 struct cdns_role_driver *rdrv;
130
131 rdrv = devm_kzalloc(cdns->dev, sizeof(*rdrv), GFP_KERNEL);
132 if (!rdrv)
133 return -ENOMEM;
134
135 rdrv->start = __cdns_host_init;
136 rdrv->stop = cdns_host_exit;
137 rdrv->state = CDNS_ROLE_STATE_INACTIVE;
138 rdrv->name = "host";
139
140 cdns->roles[USB_ROLE_HOST] = rdrv;
141
142 return 0;
143 }
144