Commit | Line | Data |
---|---|---|
eb70e5ab AS |
1 | /* |
2 | * host.c - ChipIdea USB host controller driver | |
3 | * | |
4 | * Copyright (c) 2012 Intel Corporation | |
5 | * | |
6 | * Author: Alexander Shishkin | |
7 | * | |
8 | * This program is free software; you can redistribute it and/or modify | |
9 | * it under the terms of the GNU General Public License version 2 as | |
10 | * published by the Free Software Foundation. | |
11 | * | |
12 | * This program is distributed in the hope that it will be useful, | |
13 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
14 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
15 | * GNU General Public License for more details. | |
16 | * | |
17 | * You should have received a copy of the GNU General Public License | |
18 | * along with this program; if not, write to the Free Software | |
19 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
20 | */ | |
21 | ||
22 | #include <linux/kernel.h> | |
cdb2fac7 | 23 | #include <linux/io.h> |
eb70e5ab AS |
24 | #include <linux/usb.h> |
25 | #include <linux/usb/hcd.h> | |
26 | #include <linux/usb/chipidea.h> | |
40ed51a4 | 27 | #include <linux/regulator/consumer.h> |
eb70e5ab | 28 | |
09f6ffde | 29 | #include "../host/ehci.h" |
eb70e5ab AS |
30 | |
31 | #include "ci.h" | |
32 | #include "bits.h" | |
33 | #include "host.h" | |
34 | ||
09f6ffde | 35 | static struct hc_driver __read_mostly ci_ehci_hc_driver; |
78f0357e | 36 | static int (*orig_bus_suspend)(struct usb_hcd *hcd); |
09f6ffde | 37 | |
c8679a2f MG |
38 | struct ehci_ci_priv { |
39 | struct regulator *reg_vbus; | |
40 | }; | |
41 | ||
42 | static int ehci_ci_portpower(struct usb_hcd *hcd, int portnum, bool enable) | |
43 | { | |
44 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
45 | struct ehci_ci_priv *priv = (struct ehci_ci_priv *)ehci->priv; | |
46 | struct device *dev = hcd->self.controller; | |
c8679a2f MG |
47 | int ret = 0; |
48 | int port = HCS_N_PORTS(ehci->hcs_params); | |
49 | ||
65945917 | 50 | if (priv->reg_vbus) { |
c8679a2f MG |
51 | if (port > 1) { |
52 | dev_warn(dev, | |
53 | "Not support multi-port regulator control\n"); | |
54 | return 0; | |
55 | } | |
56 | if (enable) | |
57 | ret = regulator_enable(priv->reg_vbus); | |
58 | else | |
59 | ret = regulator_disable(priv->reg_vbus); | |
60 | if (ret) { | |
61 | dev_err(dev, | |
62 | "Failed to %s vbus regulator, ret=%d\n", | |
63 | enable ? "enable" : "disable", ret); | |
64 | return ret; | |
65 | } | |
66 | } | |
67 | return 0; | |
68 | }; | |
69 | ||
70 | static const struct ehci_driver_overrides ehci_ci_overrides = { | |
71 | .extra_priv_size = sizeof(struct ehci_ci_priv), | |
72 | .port_power = ehci_ci_portpower, | |
73 | }; | |
74 | ||
8e22978c | 75 | static irqreturn_t host_irq(struct ci_hdrc *ci) |
eb70e5ab AS |
76 | { |
77 | return usb_hcd_irq(ci->irq, ci->hcd); | |
78 | } | |
79 | ||
8e22978c | 80 | static int host_start(struct ci_hdrc *ci) |
eb70e5ab AS |
81 | { |
82 | struct usb_hcd *hcd; | |
83 | struct ehci_hcd *ehci; | |
c8679a2f | 84 | struct ehci_ci_priv *priv; |
eb70e5ab AS |
85 | int ret; |
86 | ||
87 | if (usb_disabled()) | |
88 | return -ENODEV; | |
89 | ||
90 | hcd = usb_create_hcd(&ci_ehci_hc_driver, ci->dev, dev_name(ci->dev)); | |
91 | if (!hcd) | |
92 | return -ENOMEM; | |
93 | ||
24c498df | 94 | dev_set_drvdata(ci->dev, ci); |
eb70e5ab AS |
95 | hcd->rsrc_start = ci->hw_bank.phys; |
96 | hcd->rsrc_len = ci->hw_bank.size; | |
97 | hcd->regs = ci->hw_bank.abs; | |
98 | hcd->has_tt = 1; | |
99 | ||
77c4400f | 100 | hcd->power_budget = ci->platdata->power_budget; |
f6a9ff07 | 101 | hcd->tpl_support = ci->platdata->tpl_support; |
1e5e2d3d AT |
102 | if (ci->phy) |
103 | hcd->phy = ci->phy; | |
104 | else | |
105 | hcd->usb_phy = ci->usb_phy; | |
bd841986 | 106 | |
eb70e5ab AS |
107 | ehci = hcd_to_ehci(hcd); |
108 | ehci->caps = ci->hw_bank.cap; | |
109 | ehci->has_hostpc = ci->hw_bank.lpm; | |
2cdcec4f | 110 | ehci->has_tdi_phy_lpm = ci->hw_bank.lpm; |
ed8f8318 | 111 | ehci->imx28_write_fix = ci->imx28_write_fix; |
eb70e5ab | 112 | |
c8679a2f MG |
113 | priv = (struct ehci_ci_priv *)ehci->priv; |
114 | priv->reg_vbus = NULL; | |
115 | ||
65945917 LJ |
116 | if (ci->platdata->reg_vbus && !ci_otg_is_fsm_mode(ci)) { |
117 | if (ci->platdata->flags & CI_HDRC_TURN_VBUS_EARLY_ON) { | |
118 | ret = regulator_enable(ci->platdata->reg_vbus); | |
119 | if (ret) { | |
120 | dev_err(ci->dev, | |
121 | "Failed to enable vbus regulator, ret=%d\n", | |
122 | ret); | |
123 | goto put_hcd; | |
124 | } | |
125 | } else { | |
126 | priv->reg_vbus = ci->platdata->reg_vbus; | |
127 | } | |
128 | } | |
40ed51a4 | 129 | |
eb70e5ab | 130 | ret = usb_add_hcd(hcd, 0, 0); |
0698b9b3 | 131 | if (ret) { |
65945917 | 132 | goto disable_reg; |
0698b9b3 | 133 | } else { |
ef44cb42 | 134 | struct usb_otg *otg = &ci->otg; |
0698b9b3 | 135 | |
eb70e5ab | 136 | ci->hcd = hcd; |
ef44cb42 AT |
137 | |
138 | if (ci_otg_is_fsm_mode(ci)) { | |
0698b9b3 LJ |
139 | otg->host = &hcd->self; |
140 | hcd->self.otg_port = 1; | |
141 | } | |
142 | } | |
eb70e5ab | 143 | |
8e22978c | 144 | if (ci->platdata->flags & CI_HDRC_DISABLE_STREAMING) |
929473ea FE |
145 | hw_write(ci, OP_USBMODE, USBMODE_CI_SDIS, USBMODE_CI_SDIS); |
146 | ||
905276c4 DT |
147 | if (ci->platdata->flags & CI_HDRC_FORCE_FULLSPEED) |
148 | hw_write(ci, OP_PORTSC, PORTSC_PFSC, PORTSC_PFSC); | |
149 | ||
eb70e5ab | 150 | return ret; |
40ed51a4 | 151 | |
65945917 LJ |
152 | disable_reg: |
153 | if (ci->platdata->reg_vbus && !ci_otg_is_fsm_mode(ci) && | |
154 | (ci->platdata->flags & CI_HDRC_TURN_VBUS_EARLY_ON)) | |
155 | regulator_disable(ci->platdata->reg_vbus); | |
40ed51a4 PC |
156 | put_hcd: |
157 | usb_put_hcd(hcd); | |
158 | ||
159 | return ret; | |
eb70e5ab AS |
160 | } |
161 | ||
8e22978c | 162 | static void host_stop(struct ci_hdrc *ci) |
eb70e5ab AS |
163 | { |
164 | struct usb_hcd *hcd = ci->hcd; | |
165 | ||
41314fea RKAL |
166 | if (hcd) { |
167 | usb_remove_hcd(hcd); | |
168 | usb_put_hcd(hcd); | |
65945917 LJ |
169 | if (ci->platdata->reg_vbus && !ci_otg_is_fsm_mode(ci) && |
170 | (ci->platdata->flags & CI_HDRC_TURN_VBUS_EARLY_ON)) | |
171 | regulator_disable(ci->platdata->reg_vbus); | |
41314fea | 172 | } |
eb70e5ab AS |
173 | } |
174 | ||
3f124d23 PC |
175 | |
176 | void ci_hdrc_host_destroy(struct ci_hdrc *ci) | |
177 | { | |
df101c53 | 178 | if (ci->role == CI_ROLE_HOST && ci->hcd) |
3f124d23 PC |
179 | host_stop(ci); |
180 | } | |
181 | ||
78f0357e PC |
182 | static int ci_ehci_bus_suspend(struct usb_hcd *hcd) |
183 | { | |
184 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); | |
185 | int port; | |
186 | u32 tmp; | |
187 | ||
188 | int ret = orig_bus_suspend(hcd); | |
189 | ||
190 | if (ret) | |
191 | return ret; | |
192 | ||
193 | port = HCS_N_PORTS(ehci->hcs_params); | |
194 | while (port--) { | |
195 | u32 __iomem *reg = &ehci->regs->port_status[port]; | |
196 | u32 portsc = ehci_readl(ehci, reg); | |
197 | ||
198 | if (portsc & PORT_CONNECT) { | |
199 | /* | |
200 | * For chipidea, the resume signal will be ended | |
201 | * automatically, so for remote wakeup case, the | |
202 | * usbcmd.rs may not be set before the resume has | |
203 | * ended if other resume paths consumes too much | |
204 | * time (~24ms), in that case, the SOF will not | |
205 | * send out within 3ms after resume ends, then the | |
206 | * high speed device will enter full speed mode. | |
207 | */ | |
208 | ||
209 | tmp = ehci_readl(ehci, &ehci->regs->command); | |
210 | tmp |= CMD_RUN; | |
211 | ehci_writel(ehci, tmp, &ehci->regs->command); | |
212 | /* | |
213 | * It needs a short delay between set RS bit and PHCD. | |
214 | */ | |
215 | usleep_range(150, 200); | |
216 | break; | |
217 | } | |
218 | } | |
219 | ||
220 | return 0; | |
221 | } | |
222 | ||
8e22978c | 223 | int ci_hdrc_host_init(struct ci_hdrc *ci) |
eb70e5ab AS |
224 | { |
225 | struct ci_role_driver *rdrv; | |
226 | ||
227 | if (!hw_read(ci, CAP_DCCPARAMS, DCCPARAMS_HC)) | |
228 | return -ENXIO; | |
229 | ||
230 | rdrv = devm_kzalloc(ci->dev, sizeof(struct ci_role_driver), GFP_KERNEL); | |
231 | if (!rdrv) | |
232 | return -ENOMEM; | |
233 | ||
234 | rdrv->start = host_start; | |
235 | rdrv->stop = host_stop; | |
236 | rdrv->irq = host_irq; | |
237 | rdrv->name = "host"; | |
238 | ci->roles[CI_ROLE_HOST] = rdrv; | |
239 | ||
c8679a2f | 240 | ehci_init_driver(&ci_ehci_hc_driver, &ehci_ci_overrides); |
78f0357e PC |
241 | orig_bus_suspend = ci_ehci_hc_driver.bus_suspend; |
242 | ci_ehci_hc_driver.bus_suspend = ci_ehci_bus_suspend; | |
09f6ffde | 243 | |
eb70e5ab AS |
244 | return 0; |
245 | } |