This source file includes following definitions.
- ohci_da8xx_enable
- ohci_da8xx_disable
- ohci_da8xx_set_power
- ohci_da8xx_get_power
- ohci_da8xx_get_oci
- ohci_da8xx_has_set_power
- ohci_da8xx_has_oci
- ohci_da8xx_has_potpgt
- ohci_da8xx_regulator_event
- ohci_da8xx_oc_thread
- ohci_da8xx_register_notify
- ohci_da8xx_reset
- ohci_da8xx_hub_status_data
- ohci_da8xx_hub_control
- ohci_da8xx_probe
- ohci_da8xx_remove
- ohci_da8xx_suspend
- ohci_da8xx_resume
- ohci_da8xx_init
- ohci_da8xx_exit
1
2
3
4
5
6
7
8
9
10
11 #include <linux/clk.h>
12 #include <linux/gpio/consumer.h>
13 #include <linux/io.h>
14 #include <linux/interrupt.h>
15 #include <linux/jiffies.h>
16 #include <linux/kernel.h>
17 #include <linux/module.h>
18 #include <linux/platform_device.h>
19 #include <linux/phy/phy.h>
20 #include <linux/platform_data/usb-davinci.h>
21 #include <linux/regulator/consumer.h>
22 #include <linux/usb.h>
23 #include <linux/usb/hcd.h>
24 #include <asm/unaligned.h>
25
26 #include "ohci.h"
27
28 #define DRIVER_DESC "DA8XX"
29 #define DRV_NAME "ohci-da8xx"
30
31 static struct hc_driver __read_mostly ohci_da8xx_hc_driver;
32
33 static int (*orig_ohci_hub_control)(struct usb_hcd *hcd, u16 typeReq,
34 u16 wValue, u16 wIndex, char *buf, u16 wLength);
35 static int (*orig_ohci_hub_status_data)(struct usb_hcd *hcd, char *buf);
36
37 struct da8xx_ohci_hcd {
38 struct usb_hcd *hcd;
39 struct clk *usb11_clk;
40 struct phy *usb11_phy;
41 struct regulator *vbus_reg;
42 struct notifier_block nb;
43 struct gpio_desc *oc_gpio;
44 };
45
46 #define to_da8xx_ohci(hcd) (struct da8xx_ohci_hcd *)(hcd_to_ohci(hcd)->priv)
47
48
49 static volatile u16 ocic_mask;
50
51 static int ohci_da8xx_enable(struct usb_hcd *hcd)
52 {
53 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
54 int ret;
55
56 ret = clk_prepare_enable(da8xx_ohci->usb11_clk);
57 if (ret)
58 return ret;
59
60 ret = phy_init(da8xx_ohci->usb11_phy);
61 if (ret)
62 goto err_phy_init;
63
64 ret = phy_power_on(da8xx_ohci->usb11_phy);
65 if (ret)
66 goto err_phy_power_on;
67
68 return 0;
69
70 err_phy_power_on:
71 phy_exit(da8xx_ohci->usb11_phy);
72 err_phy_init:
73 clk_disable_unprepare(da8xx_ohci->usb11_clk);
74
75 return ret;
76 }
77
78 static void ohci_da8xx_disable(struct usb_hcd *hcd)
79 {
80 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
81
82 phy_power_off(da8xx_ohci->usb11_phy);
83 phy_exit(da8xx_ohci->usb11_phy);
84 clk_disable_unprepare(da8xx_ohci->usb11_clk);
85 }
86
87 static int ohci_da8xx_set_power(struct usb_hcd *hcd, int on)
88 {
89 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
90 struct device *dev = hcd->self.controller;
91 int ret;
92
93 if (!da8xx_ohci->vbus_reg)
94 return 0;
95
96 if (on) {
97 ret = regulator_enable(da8xx_ohci->vbus_reg);
98 if (ret) {
99 dev_err(dev, "Failed to enable regulator: %d\n", ret);
100 return ret;
101 }
102 } else {
103 ret = regulator_disable(da8xx_ohci->vbus_reg);
104 if (ret) {
105 dev_err(dev, "Failed to disable regulator: %d\n", ret);
106 return ret;
107 }
108 }
109
110 return 0;
111 }
112
113 static int ohci_da8xx_get_power(struct usb_hcd *hcd)
114 {
115 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
116
117 if (da8xx_ohci->vbus_reg)
118 return regulator_is_enabled(da8xx_ohci->vbus_reg);
119
120 return 1;
121 }
122
123 static int ohci_da8xx_get_oci(struct usb_hcd *hcd)
124 {
125 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
126 unsigned int flags;
127 int ret;
128
129 if (da8xx_ohci->oc_gpio)
130 return gpiod_get_value_cansleep(da8xx_ohci->oc_gpio);
131
132 if (!da8xx_ohci->vbus_reg)
133 return 0;
134
135 ret = regulator_get_error_flags(da8xx_ohci->vbus_reg, &flags);
136 if (ret)
137 return ret;
138
139 if (flags & REGULATOR_ERROR_OVER_CURRENT)
140 return 1;
141
142 return 0;
143 }
144
145 static int ohci_da8xx_has_set_power(struct usb_hcd *hcd)
146 {
147 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
148
149 if (da8xx_ohci->vbus_reg)
150 return 1;
151
152 return 0;
153 }
154
155 static int ohci_da8xx_has_oci(struct usb_hcd *hcd)
156 {
157 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
158
159 if (da8xx_ohci->oc_gpio)
160 return 1;
161
162 if (da8xx_ohci->vbus_reg)
163 return 1;
164
165 return 0;
166 }
167
168 static int ohci_da8xx_has_potpgt(struct usb_hcd *hcd)
169 {
170 struct device *dev = hcd->self.controller;
171 struct da8xx_ohci_root_hub *hub = dev_get_platdata(dev);
172
173 if (hub && hub->potpgt)
174 return 1;
175
176 return 0;
177 }
178
179 static int ohci_da8xx_regulator_event(struct notifier_block *nb,
180 unsigned long event, void *data)
181 {
182 struct da8xx_ohci_hcd *da8xx_ohci =
183 container_of(nb, struct da8xx_ohci_hcd, nb);
184
185 if (event & REGULATOR_EVENT_OVER_CURRENT) {
186 ocic_mask |= 1 << 1;
187 ohci_da8xx_set_power(da8xx_ohci->hcd, 0);
188 }
189
190 return 0;
191 }
192
193 static irqreturn_t ohci_da8xx_oc_thread(int irq, void *data)
194 {
195 struct da8xx_ohci_hcd *da8xx_ohci = data;
196 struct device *dev = da8xx_ohci->hcd->self.controller;
197 int ret;
198
199 if (gpiod_get_value_cansleep(da8xx_ohci->oc_gpio) &&
200 da8xx_ohci->vbus_reg) {
201 ret = regulator_disable(da8xx_ohci->vbus_reg);
202 if (ret)
203 dev_err(dev, "Failed to disable regulator: %d\n", ret);
204 }
205
206 return IRQ_HANDLED;
207 }
208
209 static int ohci_da8xx_register_notify(struct usb_hcd *hcd)
210 {
211 struct da8xx_ohci_hcd *da8xx_ohci = to_da8xx_ohci(hcd);
212 struct device *dev = hcd->self.controller;
213 int ret = 0;
214
215 if (!da8xx_ohci->oc_gpio && da8xx_ohci->vbus_reg) {
216 da8xx_ohci->nb.notifier_call = ohci_da8xx_regulator_event;
217 ret = devm_regulator_register_notifier(da8xx_ohci->vbus_reg,
218 &da8xx_ohci->nb);
219 }
220
221 if (ret)
222 dev_err(dev, "Failed to register notifier: %d\n", ret);
223
224 return ret;
225 }
226
227 static int ohci_da8xx_reset(struct usb_hcd *hcd)
228 {
229 struct device *dev = hcd->self.controller;
230 struct da8xx_ohci_root_hub *hub = dev_get_platdata(dev);
231 struct ohci_hcd *ohci = hcd_to_ohci(hcd);
232 int result;
233 u32 rh_a;
234
235 dev_dbg(dev, "starting USB controller\n");
236
237 result = ohci_da8xx_enable(hcd);
238 if (result < 0)
239 return result;
240
241
242
243
244
245 ohci->num_ports = 1;
246
247 result = ohci_setup(hcd);
248 if (result < 0) {
249 ohci_da8xx_disable(hcd);
250 return result;
251 }
252
253
254
255
256
257
258
259 rh_a = ohci_readl(ohci, &ohci->regs->roothub.a);
260 if (ohci_da8xx_has_set_power(hcd)) {
261 rh_a &= ~RH_A_NPS;
262 rh_a |= RH_A_PSM;
263 }
264 if (ohci_da8xx_has_oci(hcd)) {
265 rh_a &= ~RH_A_NOCP;
266 rh_a |= RH_A_OCPM;
267 }
268 if (ohci_da8xx_has_potpgt(hcd)) {
269 rh_a &= ~RH_A_POTPGT;
270 rh_a |= hub->potpgt << 24;
271 }
272 ohci_writel(ohci, rh_a, &ohci->regs->roothub.a);
273
274 return result;
275 }
276
277
278
279
280 static int ohci_da8xx_hub_status_data(struct usb_hcd *hcd, char *buf)
281 {
282 int length = orig_ohci_hub_status_data(hcd, buf);
283
284
285 if (ocic_mask & (1 << 1)) {
286 dev_dbg(hcd->self.controller, "over-current indicator change "
287 "on port 1\n");
288
289 if (!length)
290 length = 1;
291
292 buf[0] |= 1 << 1;
293 }
294 return length;
295 }
296
297
298
299
300 static int ohci_da8xx_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
301 u16 wIndex, char *buf, u16 wLength)
302 {
303 struct device *dev = hcd->self.controller;
304 int temp;
305
306 switch (typeReq) {
307 case GetPortStatus:
308
309 if (wIndex != 1)
310 break;
311
312 dev_dbg(dev, "GetPortStatus(%u)\n", wIndex);
313
314 temp = roothub_portstatus(hcd_to_ohci(hcd), wIndex - 1);
315
316
317 if (!ohci_da8xx_get_power(hcd))
318 temp &= ~RH_PS_PPS;
319
320
321 if (ohci_da8xx_get_oci(hcd) > 0)
322 temp |= RH_PS_POCI;
323
324
325 if (ocic_mask & (1 << wIndex))
326 temp |= RH_PS_OCIC;
327
328 put_unaligned(cpu_to_le32(temp), (__le32 *)buf);
329 return 0;
330 case SetPortFeature:
331 temp = 1;
332 goto check_port;
333 case ClearPortFeature:
334 temp = 0;
335
336 check_port:
337
338 if (wIndex != 1)
339 break;
340
341 switch (wValue) {
342 case USB_PORT_FEAT_POWER:
343 dev_dbg(dev, "%sPortFeature(%u): %s\n",
344 temp ? "Set" : "Clear", wIndex, "POWER");
345
346 return ohci_da8xx_set_power(hcd, temp) ? -EPIPE : 0;
347 case USB_PORT_FEAT_C_OVER_CURRENT:
348 dev_dbg(dev, "%sPortFeature(%u): %s\n",
349 temp ? "Set" : "Clear", wIndex,
350 "C_OVER_CURRENT");
351
352 if (temp)
353 ocic_mask |= 1 << wIndex;
354 else
355 ocic_mask &= ~(1 << wIndex);
356 return 0;
357 }
358 }
359
360 return orig_ohci_hub_control(hcd, typeReq, wValue,
361 wIndex, buf, wLength);
362 }
363
364
365 #ifdef CONFIG_OF
366 static const struct of_device_id da8xx_ohci_ids[] = {
367 { .compatible = "ti,da830-ohci" },
368 { }
369 };
370 MODULE_DEVICE_TABLE(of, da8xx_ohci_ids);
371 #endif
372
373 static int ohci_da8xx_probe(struct platform_device *pdev)
374 {
375 struct da8xx_ohci_hcd *da8xx_ohci;
376 struct device *dev = &pdev->dev;
377 int error, hcd_irq, oc_irq;
378 struct usb_hcd *hcd;
379 struct resource *mem;
380
381 hcd = usb_create_hcd(&ohci_da8xx_hc_driver, dev, dev_name(dev));
382 if (!hcd)
383 return -ENOMEM;
384
385 da8xx_ohci = to_da8xx_ohci(hcd);
386 da8xx_ohci->hcd = hcd;
387
388 da8xx_ohci->usb11_clk = devm_clk_get(dev, NULL);
389 if (IS_ERR(da8xx_ohci->usb11_clk)) {
390 error = PTR_ERR(da8xx_ohci->usb11_clk);
391 if (error != -EPROBE_DEFER)
392 dev_err(dev, "Failed to get clock.\n");
393 goto err;
394 }
395
396 da8xx_ohci->usb11_phy = devm_phy_get(dev, "usb-phy");
397 if (IS_ERR(da8xx_ohci->usb11_phy)) {
398 error = PTR_ERR(da8xx_ohci->usb11_phy);
399 if (error != -EPROBE_DEFER)
400 dev_err(dev, "Failed to get phy.\n");
401 goto err;
402 }
403
404 da8xx_ohci->vbus_reg = devm_regulator_get_optional(dev, "vbus");
405 if (IS_ERR(da8xx_ohci->vbus_reg)) {
406 error = PTR_ERR(da8xx_ohci->vbus_reg);
407 if (error == -ENODEV) {
408 da8xx_ohci->vbus_reg = NULL;
409 } else if (error == -EPROBE_DEFER) {
410 goto err;
411 } else {
412 dev_err(dev, "Failed to get regulator\n");
413 goto err;
414 }
415 }
416
417 da8xx_ohci->oc_gpio = devm_gpiod_get_optional(dev, "oc", GPIOD_IN);
418 if (IS_ERR(da8xx_ohci->oc_gpio)) {
419 error = PTR_ERR(da8xx_ohci->oc_gpio);
420 goto err;
421 }
422
423 if (da8xx_ohci->oc_gpio) {
424 oc_irq = gpiod_to_irq(da8xx_ohci->oc_gpio);
425 if (oc_irq < 0) {
426 error = oc_irq;
427 goto err;
428 }
429
430 error = devm_request_threaded_irq(dev, oc_irq, NULL,
431 ohci_da8xx_oc_thread, IRQF_TRIGGER_RISING |
432 IRQF_TRIGGER_FALLING | IRQF_ONESHOT,
433 "OHCI over-current indicator", da8xx_ohci);
434 if (error)
435 goto err;
436 }
437
438 mem = platform_get_resource(pdev, IORESOURCE_MEM, 0);
439 hcd->regs = devm_ioremap_resource(dev, mem);
440 if (IS_ERR(hcd->regs)) {
441 error = PTR_ERR(hcd->regs);
442 goto err;
443 }
444 hcd->rsrc_start = mem->start;
445 hcd->rsrc_len = resource_size(mem);
446
447 hcd_irq = platform_get_irq(pdev, 0);
448 if (hcd_irq < 0) {
449 error = -ENODEV;
450 goto err;
451 }
452
453 error = usb_add_hcd(hcd, hcd_irq, 0);
454 if (error)
455 goto err;
456
457 device_wakeup_enable(hcd->self.controller);
458
459 error = ohci_da8xx_register_notify(hcd);
460 if (error)
461 goto err_remove_hcd;
462
463 return 0;
464
465 err_remove_hcd:
466 usb_remove_hcd(hcd);
467 err:
468 usb_put_hcd(hcd);
469 return error;
470 }
471
472 static int ohci_da8xx_remove(struct platform_device *pdev)
473 {
474 struct usb_hcd *hcd = platform_get_drvdata(pdev);
475
476 usb_remove_hcd(hcd);
477 usb_put_hcd(hcd);
478
479 return 0;
480 }
481
482 #ifdef CONFIG_PM
483 static int ohci_da8xx_suspend(struct platform_device *pdev,
484 pm_message_t message)
485 {
486 struct usb_hcd *hcd = platform_get_drvdata(pdev);
487 struct ohci_hcd *ohci = hcd_to_ohci(hcd);
488 bool do_wakeup = device_may_wakeup(&pdev->dev);
489 int ret;
490
491
492 if (time_before(jiffies, ohci->next_statechange))
493 msleep(5);
494 ohci->next_statechange = jiffies;
495
496 ret = ohci_suspend(hcd, do_wakeup);
497 if (ret)
498 return ret;
499
500 ohci_da8xx_disable(hcd);
501 hcd->state = HC_STATE_SUSPENDED;
502
503 return ret;
504 }
505
506 static int ohci_da8xx_resume(struct platform_device *dev)
507 {
508 struct usb_hcd *hcd = platform_get_drvdata(dev);
509 struct ohci_hcd *ohci = hcd_to_ohci(hcd);
510 int ret;
511
512 if (time_before(jiffies, ohci->next_statechange))
513 msleep(5);
514 ohci->next_statechange = jiffies;
515
516 ret = ohci_da8xx_enable(hcd);
517 if (ret)
518 return ret;
519
520 ohci_resume(hcd, false);
521
522 return 0;
523 }
524 #endif
525
526 static const struct ohci_driver_overrides da8xx_overrides __initconst = {
527 .reset = ohci_da8xx_reset,
528 .extra_priv_size = sizeof(struct da8xx_ohci_hcd),
529 };
530
531
532
533
534 static struct platform_driver ohci_hcd_da8xx_driver = {
535 .probe = ohci_da8xx_probe,
536 .remove = ohci_da8xx_remove,
537 .shutdown = usb_hcd_platform_shutdown,
538 #ifdef CONFIG_PM
539 .suspend = ohci_da8xx_suspend,
540 .resume = ohci_da8xx_resume,
541 #endif
542 .driver = {
543 .name = DRV_NAME,
544 .of_match_table = of_match_ptr(da8xx_ohci_ids),
545 },
546 };
547
548 static int __init ohci_da8xx_init(void)
549 {
550
551 if (usb_disabled())
552 return -ENODEV;
553
554 pr_info("%s: " DRIVER_DESC "\n", DRV_NAME);
555 ohci_init_driver(&ohci_da8xx_hc_driver, &da8xx_overrides);
556
557
558
559
560
561
562
563
564
565
566 orig_ohci_hub_control = ohci_da8xx_hc_driver.hub_control;
567 orig_ohci_hub_status_data = ohci_da8xx_hc_driver.hub_status_data;
568
569 ohci_da8xx_hc_driver.hub_status_data = ohci_da8xx_hub_status_data;
570 ohci_da8xx_hc_driver.hub_control = ohci_da8xx_hub_control;
571
572 return platform_driver_register(&ohci_hcd_da8xx_driver);
573 }
574 module_init(ohci_da8xx_init);
575
576 static void __exit ohci_da8xx_exit(void)
577 {
578 platform_driver_unregister(&ohci_hcd_da8xx_driver);
579 }
580 module_exit(ohci_da8xx_exit);
581 MODULE_DESCRIPTION(DRIVER_DESC);
582 MODULE_LICENSE("GPL");
583 MODULE_ALIAS("platform:" DRV_NAME);