1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * host.c - ChipIdea USB host controller driver
4 *
5 * Copyright (c) 2012 Intel Corporation
6 *
7 * Author: Alexander Shishkin
8 */
9
10 #include <linux/kernel.h>
11 #include <linux/io.h>
12 #include <linux/usb.h>
13 #include <linux/usb/hcd.h>
14 #include <linux/usb/chipidea.h>
15 #include <linux/regulator/consumer.h>
16
17 #include "../host/ehci.h"
18
19 #include "ci.h"
20 #include "bits.h"
21 #include "host.h"
22
23 static struct hc_driver __read_mostly ci_ehci_hc_driver;
24 static int (*orig_bus_suspend)(struct usb_hcd *hcd);
25
26 struct ehci_ci_priv {
27 struct regulator *reg_vbus;
28 bool enabled;
29 };
30
ehci_ci_portpower(struct usb_hcd * hcd,int portnum,bool enable)31 static int ehci_ci_portpower(struct usb_hcd *hcd, int portnum, bool enable)
32 {
33 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
34 struct ehci_ci_priv *priv = (struct ehci_ci_priv *)ehci->priv;
35 struct device *dev = hcd->self.controller;
36 struct ci_hdrc *ci = dev_get_drvdata(dev);
37 int ret = 0;
38 int port = HCS_N_PORTS(ehci->hcs_params);
39
40 if (priv->reg_vbus && enable != priv->enabled) {
41 if (port > 1) {
42 dev_warn(dev,
43 "Not support multi-port regulator control\n");
44 return 0;
45 }
46 if (enable)
47 ret = regulator_enable(priv->reg_vbus);
48 else
49 ret = regulator_disable(priv->reg_vbus);
50 if (ret) {
51 dev_err(dev,
52 "Failed to %s vbus regulator, ret=%d\n",
53 enable ? "enable" : "disable", ret);
54 return ret;
55 }
56 priv->enabled = enable;
57 }
58
59 if (enable && (ci->platdata->phy_mode == USBPHY_INTERFACE_MODE_HSIC)) {
60 /*
61 * Marvell 28nm HSIC PHY requires forcing the port to HS mode.
62 * As HSIC is always HS, this should be safe for others.
63 */
64 hw_port_test_set(ci, 5);
65 hw_port_test_set(ci, 0);
66 }
67 return 0;
68 };
69
ehci_ci_reset(struct usb_hcd * hcd)70 static int ehci_ci_reset(struct usb_hcd *hcd)
71 {
72 struct device *dev = hcd->self.controller;
73 struct ci_hdrc *ci = dev_get_drvdata(dev);
74 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
75 int ret;
76
77 ret = ehci_setup(hcd);
78 if (ret)
79 return ret;
80
81 ehci->need_io_watchdog = 0;
82
83 if (ci->platdata->notify_event) {
84 ret = ci->platdata->notify_event(ci,
85 CI_HDRC_CONTROLLER_RESET_EVENT);
86 if (ret)
87 return ret;
88 }
89
90 ci_platform_configure(ci);
91
92 return ret;
93 }
94
95 static const struct ehci_driver_overrides ehci_ci_overrides = {
96 .extra_priv_size = sizeof(struct ehci_ci_priv),
97 .port_power = ehci_ci_portpower,
98 .reset = ehci_ci_reset,
99 };
100
host_irq(struct ci_hdrc * ci)101 static irqreturn_t host_irq(struct ci_hdrc *ci)
102 {
103 return usb_hcd_irq(ci->irq, ci->hcd);
104 }
105
host_start(struct ci_hdrc * ci)106 static int host_start(struct ci_hdrc *ci)
107 {
108 struct usb_hcd *hcd;
109 struct ehci_hcd *ehci;
110 struct ehci_ci_priv *priv;
111 int ret;
112
113 if (usb_disabled())
114 return -ENODEV;
115
116 hcd = __usb_create_hcd(&ci_ehci_hc_driver, ci->dev->parent,
117 ci->dev, dev_name(ci->dev), NULL);
118 if (!hcd)
119 return -ENOMEM;
120
121 dev_set_drvdata(ci->dev, ci);
122 hcd->rsrc_start = ci->hw_bank.phys;
123 hcd->rsrc_len = ci->hw_bank.size;
124 hcd->regs = ci->hw_bank.abs;
125 hcd->has_tt = 1;
126
127 hcd->power_budget = ci->platdata->power_budget;
128 hcd->tpl_support = ci->platdata->tpl_support;
129 if (ci->phy || ci->usb_phy) {
130 hcd->skip_phy_initialization = 1;
131 if (ci->usb_phy)
132 hcd->usb_phy = ci->usb_phy;
133 }
134
135 ehci = hcd_to_ehci(hcd);
136 ehci->caps = ci->hw_bank.cap;
137 ehci->has_hostpc = ci->hw_bank.lpm;
138 ehci->has_tdi_phy_lpm = ci->hw_bank.lpm;
139 ehci->imx28_write_fix = ci->imx28_write_fix;
140
141 priv = (struct ehci_ci_priv *)ehci->priv;
142 priv->reg_vbus = NULL;
143
144 if (ci->platdata->reg_vbus && !ci_otg_is_fsm_mode(ci)) {
145 if (ci->platdata->flags & CI_HDRC_TURN_VBUS_EARLY_ON) {
146 ret = regulator_enable(ci->platdata->reg_vbus);
147 if (ret) {
148 dev_err(ci->dev,
149 "Failed to enable vbus regulator, ret=%d\n",
150 ret);
151 goto put_hcd;
152 }
153 } else {
154 priv->reg_vbus = ci->platdata->reg_vbus;
155 }
156 }
157
158 ret = usb_add_hcd(hcd, 0, 0);
159 if (ret) {
160 goto disable_reg;
161 } else {
162 struct usb_otg *otg = &ci->otg;
163
164 ci->hcd = hcd;
165
166 if (ci_otg_is_fsm_mode(ci)) {
167 otg->host = &hcd->self;
168 hcd->self.otg_port = 1;
169 }
170 }
171
172 return ret;
173
174 disable_reg:
175 if (ci->platdata->reg_vbus && !ci_otg_is_fsm_mode(ci) &&
176 (ci->platdata->flags & CI_HDRC_TURN_VBUS_EARLY_ON))
177 regulator_disable(ci->platdata->reg_vbus);
178 put_hcd:
179 usb_put_hcd(hcd);
180
181 return ret;
182 }
183
host_stop(struct ci_hdrc * ci)184 static void host_stop(struct ci_hdrc *ci)
185 {
186 struct usb_hcd *hcd = ci->hcd;
187
188 if (hcd) {
189 if (ci->platdata->notify_event)
190 ci->platdata->notify_event(ci,
191 CI_HDRC_CONTROLLER_STOPPED_EVENT);
192 usb_remove_hcd(hcd);
193 ci->role = CI_ROLE_END;
194 synchronize_irq(ci->irq);
195 usb_put_hcd(hcd);
196 if (ci->platdata->reg_vbus && !ci_otg_is_fsm_mode(ci) &&
197 (ci->platdata->flags & CI_HDRC_TURN_VBUS_EARLY_ON))
198 regulator_disable(ci->platdata->reg_vbus);
199 }
200 ci->hcd = NULL;
201 ci->otg.host = NULL;
202 }
203
204
ci_hdrc_host_destroy(struct ci_hdrc * ci)205 void ci_hdrc_host_destroy(struct ci_hdrc *ci)
206 {
207 if (ci->role == CI_ROLE_HOST && ci->hcd)
208 host_stop(ci);
209 }
210
ci_ehci_bus_suspend(struct usb_hcd * hcd)211 static int ci_ehci_bus_suspend(struct usb_hcd *hcd)
212 {
213 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
214 int port;
215 u32 tmp;
216
217 int ret = orig_bus_suspend(hcd);
218
219 if (ret)
220 return ret;
221
222 port = HCS_N_PORTS(ehci->hcs_params);
223 while (port--) {
224 u32 __iomem *reg = &ehci->regs->port_status[port];
225 u32 portsc = ehci_readl(ehci, reg);
226
227 if (portsc & PORT_CONNECT) {
228 /*
229 * For chipidea, the resume signal will be ended
230 * automatically, so for remote wakeup case, the
231 * usbcmd.rs may not be set before the resume has
232 * ended if other resume paths consumes too much
233 * time (~24ms), in that case, the SOF will not
234 * send out within 3ms after resume ends, then the
235 * high speed device will enter full speed mode.
236 */
237
238 tmp = ehci_readl(ehci, &ehci->regs->command);
239 tmp |= CMD_RUN;
240 ehci_writel(ehci, tmp, &ehci->regs->command);
241 /*
242 * It needs a short delay between set RS bit and PHCD.
243 */
244 usleep_range(150, 200);
245 break;
246 }
247 }
248
249 return 0;
250 }
251
ci_hdrc_host_init(struct ci_hdrc * ci)252 int ci_hdrc_host_init(struct ci_hdrc *ci)
253 {
254 struct ci_role_driver *rdrv;
255
256 if (!hw_read(ci, CAP_DCCPARAMS, DCCPARAMS_HC))
257 return -ENXIO;
258
259 rdrv = devm_kzalloc(ci->dev, sizeof(struct ci_role_driver), GFP_KERNEL);
260 if (!rdrv)
261 return -ENOMEM;
262
263 rdrv->start = host_start;
264 rdrv->stop = host_stop;
265 rdrv->irq = host_irq;
266 rdrv->name = "host";
267 ci->roles[CI_ROLE_HOST] = rdrv;
268
269 return 0;
270 }
271
ci_hdrc_host_driver_init(void)272 void ci_hdrc_host_driver_init(void)
273 {
274 ehci_init_driver(&ci_ehci_hc_driver, &ehci_ci_overrides);
275 orig_bus_suspend = ci_ehci_hc_driver.bus_suspend;
276 ci_ehci_hc_driver.bus_suspend = ci_ehci_bus_suspend;
277 }
278