1 | // SPDX-License-Identifier: GPL-2.0 |
---|---|
2 | /* |
3 | * Generic platform ehci driver |
4 | * |
5 | * Copyright 2007 Steven Brown <sbrown@cortland.com> |
6 | * Copyright 2010-2012 Hauke Mehrtens <hauke@hauke-m.de> |
7 | * Copyright 2014 Hans de Goede <hdegoede@redhat.com> |
8 | * |
9 | * Derived from the ohci-ssb driver |
10 | * Copyright 2007 Michael Buesch <m@bues.ch> |
11 | * |
12 | * Derived from the EHCI-PCI driver |
13 | * Copyright (c) 2000-2004 by David Brownell |
14 | * |
15 | * Derived from the ohci-pci driver |
16 | * Copyright 1999 Roman Weissgaerber |
17 | * Copyright 2000-2002 David Brownell |
18 | * Copyright 1999 Linus Torvalds |
19 | * Copyright 1999 Gregory P. Smith |
20 | */ |
21 | #include <linux/acpi.h> |
22 | #include <linux/clk.h> |
23 | #include <linux/dma-mapping.h> |
24 | #include <linux/err.h> |
25 | #include <linux/kernel.h> |
26 | #include <linux/hrtimer.h> |
27 | #include <linux/io.h> |
28 | #include <linux/module.h> |
29 | #include <linux/of.h> |
30 | #include <linux/platform_device.h> |
31 | #include <linux/reset.h> |
32 | #include <linux/sys_soc.h> |
33 | #include <linux/timer.h> |
34 | #include <linux/usb.h> |
35 | #include <linux/usb/hcd.h> |
36 | #include <linux/usb/ehci_pdriver.h> |
37 | #include <linux/usb/of.h> |
38 | |
39 | #include "ehci.h" |
40 | |
41 | #define DRIVER_DESC "EHCI generic platform driver" |
42 | #define EHCI_MAX_CLKS 4 |
43 | #define hcd_to_ehci_priv(h) ((struct ehci_platform_priv *)hcd_to_ehci(h)->priv) |
44 | |
45 | #define BCM_USB_FIFO_THRESHOLD 0x00800040 |
46 | |
47 | struct ehci_platform_priv { |
48 | struct clk *clks[EHCI_MAX_CLKS]; |
49 | struct reset_control *rsts; |
50 | bool reset_on_resume; |
51 | bool quirk_poll; |
52 | struct timer_list poll_timer; |
53 | struct delayed_work poll_work; |
54 | }; |
55 | |
56 | static int ehci_platform_reset(struct usb_hcd *hcd) |
57 | { |
58 | struct platform_device *pdev = to_platform_device(hcd->self.controller); |
59 | struct usb_ehci_pdata *pdata = dev_get_platdata(dev: &pdev->dev); |
60 | struct ehci_hcd *ehci = hcd_to_ehci(hcd); |
61 | int retval; |
62 | |
63 | ehci->has_synopsys_hc_bug = pdata->has_synopsys_hc_bug; |
64 | |
65 | if (pdata->pre_setup) { |
66 | retval = pdata->pre_setup(hcd); |
67 | if (retval < 0) |
68 | return retval; |
69 | } |
70 | |
71 | ehci->caps = hcd->regs + pdata->caps_offset; |
72 | retval = ehci_setup(hcd); |
73 | if (retval) |
74 | return retval; |
75 | |
76 | if (pdata->no_io_watchdog) |
77 | ehci->need_io_watchdog = 0; |
78 | |
79 | if (of_device_is_compatible(device: pdev->dev.of_node, "brcm,xgs-iproc-ehci")) |
80 | ehci_writel(ehci, BCM_USB_FIFO_THRESHOLD, |
81 | regs: &ehci->regs->brcm_insnreg[1]); |
82 | |
83 | return 0; |
84 | } |
85 | |
86 | static int ehci_platform_power_on(struct platform_device *dev) |
87 | { |
88 | struct usb_hcd *hcd = platform_get_drvdata(pdev: dev); |
89 | struct ehci_platform_priv *priv = hcd_to_ehci_priv(hcd); |
90 | int clk, ret; |
91 | |
92 | for (clk = 0; clk < EHCI_MAX_CLKS && priv->clks[clk]; clk++) { |
93 | ret = clk_prepare_enable(clk: priv->clks[clk]); |
94 | if (ret) |
95 | goto err_disable_clks; |
96 | } |
97 | |
98 | return 0; |
99 | |
100 | err_disable_clks: |
101 | while (--clk >= 0) |
102 | clk_disable_unprepare(clk: priv->clks[clk]); |
103 | |
104 | return ret; |
105 | } |
106 | |
107 | static void ehci_platform_power_off(struct platform_device *dev) |
108 | { |
109 | struct usb_hcd *hcd = platform_get_drvdata(pdev: dev); |
110 | struct ehci_platform_priv *priv = hcd_to_ehci_priv(hcd); |
111 | int clk; |
112 | |
113 | for (clk = EHCI_MAX_CLKS - 1; clk >= 0; clk--) |
114 | if (priv->clks[clk]) |
115 | clk_disable_unprepare(clk: priv->clks[clk]); |
116 | } |
117 | |
118 | static struct hc_driver __read_mostly ehci_platform_hc_driver; |
119 | |
120 | static const struct ehci_driver_overrides platform_overrides __initconst = { |
121 | .reset = ehci_platform_reset, |
122 | .extra_priv_size = sizeof(struct ehci_platform_priv), |
123 | }; |
124 | |
125 | static struct usb_ehci_pdata ehci_platform_defaults = { |
126 | .power_on = ehci_platform_power_on, |
127 | .power_suspend = ehci_platform_power_off, |
128 | .power_off = ehci_platform_power_off, |
129 | }; |
130 | |
131 | /** |
132 | * quirk_poll_check_port_status - Poll port_status if the device sticks |
133 | * @ehci: the ehci hcd pointer |
134 | * |
135 | * Since EHCI/OHCI controllers on R-Car Gen3 SoCs are possible to be getting |
136 | * stuck very rarely after a full/low usb device was disconnected. To |
137 | * detect such a situation, the controllers require a special way which poll |
138 | * the EHCI PORTSC register. |
139 | * |
140 | * Return: true if the controller's port_status indicated getting stuck |
141 | */ |
142 | static bool quirk_poll_check_port_status(struct ehci_hcd *ehci) |
143 | { |
144 | u32 port_status = ehci_readl(ehci, regs: &ehci->regs->port_status[0]); |
145 | |
146 | if (!(port_status & PORT_OWNER) && |
147 | (port_status & PORT_POWER) && |
148 | !(port_status & PORT_CONNECT) && |
149 | (port_status & PORT_LS_MASK)) |
150 | return true; |
151 | |
152 | return false; |
153 | } |
154 | |
155 | /** |
156 | * quirk_poll_rebind_companion - rebind comanion device to recover |
157 | * @ehci: the ehci hcd pointer |
158 | * |
159 | * Since EHCI/OHCI controllers on R-Car Gen3 SoCs are possible to be getting |
160 | * stuck very rarely after a full/low usb device was disconnected. To |
161 | * recover from such a situation, the controllers require changing the OHCI |
162 | * functional state. |
163 | */ |
164 | static void quirk_poll_rebind_companion(struct ehci_hcd *ehci) |
165 | { |
166 | struct device *companion_dev; |
167 | struct usb_hcd *hcd = ehci_to_hcd(ehci); |
168 | |
169 | companion_dev = usb_of_get_companion_dev(dev: hcd->self.controller); |
170 | if (!companion_dev) |
171 | return; |
172 | |
173 | device_release_driver(dev: companion_dev); |
174 | if (device_attach(dev: companion_dev) < 0) |
175 | ehci_err(ehci, "%s: failed\n", __func__); |
176 | |
177 | put_device(dev: companion_dev); |
178 | } |
179 | |
180 | static void quirk_poll_work(struct work_struct *work) |
181 | { |
182 | struct ehci_platform_priv *priv = |
183 | container_of(to_delayed_work(work), struct ehci_platform_priv, |
184 | poll_work); |
185 | struct ehci_hcd *ehci = container_of((void *)priv, struct ehci_hcd, |
186 | priv); |
187 | |
188 | /* check the status twice to reduce misdetection rate */ |
189 | if (!quirk_poll_check_port_status(ehci)) |
190 | return; |
191 | udelay(10); |
192 | if (!quirk_poll_check_port_status(ehci)) |
193 | return; |
194 | |
195 | ehci_dbg(ehci, "%s: detected getting stuck. rebind now!\n", __func__); |
196 | quirk_poll_rebind_companion(ehci); |
197 | } |
198 | |
199 | static void quirk_poll_timer(struct timer_list *t) |
200 | { |
201 | struct ehci_platform_priv *priv = from_timer(priv, t, poll_timer); |
202 | struct ehci_hcd *ehci = container_of((void *)priv, struct ehci_hcd, |
203 | priv); |
204 | |
205 | if (quirk_poll_check_port_status(ehci)) { |
206 | /* |
207 | * Now scheduling the work for testing the port more. Note that |
208 | * updating the status is possible to be delayed when |
209 | * reconnection. So, this uses delayed work with 5 ms delay |
210 | * to avoid misdetection. |
211 | */ |
212 | schedule_delayed_work(dwork: &priv->poll_work, delay: msecs_to_jiffies(m: 5)); |
213 | } |
214 | |
215 | mod_timer(timer: &priv->poll_timer, expires: jiffies + HZ); |
216 | } |
217 | |
218 | static void quirk_poll_init(struct ehci_platform_priv *priv) |
219 | { |
220 | INIT_DELAYED_WORK(&priv->poll_work, quirk_poll_work); |
221 | timer_setup(&priv->poll_timer, quirk_poll_timer, 0); |
222 | mod_timer(timer: &priv->poll_timer, expires: jiffies + HZ); |
223 | } |
224 | |
225 | static void quirk_poll_end(struct ehci_platform_priv *priv) |
226 | { |
227 | del_timer_sync(timer: &priv->poll_timer); |
228 | cancel_delayed_work(dwork: &priv->poll_work); |
229 | } |
230 | |
231 | static const struct soc_device_attribute quirk_poll_match[] = { |
232 | { .family = "R-Car Gen3"}, |
233 | { /* sentinel*/ } |
234 | }; |
235 | |
236 | static int ehci_platform_probe(struct platform_device *dev) |
237 | { |
238 | struct usb_hcd *hcd; |
239 | struct resource *res_mem; |
240 | struct usb_ehci_pdata *pdata = dev_get_platdata(dev: &dev->dev); |
241 | struct ehci_platform_priv *priv; |
242 | struct ehci_hcd *ehci; |
243 | int err, irq, clk = 0; |
244 | |
245 | if (usb_disabled()) |
246 | return -ENODEV; |
247 | |
248 | /* |
249 | * Use reasonable defaults so platforms don't have to provide these |
250 | * with DT probing on ARM. |
251 | */ |
252 | if (!pdata) |
253 | pdata = &ehci_platform_defaults; |
254 | |
255 | err = dma_coerce_mask_and_coherent(dev: &dev->dev, |
256 | mask: pdata->dma_mask_64 ? DMA_BIT_MASK(64) : DMA_BIT_MASK(32)); |
257 | if (err) { |
258 | dev_err(&dev->dev, "Error: DMA mask configuration failed\n"); |
259 | return err; |
260 | } |
261 | |
262 | irq = platform_get_irq(dev, 0); |
263 | if (irq < 0) |
264 | return irq; |
265 | |
266 | hcd = usb_create_hcd(driver: &ehci_platform_hc_driver, dev: &dev->dev, |
267 | bus_name: dev_name(dev: &dev->dev)); |
268 | if (!hcd) |
269 | return -ENOMEM; |
270 | |
271 | platform_set_drvdata(pdev: dev, data: hcd); |
272 | dev->dev.platform_data = pdata; |
273 | priv = hcd_to_ehci_priv(hcd); |
274 | ehci = hcd_to_ehci(hcd); |
275 | |
276 | if (pdata == &ehci_platform_defaults && dev->dev.of_node) { |
277 | if (of_property_read_bool(np: dev->dev.of_node, propname: "big-endian-regs")) |
278 | ehci->big_endian_mmio = 1; |
279 | |
280 | if (of_property_read_bool(np: dev->dev.of_node, propname: "big-endian-desc")) |
281 | ehci->big_endian_desc = 1; |
282 | |
283 | if (of_property_read_bool(np: dev->dev.of_node, propname: "big-endian")) |
284 | ehci->big_endian_mmio = ehci->big_endian_desc = 1; |
285 | |
286 | if (of_property_read_bool(np: dev->dev.of_node, propname: "spurious-oc")) |
287 | ehci->spurious_oc = 1; |
288 | |
289 | if (of_property_read_bool(np: dev->dev.of_node, |
290 | propname: "needs-reset-on-resume")) |
291 | priv->reset_on_resume = true; |
292 | |
293 | if (of_property_read_bool(np: dev->dev.of_node, |
294 | propname: "has-transaction-translator")) |
295 | hcd->has_tt = 1; |
296 | |
297 | if (of_device_is_compatible(device: dev->dev.of_node, |
298 | "aspeed,ast2500-ehci") || |
299 | of_device_is_compatible(device: dev->dev.of_node, |
300 | "aspeed,ast2600-ehci")) |
301 | ehci->is_aspeed = 1; |
302 | |
303 | if (soc_device_match(matches: quirk_poll_match)) |
304 | priv->quirk_poll = true; |
305 | |
306 | for (clk = 0; clk < EHCI_MAX_CLKS; clk++) { |
307 | priv->clks[clk] = of_clk_get(np: dev->dev.of_node, index: clk); |
308 | if (IS_ERR(ptr: priv->clks[clk])) { |
309 | err = PTR_ERR(ptr: priv->clks[clk]); |
310 | if (err == -EPROBE_DEFER) |
311 | goto err_put_clks; |
312 | priv->clks[clk] = NULL; |
313 | break; |
314 | } |
315 | } |
316 | } |
317 | |
318 | priv->rsts = devm_reset_control_array_get_optional_shared(dev: &dev->dev); |
319 | if (IS_ERR(ptr: priv->rsts)) { |
320 | err = PTR_ERR(ptr: priv->rsts); |
321 | goto err_put_clks; |
322 | } |
323 | |
324 | err = reset_control_deassert(rstc: priv->rsts); |
325 | if (err) |
326 | goto err_put_clks; |
327 | |
328 | if (pdata->big_endian_desc) |
329 | ehci->big_endian_desc = 1; |
330 | if (pdata->big_endian_mmio) |
331 | ehci->big_endian_mmio = 1; |
332 | if (pdata->has_tt) |
333 | hcd->has_tt = 1; |
334 | if (pdata->reset_on_resume) |
335 | priv->reset_on_resume = true; |
336 | if (pdata->spurious_oc) |
337 | ehci->spurious_oc = 1; |
338 | |
339 | #ifndef CONFIG_USB_EHCI_BIG_ENDIAN_MMIO |
340 | if (ehci->big_endian_mmio) { |
341 | dev_err(&dev->dev, |
342 | "Error: CONFIG_USB_EHCI_BIG_ENDIAN_MMIO not set\n"); |
343 | err = -EINVAL; |
344 | goto err_reset; |
345 | } |
346 | #endif |
347 | #ifndef CONFIG_USB_EHCI_BIG_ENDIAN_DESC |
348 | if (ehci->big_endian_desc) { |
349 | dev_err(&dev->dev, |
350 | "Error: CONFIG_USB_EHCI_BIG_ENDIAN_DESC not set\n"); |
351 | err = -EINVAL; |
352 | goto err_reset; |
353 | } |
354 | #endif |
355 | |
356 | if (pdata->power_on) { |
357 | err = pdata->power_on(dev); |
358 | if (err < 0) |
359 | goto err_reset; |
360 | } |
361 | |
362 | hcd->regs = devm_platform_get_and_ioremap_resource(pdev: dev, index: 0, res: &res_mem); |
363 | if (IS_ERR(ptr: hcd->regs)) { |
364 | err = PTR_ERR(ptr: hcd->regs); |
365 | goto err_power; |
366 | } |
367 | hcd->rsrc_start = res_mem->start; |
368 | hcd->rsrc_len = resource_size(res: res_mem); |
369 | |
370 | hcd->tpl_support = of_usb_host_tpl_support(np: dev->dev.of_node); |
371 | |
372 | err = usb_add_hcd(hcd, irqnum: irq, IRQF_SHARED); |
373 | if (err) |
374 | goto err_power; |
375 | |
376 | device_wakeup_enable(dev: hcd->self.controller); |
377 | device_enable_async_suspend(dev: hcd->self.controller); |
378 | platform_set_drvdata(pdev: dev, data: hcd); |
379 | |
380 | if (priv->quirk_poll) |
381 | quirk_poll_init(priv); |
382 | |
383 | return err; |
384 | |
385 | err_power: |
386 | if (pdata->power_off) |
387 | pdata->power_off(dev); |
388 | err_reset: |
389 | reset_control_assert(rstc: priv->rsts); |
390 | err_put_clks: |
391 | while (--clk >= 0) |
392 | clk_put(clk: priv->clks[clk]); |
393 | |
394 | if (pdata == &ehci_platform_defaults) |
395 | dev->dev.platform_data = NULL; |
396 | |
397 | usb_put_hcd(hcd); |
398 | |
399 | return err; |
400 | } |
401 | |
402 | static void ehci_platform_remove(struct platform_device *dev) |
403 | { |
404 | struct usb_hcd *hcd = platform_get_drvdata(pdev: dev); |
405 | struct usb_ehci_pdata *pdata = dev_get_platdata(dev: &dev->dev); |
406 | struct ehci_platform_priv *priv = hcd_to_ehci_priv(hcd); |
407 | int clk; |
408 | |
409 | if (priv->quirk_poll) |
410 | quirk_poll_end(priv); |
411 | |
412 | usb_remove_hcd(hcd); |
413 | |
414 | if (pdata->power_off) |
415 | pdata->power_off(dev); |
416 | |
417 | reset_control_assert(rstc: priv->rsts); |
418 | |
419 | for (clk = 0; clk < EHCI_MAX_CLKS && priv->clks[clk]; clk++) |
420 | clk_put(clk: priv->clks[clk]); |
421 | |
422 | usb_put_hcd(hcd); |
423 | |
424 | if (pdata == &ehci_platform_defaults) |
425 | dev->dev.platform_data = NULL; |
426 | } |
427 | |
428 | static int __maybe_unused ehci_platform_suspend(struct device *dev) |
429 | { |
430 | struct usb_hcd *hcd = dev_get_drvdata(dev); |
431 | struct usb_ehci_pdata *pdata = dev_get_platdata(dev); |
432 | struct platform_device *pdev = to_platform_device(dev); |
433 | struct ehci_platform_priv *priv = hcd_to_ehci_priv(hcd); |
434 | bool do_wakeup = device_may_wakeup(dev); |
435 | int ret; |
436 | |
437 | if (priv->quirk_poll) |
438 | quirk_poll_end(priv); |
439 | |
440 | ret = ehci_suspend(hcd, do_wakeup); |
441 | if (ret) |
442 | return ret; |
443 | |
444 | if (pdata->power_suspend) |
445 | pdata->power_suspend(pdev); |
446 | |
447 | return ret; |
448 | } |
449 | |
450 | static int __maybe_unused ehci_platform_resume(struct device *dev) |
451 | { |
452 | struct usb_hcd *hcd = dev_get_drvdata(dev); |
453 | struct usb_ehci_pdata *pdata = dev_get_platdata(dev); |
454 | struct platform_device *pdev = to_platform_device(dev); |
455 | struct ehci_platform_priv *priv = hcd_to_ehci_priv(hcd); |
456 | struct device *companion_dev; |
457 | |
458 | if (pdata->power_on) { |
459 | int err = pdata->power_on(pdev); |
460 | if (err < 0) |
461 | return err; |
462 | } |
463 | |
464 | companion_dev = usb_of_get_companion_dev(dev: hcd->self.controller); |
465 | if (companion_dev) { |
466 | device_pm_wait_for_dev(sub: hcd->self.controller, dev: companion_dev); |
467 | put_device(dev: companion_dev); |
468 | } |
469 | |
470 | ehci_resume(hcd, force_reset: priv->reset_on_resume); |
471 | |
472 | pm_runtime_disable(dev); |
473 | pm_runtime_set_active(dev); |
474 | pm_runtime_enable(dev); |
475 | |
476 | if (priv->quirk_poll) |
477 | quirk_poll_init(priv); |
478 | |
479 | return 0; |
480 | } |
481 | |
482 | static const struct of_device_id vt8500_ehci_ids[] = { |
483 | { .compatible = "via,vt8500-ehci", }, |
484 | { .compatible = "wm,prizm-ehci", }, |
485 | { .compatible = "generic-ehci", }, |
486 | { .compatible = "cavium,octeon-6335-ehci", }, |
487 | {} |
488 | }; |
489 | MODULE_DEVICE_TABLE(of, vt8500_ehci_ids); |
490 | |
491 | #ifdef CONFIG_ACPI |
492 | static const struct acpi_device_id ehci_acpi_match[] = { |
493 | { "PNP0D20", 0 }, /* EHCI controller without debug */ |
494 | { } |
495 | }; |
496 | MODULE_DEVICE_TABLE(acpi, ehci_acpi_match); |
497 | #endif |
498 | |
499 | static const struct platform_device_id ehci_platform_table[] = { |
500 | { "ehci-platform", 0 }, |
501 | { } |
502 | }; |
503 | MODULE_DEVICE_TABLE(platform, ehci_platform_table); |
504 | |
505 | static SIMPLE_DEV_PM_OPS(ehci_platform_pm_ops, ehci_platform_suspend, |
506 | ehci_platform_resume); |
507 | |
508 | static struct platform_driver ehci_platform_driver = { |
509 | .id_table = ehci_platform_table, |
510 | .probe = ehci_platform_probe, |
511 | .remove_new = ehci_platform_remove, |
512 | .shutdown = usb_hcd_platform_shutdown, |
513 | .driver = { |
514 | .name = "ehci-platform", |
515 | .pm = pm_ptr(&ehci_platform_pm_ops), |
516 | .of_match_table = vt8500_ehci_ids, |
517 | .acpi_match_table = ACPI_PTR(ehci_acpi_match), |
518 | .probe_type = PROBE_PREFER_ASYNCHRONOUS, |
519 | } |
520 | }; |
521 | |
522 | static int __init ehci_platform_init(void) |
523 | { |
524 | if (usb_disabled()) |
525 | return -ENODEV; |
526 | |
527 | ehci_init_driver(drv: &ehci_platform_hc_driver, over: &platform_overrides); |
528 | return platform_driver_register(&ehci_platform_driver); |
529 | } |
530 | module_init(ehci_platform_init); |
531 | |
532 | static void __exit ehci_platform_cleanup(void) |
533 | { |
534 | platform_driver_unregister(&ehci_platform_driver); |
535 | } |
536 | module_exit(ehci_platform_cleanup); |
537 | |
538 | MODULE_DESCRIPTION(DRIVER_DESC); |
539 | MODULE_AUTHOR("Hauke Mehrtens"); |
540 | MODULE_AUTHOR("Alan Stern"); |
541 | MODULE_LICENSE("GPL"); |
542 |
Definitions
- ehci_platform_priv
- ehci_platform_reset
- ehci_platform_power_on
- ehci_platform_power_off
- ehci_platform_hc_driver
- platform_overrides
- ehci_platform_defaults
- quirk_poll_check_port_status
- quirk_poll_rebind_companion
- quirk_poll_work
- quirk_poll_timer
- quirk_poll_init
- quirk_poll_end
- quirk_poll_match
- ehci_platform_probe
- ehci_platform_remove
- ehci_platform_suspend
- ehci_platform_resume
- vt8500_ehci_ids
- ehci_acpi_match
- ehci_platform_table
- ehci_platform_pm_ops
- ehci_platform_driver
- ehci_platform_init
Improve your Profiling and Debugging skills
Find out more