]>
Commit | Line | Data |
---|---|---|
3a082ec9 NZ |
1 | /* |
2 | * Copyright (C) 2011 Marvell International Ltd. All rights reserved. | |
3 | * Author: Chao Xie <chao.xie@marvell.com> | |
4 | * Neil Zhang <zhangwm@marvell.com> | |
5 | * | |
6 | * This program is free software; you can redistribute it and/or modify it | |
7 | * under the terms of the GNU General Public License as published by the | |
8 | * Free Software Foundation; either version 2 of the License, or (at your | |
9 | * option) any later version. | |
10 | */ | |
11 | ||
12 | #include <linux/kernel.h> | |
13 | #include <linux/module.h> | |
14 | #include <linux/platform_device.h> | |
15 | #include <linux/clk.h> | |
ded017ee | 16 | #include <linux/err.h> |
3a082ec9 NZ |
17 | #include <linux/usb/otg.h> |
18 | #include <linux/platform_data/mv_usb.h> | |
19 | ||
20 | #define CAPLENGTH_MASK (0xff) | |
21 | ||
22 | struct ehci_hcd_mv { | |
23 | struct usb_hcd *hcd; | |
24 | ||
25 | /* Which mode does this ehci running OTG/Host ? */ | |
26 | int mode; | |
27 | ||
28 | void __iomem *phy_regs; | |
29 | void __iomem *cap_regs; | |
30 | void __iomem *op_regs; | |
31 | ||
86753811 | 32 | struct usb_phy *otg; |
3a082ec9 NZ |
33 | |
34 | struct mv_usb_platform_data *pdata; | |
35 | ||
36 | /* clock source and total clock number */ | |
37 | unsigned int clknum; | |
38 | struct clk *clk[0]; | |
39 | }; | |
40 | ||
41 | static void ehci_clock_enable(struct ehci_hcd_mv *ehci_mv) | |
42 | { | |
43 | unsigned int i; | |
44 | ||
45 | for (i = 0; i < ehci_mv->clknum; i++) | |
46 | clk_enable(ehci_mv->clk[i]); | |
47 | } | |
48 | ||
49 | static void ehci_clock_disable(struct ehci_hcd_mv *ehci_mv) | |
50 | { | |
51 | unsigned int i; | |
52 | ||
53 | for (i = 0; i < ehci_mv->clknum; i++) | |
54 | clk_disable(ehci_mv->clk[i]); | |
55 | } | |
56 | ||
57 | static int mv_ehci_enable(struct ehci_hcd_mv *ehci_mv) | |
58 | { | |
59 | int retval; | |
60 | ||
61 | ehci_clock_enable(ehci_mv); | |
62 | if (ehci_mv->pdata->phy_init) { | |
63 | retval = ehci_mv->pdata->phy_init(ehci_mv->phy_regs); | |
64 | if (retval) | |
65 | return retval; | |
66 | } | |
67 | ||
68 | return 0; | |
69 | } | |
70 | ||
71 | static void mv_ehci_disable(struct ehci_hcd_mv *ehci_mv) | |
72 | { | |
73 | if (ehci_mv->pdata->phy_deinit) | |
74 | ehci_mv->pdata->phy_deinit(ehci_mv->phy_regs); | |
75 | ehci_clock_disable(ehci_mv); | |
76 | } | |
77 | ||
78 | static int mv_ehci_reset(struct usb_hcd *hcd) | |
79 | { | |
3a082ec9 NZ |
80 | struct device *dev = hcd->self.controller; |
81 | struct ehci_hcd_mv *ehci_mv = dev_get_drvdata(dev); | |
82 | int retval; | |
83 | ||
84 | if (ehci_mv == NULL) { | |
85 | dev_err(dev, "Can not find private ehci data\n"); | |
86 | return -ENODEV; | |
87 | } | |
88 | ||
3a082ec9 | 89 | hcd->has_tt = 1; |
3a082ec9 | 90 | |
1a49e2ac AS |
91 | retval = ehci_setup(hcd); |
92 | if (retval) | |
93 | dev_err(dev, "ehci_setup failed %d\n", retval); | |
3a082ec9 | 94 | |
1a49e2ac | 95 | return retval; |
3a082ec9 NZ |
96 | } |
97 | ||
98 | static const struct hc_driver mv_ehci_hc_driver = { | |
99 | .description = hcd_name, | |
100 | .product_desc = "Marvell EHCI", | |
101 | .hcd_priv_size = sizeof(struct ehci_hcd), | |
102 | ||
103 | /* | |
104 | * generic hardware linkage | |
105 | */ | |
106 | .irq = ehci_irq, | |
107 | .flags = HCD_MEMORY | HCD_USB2, | |
108 | ||
109 | /* | |
110 | * basic lifecycle operations | |
111 | */ | |
112 | .reset = mv_ehci_reset, | |
113 | .start = ehci_run, | |
114 | .stop = ehci_stop, | |
115 | .shutdown = ehci_shutdown, | |
116 | ||
117 | /* | |
118 | * managing i/o requests and associated device resources | |
119 | */ | |
120 | .urb_enqueue = ehci_urb_enqueue, | |
121 | .urb_dequeue = ehci_urb_dequeue, | |
122 | .endpoint_disable = ehci_endpoint_disable, | |
123 | .endpoint_reset = ehci_endpoint_reset, | |
124 | .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete, | |
125 | ||
126 | /* | |
127 | * scheduling support | |
128 | */ | |
129 | .get_frame_number = ehci_get_frame, | |
130 | ||
131 | /* | |
132 | * root hub support | |
133 | */ | |
134 | .hub_status_data = ehci_hub_status_data, | |
135 | .hub_control = ehci_hub_control, | |
136 | .bus_suspend = ehci_bus_suspend, | |
137 | .bus_resume = ehci_bus_resume, | |
138 | }; | |
139 | ||
140 | static int mv_ehci_probe(struct platform_device *pdev) | |
141 | { | |
142 | struct mv_usb_platform_data *pdata = pdev->dev.platform_data; | |
143 | struct usb_hcd *hcd; | |
144 | struct ehci_hcd *ehci; | |
145 | struct ehci_hcd_mv *ehci_mv; | |
146 | struct resource *r; | |
147 | int clk_i, retval = -ENODEV; | |
148 | u32 offset; | |
149 | size_t size; | |
150 | ||
151 | if (!pdata) { | |
152 | dev_err(&pdev->dev, "missing platform_data\n"); | |
153 | return -ENODEV; | |
154 | } | |
155 | ||
156 | if (usb_disabled()) | |
157 | return -ENODEV; | |
158 | ||
159 | hcd = usb_create_hcd(&mv_ehci_hc_driver, &pdev->dev, "mv ehci"); | |
160 | if (!hcd) | |
161 | return -ENOMEM; | |
162 | ||
163 | size = sizeof(*ehci_mv) + sizeof(struct clk *) * pdata->clknum; | |
164 | ehci_mv = kzalloc(size, GFP_KERNEL); | |
165 | if (ehci_mv == NULL) { | |
166 | dev_err(&pdev->dev, "cannot allocate ehci_hcd_mv\n"); | |
167 | retval = -ENOMEM; | |
168 | goto err_put_hcd; | |
169 | } | |
170 | ||
171 | platform_set_drvdata(pdev, ehci_mv); | |
172 | ehci_mv->pdata = pdata; | |
173 | ehci_mv->hcd = hcd; | |
174 | ||
175 | ehci_mv->clknum = pdata->clknum; | |
176 | for (clk_i = 0; clk_i < ehci_mv->clknum; clk_i++) { | |
177 | ehci_mv->clk[clk_i] = | |
178 | clk_get(&pdev->dev, pdata->clkname[clk_i]); | |
179 | if (IS_ERR(ehci_mv->clk[clk_i])) { | |
180 | dev_err(&pdev->dev, "error get clck \"%s\"\n", | |
181 | pdata->clkname[clk_i]); | |
182 | retval = PTR_ERR(ehci_mv->clk[clk_i]); | |
183 | goto err_put_clk; | |
184 | } | |
185 | } | |
186 | ||
187 | r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "phyregs"); | |
188 | if (r == NULL) { | |
189 | dev_err(&pdev->dev, "no phy I/O memory resource defined\n"); | |
190 | retval = -ENODEV; | |
191 | goto err_put_clk; | |
192 | } | |
193 | ||
194 | ehci_mv->phy_regs = ioremap(r->start, resource_size(r)); | |
195 | if (ehci_mv->phy_regs == 0) { | |
196 | dev_err(&pdev->dev, "failed to map phy I/O memory\n"); | |
197 | retval = -EFAULT; | |
198 | goto err_put_clk; | |
199 | } | |
200 | ||
201 | r = platform_get_resource_byname(pdev, IORESOURCE_MEM, "capregs"); | |
202 | if (!r) { | |
203 | dev_err(&pdev->dev, "no I/O memory resource defined\n"); | |
204 | retval = -ENODEV; | |
205 | goto err_iounmap_phyreg; | |
206 | } | |
207 | ||
208 | ehci_mv->cap_regs = ioremap(r->start, resource_size(r)); | |
209 | if (ehci_mv->cap_regs == NULL) { | |
210 | dev_err(&pdev->dev, "failed to map I/O memory\n"); | |
211 | retval = -EFAULT; | |
212 | goto err_iounmap_phyreg; | |
213 | } | |
214 | ||
215 | retval = mv_ehci_enable(ehci_mv); | |
216 | if (retval) { | |
217 | dev_err(&pdev->dev, "init phy error %d\n", retval); | |
218 | goto err_iounmap_capreg; | |
219 | } | |
220 | ||
221 | offset = readl(ehci_mv->cap_regs) & CAPLENGTH_MASK; | |
222 | ehci_mv->op_regs = | |
223 | (void __iomem *) ((unsigned long) ehci_mv->cap_regs + offset); | |
224 | ||
225 | hcd->rsrc_start = r->start; | |
226 | hcd->rsrc_len = r->end - r->start + 1; | |
227 | hcd->regs = ehci_mv->op_regs; | |
228 | ||
229 | hcd->irq = platform_get_irq(pdev, 0); | |
230 | if (!hcd->irq) { | |
231 | dev_err(&pdev->dev, "Cannot get irq."); | |
232 | retval = -ENODEV; | |
233 | goto err_disable_clk; | |
234 | } | |
235 | ||
236 | ehci = hcd_to_ehci(hcd); | |
237 | ehci->caps = (struct ehci_caps *) ehci_mv->cap_regs; | |
3a082ec9 NZ |
238 | |
239 | ehci_mv->mode = pdata->mode; | |
240 | if (ehci_mv->mode == MV_USB_MODE_OTG) { | |
241 | #ifdef CONFIG_USB_OTG_UTILS | |
662dca54 | 242 | ehci_mv->otg = usb_get_phy(USB_PHY_TYPE_USB2); |
ded017ee | 243 | if (IS_ERR_OR_NULL(ehci_mv->otg)) { |
3a082ec9 NZ |
244 | dev_err(&pdev->dev, |
245 | "unable to find transceiver\n"); | |
246 | retval = -ENODEV; | |
247 | goto err_disable_clk; | |
248 | } | |
249 | ||
6e13c650 | 250 | retval = otg_set_host(ehci_mv->otg->otg, &hcd->self); |
3a082ec9 NZ |
251 | if (retval < 0) { |
252 | dev_err(&pdev->dev, | |
253 | "unable to register with transceiver\n"); | |
254 | retval = -ENODEV; | |
255 | goto err_put_transceiver; | |
256 | } | |
257 | /* otg will enable clock before use as host */ | |
258 | mv_ehci_disable(ehci_mv); | |
259 | #else | |
260 | dev_info(&pdev->dev, "MV_USB_MODE_OTG " | |
261 | "must have CONFIG_USB_OTG_UTILS enabled\n"); | |
262 | goto err_disable_clk; | |
263 | #endif | |
264 | } else { | |
265 | if (pdata->set_vbus) | |
266 | pdata->set_vbus(1); | |
267 | ||
268 | retval = usb_add_hcd(hcd, hcd->irq, IRQF_SHARED); | |
269 | if (retval) { | |
270 | dev_err(&pdev->dev, | |
271 | "failed to add hcd with err %d\n", retval); | |
272 | goto err_set_vbus; | |
273 | } | |
274 | } | |
275 | ||
276 | if (pdata->private_init) | |
277 | pdata->private_init(ehci_mv->op_regs, ehci_mv->phy_regs); | |
278 | ||
279 | dev_info(&pdev->dev, | |
280 | "successful find EHCI device with regs 0x%p irq %d" | |
281 | " working in %s mode\n", hcd->regs, hcd->irq, | |
282 | ehci_mv->mode == MV_USB_MODE_OTG ? "OTG" : "Host"); | |
283 | ||
284 | return 0; | |
285 | ||
286 | err_set_vbus: | |
287 | if (pdata->set_vbus) | |
288 | pdata->set_vbus(0); | |
289 | #ifdef CONFIG_USB_OTG_UTILS | |
290 | err_put_transceiver: | |
ded017ee | 291 | if (!IS_ERR_OR_NULL(ehci_mv->otg)) |
721002ec | 292 | usb_put_phy(ehci_mv->otg); |
3a082ec9 NZ |
293 | #endif |
294 | err_disable_clk: | |
295 | mv_ehci_disable(ehci_mv); | |
296 | err_iounmap_capreg: | |
297 | iounmap(ehci_mv->cap_regs); | |
298 | err_iounmap_phyreg: | |
299 | iounmap(ehci_mv->phy_regs); | |
300 | err_put_clk: | |
301 | for (clk_i--; clk_i >= 0; clk_i--) | |
302 | clk_put(ehci_mv->clk[clk_i]); | |
303 | platform_set_drvdata(pdev, NULL); | |
304 | kfree(ehci_mv); | |
305 | err_put_hcd: | |
306 | usb_put_hcd(hcd); | |
307 | ||
308 | return retval; | |
309 | } | |
310 | ||
311 | static int mv_ehci_remove(struct platform_device *pdev) | |
312 | { | |
313 | struct ehci_hcd_mv *ehci_mv = platform_get_drvdata(pdev); | |
314 | struct usb_hcd *hcd = ehci_mv->hcd; | |
315 | int clk_i; | |
316 | ||
317 | if (hcd->rh_registered) | |
318 | usb_remove_hcd(hcd); | |
319 | ||
ded017ee | 320 | if (!IS_ERR_OR_NULL(ehci_mv->otg)) { |
6e13c650 | 321 | otg_set_host(ehci_mv->otg->otg, NULL); |
721002ec | 322 | usb_put_phy(ehci_mv->otg); |
3a082ec9 NZ |
323 | } |
324 | ||
325 | if (ehci_mv->mode == MV_USB_MODE_HOST) { | |
326 | if (ehci_mv->pdata->set_vbus) | |
327 | ehci_mv->pdata->set_vbus(0); | |
328 | ||
329 | mv_ehci_disable(ehci_mv); | |
330 | } | |
331 | ||
332 | iounmap(ehci_mv->cap_regs); | |
333 | iounmap(ehci_mv->phy_regs); | |
334 | ||
335 | for (clk_i = 0; clk_i < ehci_mv->clknum; clk_i++) | |
336 | clk_put(ehci_mv->clk[clk_i]); | |
337 | ||
338 | platform_set_drvdata(pdev, NULL); | |
339 | ||
340 | kfree(ehci_mv); | |
341 | usb_put_hcd(hcd); | |
342 | ||
343 | return 0; | |
344 | } | |
345 | ||
346 | MODULE_ALIAS("mv-ehci"); | |
347 | ||
348 | static const struct platform_device_id ehci_id_table[] = { | |
349 | {"pxa-u2oehci", PXA_U2OEHCI}, | |
350 | {"pxa-sph", PXA_SPH}, | |
351 | {"mmp3-hsic", MMP3_HSIC}, | |
352 | {"mmp3-fsic", MMP3_FSIC}, | |
353 | {}, | |
354 | }; | |
355 | ||
356 | static void mv_ehci_shutdown(struct platform_device *pdev) | |
357 | { | |
358 | struct ehci_hcd_mv *ehci_mv = platform_get_drvdata(pdev); | |
359 | struct usb_hcd *hcd = ehci_mv->hcd; | |
360 | ||
361 | if (!hcd->rh_registered) | |
362 | return; | |
363 | ||
364 | if (hcd->driver->shutdown) | |
365 | hcd->driver->shutdown(hcd); | |
366 | } | |
367 | ||
368 | static struct platform_driver ehci_mv_driver = { | |
369 | .probe = mv_ehci_probe, | |
370 | .remove = mv_ehci_remove, | |
371 | .shutdown = mv_ehci_shutdown, | |
372 | .driver = { | |
373 | .name = "mv-ehci", | |
374 | .bus = &platform_bus_type, | |
375 | }, | |
376 | .id_table = ehci_id_table, | |
377 | }; |