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