1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/clk.h>
24#include <linux/device.h>
25#include <linux/dma-mapping.h>
26#include <linux/io.h>
27#include <linux/kernel.h>
28#include <linux/module.h>
29#include <linux/of_platform.h>
30#include <linux/of_gpio.h>
31#include <linux/platform_data/usb-ohci-pxa27x.h>
32#include <linux/platform_data/usb-pxa3xx-ulpi.h>
33#include <linux/platform_device.h>
34#include <linux/regulator/consumer.h>
35#include <linux/signal.h>
36#include <linux/usb.h>
37#include <linux/usb/hcd.h>
38#include <linux/usb/otg.h>
39
40#include <mach/hardware.h>
41
42#include "ohci.h"
43
44#define DRIVER_DESC "OHCI PXA27x/PXA3x driver"
45
46
47
48
49#define UHCREV (0x0000)
50#define UHCHCON (0x0004)
51#define UHCCOMS (0x0008)
52#define UHCINTS (0x000C)
53#define UHCINTE (0x0010)
54#define UHCINTD (0x0014)
55#define UHCHCCA (0x0018)
56#define UHCPCED (0x001C)
57#define UHCCHED (0x0020)
58#define UHCCCED (0x0024)
59#define UHCBHED (0x0028)
60#define UHCBCED (0x002C)
61#define UHCDHEAD (0x0030)
62#define UHCFMI (0x0034)
63#define UHCFMR (0x0038)
64#define UHCFMN (0x003C)
65#define UHCPERS (0x0040)
66#define UHCLS (0x0044)
67
68#define UHCRHDA (0x0048)
69#define UHCRHDA_NOCP (1 << 12)
70#define UHCRHDA_OCPM (1 << 11)
71#define UHCRHDA_POTPGT(x) \
72 (((x) & 0xff) << 24)
73
74#define UHCRHDB (0x004C)
75#define UHCRHS (0x0050)
76#define UHCRHPS1 (0x0054)
77#define UHCRHPS2 (0x0058)
78#define UHCRHPS3 (0x005C)
79
80#define UHCSTAT (0x0060)
81#define UHCSTAT_UPS3 (1 << 16)
82#define UHCSTAT_SBMAI (1 << 15)
83#define UHCSTAT_SBTAI (1 << 14)
84#define UHCSTAT_UPRI (1 << 13)
85#define UHCSTAT_UPS2 (1 << 12)
86#define UHCSTAT_UPS1 (1 << 11)
87#define UHCSTAT_HTA (1 << 10)
88#define UHCSTAT_HBA (1 << 8)
89#define UHCSTAT_RWUE (1 << 7)
90
91#define UHCHR (0x0064)
92#define UHCHR_SSEP3 (1 << 11)
93#define UHCHR_SSEP2 (1 << 10)
94#define UHCHR_SSEP1 (1 << 9)
95#define UHCHR_PCPL (1 << 7)
96#define UHCHR_PSPL (1 << 6)
97#define UHCHR_SSE (1 << 5)
98#define UHCHR_UIT (1 << 4)
99#define UHCHR_SSDC (1 << 3)
100#define UHCHR_CGR (1 << 2)
101#define UHCHR_FHR (1 << 1)
102#define UHCHR_FSBIR (1 << 0)
103
104#define UHCHIE (0x0068)
105#define UHCHIE_UPS3IE (1 << 14)
106#define UHCHIE_UPRIE (1 << 13)
107#define UHCHIE_UPS2IE (1 << 12)
108#define UHCHIE_UPS1IE (1 << 11)
109#define UHCHIE_TAIE (1 << 10)
110
111#define UHCHIE_HBAIE (1 << 8)
112#define UHCHIE_RWIE (1 << 7)
113
114#define UHCHIT (0x006C)
115
116#define PXA_UHC_MAX_PORTNUM 3
117
118static const char hcd_name[] = "ohci-pxa27x";
119
120static struct hc_driver __read_mostly ohci_pxa27x_hc_driver;
121
122struct pxa27x_ohci {
123 struct clk *clk;
124 void __iomem *mmio_base;
125 struct regulator *vbus[3];
126 bool vbus_enabled[3];
127};
128
129#define to_pxa27x_ohci(hcd) (struct pxa27x_ohci *)(hcd_to_ohci(hcd)->priv)
130
131
132
133
134
135
136
137
138
139
140
141static int pxa27x_ohci_select_pmm(struct pxa27x_ohci *pxa_ohci, int mode)
142{
143 uint32_t uhcrhda = __raw_readl(pxa_ohci->mmio_base + UHCRHDA);
144 uint32_t uhcrhdb = __raw_readl(pxa_ohci->mmio_base + UHCRHDB);
145
146 switch (mode) {
147 case PMM_NPS_MODE:
148 uhcrhda |= RH_A_NPS;
149 break;
150 case PMM_GLOBAL_MODE:
151 uhcrhda &= ~(RH_A_NPS & RH_A_PSM);
152 break;
153 case PMM_PERPORT_MODE:
154 uhcrhda &= ~(RH_A_NPS);
155 uhcrhda |= RH_A_PSM;
156
157
158 uhcrhdb |= (0x7<<17);
159 break;
160 default:
161 printk( KERN_ERR
162 "Invalid mode %d, set to non-power switch mode.\n",
163 mode );
164
165 uhcrhda |= RH_A_NPS;
166 }
167
168 __raw_writel(uhcrhda, pxa_ohci->mmio_base + UHCRHDA);
169 __raw_writel(uhcrhdb, pxa_ohci->mmio_base + UHCRHDB);
170 return 0;
171}
172
173static int pxa27x_ohci_set_vbus_power(struct pxa27x_ohci *pxa_ohci,
174 unsigned int port, bool enable)
175{
176 struct regulator *vbus = pxa_ohci->vbus[port];
177 int ret = 0;
178
179 if (IS_ERR_OR_NULL(vbus))
180 return 0;
181
182 if (enable && !pxa_ohci->vbus_enabled[port])
183 ret = regulator_enable(vbus);
184 else if (!enable && pxa_ohci->vbus_enabled[port])
185 ret = regulator_disable(vbus);
186
187 if (ret < 0)
188 return ret;
189
190 pxa_ohci->vbus_enabled[port] = enable;
191
192 return 0;
193}
194
195static int pxa27x_ohci_hub_control(struct usb_hcd *hcd, u16 typeReq, u16 wValue,
196 u16 wIndex, char *buf, u16 wLength)
197{
198 struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd);
199 int ret;
200
201 switch (typeReq) {
202 case SetPortFeature:
203 case ClearPortFeature:
204 if (!wIndex || wIndex > 3)
205 return -EPIPE;
206
207 if (wValue != USB_PORT_FEAT_POWER)
208 break;
209
210 ret = pxa27x_ohci_set_vbus_power(pxa_ohci, wIndex - 1,
211 typeReq == SetPortFeature);
212 if (ret)
213 return ret;
214 break;
215 }
216
217 return ohci_hub_control(hcd, typeReq, wValue, wIndex, buf, wLength);
218}
219
220
221static inline void pxa27x_setup_hc(struct pxa27x_ohci *pxa_ohci,
222 struct pxaohci_platform_data *inf)
223{
224 uint32_t uhchr = __raw_readl(pxa_ohci->mmio_base + UHCHR);
225 uint32_t uhcrhda = __raw_readl(pxa_ohci->mmio_base + UHCRHDA);
226
227 if (inf->flags & ENABLE_PORT1)
228 uhchr &= ~UHCHR_SSEP1;
229
230 if (inf->flags & ENABLE_PORT2)
231 uhchr &= ~UHCHR_SSEP2;
232
233 if (inf->flags & ENABLE_PORT3)
234 uhchr &= ~UHCHR_SSEP3;
235
236 if (inf->flags & POWER_CONTROL_LOW)
237 uhchr |= UHCHR_PCPL;
238
239 if (inf->flags & POWER_SENSE_LOW)
240 uhchr |= UHCHR_PSPL;
241
242 if (inf->flags & NO_OC_PROTECTION)
243 uhcrhda |= UHCRHDA_NOCP;
244 else
245 uhcrhda &= ~UHCRHDA_NOCP;
246
247 if (inf->flags & OC_MODE_PERPORT)
248 uhcrhda |= UHCRHDA_OCPM;
249 else
250 uhcrhda &= ~UHCRHDA_OCPM;
251
252 if (inf->power_on_delay) {
253 uhcrhda &= ~UHCRHDA_POTPGT(0xff);
254 uhcrhda |= UHCRHDA_POTPGT(inf->power_on_delay / 2);
255 }
256
257 __raw_writel(uhchr, pxa_ohci->mmio_base + UHCHR);
258 __raw_writel(uhcrhda, pxa_ohci->mmio_base + UHCRHDA);
259}
260
261static inline void pxa27x_reset_hc(struct pxa27x_ohci *pxa_ohci)
262{
263 uint32_t uhchr = __raw_readl(pxa_ohci->mmio_base + UHCHR);
264
265 __raw_writel(uhchr | UHCHR_FHR, pxa_ohci->mmio_base + UHCHR);
266 udelay(11);
267 __raw_writel(uhchr & ~UHCHR_FHR, pxa_ohci->mmio_base + UHCHR);
268}
269
270#ifdef CONFIG_PXA27x
271extern void pxa27x_clear_otgph(void);
272#else
273#define pxa27x_clear_otgph() do {} while (0)
274#endif
275
276static int pxa27x_start_hc(struct pxa27x_ohci *pxa_ohci, struct device *dev)
277{
278 int retval;
279 struct pxaohci_platform_data *inf;
280 uint32_t uhchr;
281 struct usb_hcd *hcd = dev_get_drvdata(dev);
282
283 inf = dev_get_platdata(dev);
284
285 retval = clk_prepare_enable(pxa_ohci->clk);
286 if (retval)
287 return retval;
288
289 pxa27x_reset_hc(pxa_ohci);
290
291 uhchr = __raw_readl(pxa_ohci->mmio_base + UHCHR) | UHCHR_FSBIR;
292 __raw_writel(uhchr, pxa_ohci->mmio_base + UHCHR);
293
294 while (__raw_readl(pxa_ohci->mmio_base + UHCHR) & UHCHR_FSBIR)
295 cpu_relax();
296
297 pxa27x_setup_hc(pxa_ohci, inf);
298
299 if (inf->init)
300 retval = inf->init(dev);
301
302 if (retval < 0) {
303 clk_disable_unprepare(pxa_ohci->clk);
304 return retval;
305 }
306
307 if (cpu_is_pxa3xx())
308 pxa3xx_u2d_start_hc(&hcd->self);
309
310 uhchr = __raw_readl(pxa_ohci->mmio_base + UHCHR) & ~UHCHR_SSE;
311 __raw_writel(uhchr, pxa_ohci->mmio_base + UHCHR);
312 __raw_writel(UHCHIE_UPRIE | UHCHIE_RWIE, pxa_ohci->mmio_base + UHCHIE);
313
314
315 pxa27x_clear_otgph();
316 return 0;
317}
318
319static void pxa27x_stop_hc(struct pxa27x_ohci *pxa_ohci, struct device *dev)
320{
321 struct pxaohci_platform_data *inf;
322 struct usb_hcd *hcd = dev_get_drvdata(dev);
323 uint32_t uhccoms;
324
325 inf = dev_get_platdata(dev);
326
327 if (cpu_is_pxa3xx())
328 pxa3xx_u2d_stop_hc(&hcd->self);
329
330 if (inf->exit)
331 inf->exit(dev);
332
333 pxa27x_reset_hc(pxa_ohci);
334
335
336 uhccoms = __raw_readl(pxa_ohci->mmio_base + UHCCOMS) | 0x01;
337 __raw_writel(uhccoms, pxa_ohci->mmio_base + UHCCOMS);
338 udelay(10);
339
340 clk_disable_unprepare(pxa_ohci->clk);
341}
342
343#ifdef CONFIG_OF
344static const struct of_device_id pxa_ohci_dt_ids[] = {
345 { .compatible = "marvell,pxa-ohci" },
346 { }
347};
348
349MODULE_DEVICE_TABLE(of, pxa_ohci_dt_ids);
350
351static int ohci_pxa_of_init(struct platform_device *pdev)
352{
353 struct device_node *np = pdev->dev.of_node;
354 struct pxaohci_platform_data *pdata;
355 u32 tmp;
356 int ret;
357
358 if (!np)
359 return 0;
360
361
362
363
364
365 ret = dma_coerce_mask_and_coherent(&pdev->dev, DMA_BIT_MASK(32));
366 if (ret)
367 return ret;
368
369 pdata = devm_kzalloc(&pdev->dev, sizeof(*pdata), GFP_KERNEL);
370 if (!pdata)
371 return -ENOMEM;
372
373 if (of_property_read_bool(np, "marvell,enable-port1"))
374 pdata->flags |= ENABLE_PORT1;
375 if (of_property_read_bool(np, "marvell,enable-port2"))
376 pdata->flags |= ENABLE_PORT2;
377 if (of_property_read_bool(np, "marvell,enable-port3"))
378 pdata->flags |= ENABLE_PORT3;
379 if (of_property_read_bool(np, "marvell,port-sense-low"))
380 pdata->flags |= POWER_SENSE_LOW;
381 if (of_property_read_bool(np, "marvell,power-control-low"))
382 pdata->flags |= POWER_CONTROL_LOW;
383 if (of_property_read_bool(np, "marvell,no-oc-protection"))
384 pdata->flags |= NO_OC_PROTECTION;
385 if (of_property_read_bool(np, "marvell,oc-mode-perport"))
386 pdata->flags |= OC_MODE_PERPORT;
387 if (!of_property_read_u32(np, "marvell,power-on-delay", &tmp))
388 pdata->power_on_delay = tmp;
389 if (!of_property_read_u32(np, "marvell,port-mode", &tmp))
390 pdata->port_mode = tmp;
391 if (!of_property_read_u32(np, "marvell,power-budget", &tmp))
392 pdata->power_budget = tmp;
393
394 pdev->dev.platform_data = pdata;
395
396 return 0;
397}
398#else
399static int ohci_pxa_of_init(struct platform_device *pdev)
400{
401 return 0;
402}
403#endif
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420static int ohci_hcd_pxa27x_probe(struct platform_device *pdev)
421{
422 int retval, irq;
423 struct usb_hcd *hcd;
424 struct pxaohci_platform_data *inf;
425 struct pxa27x_ohci *pxa_ohci;
426 struct ohci_hcd *ohci;
427 struct resource *r;
428 struct clk *usb_clk;
429 unsigned int i;
430
431 retval = ohci_pxa_of_init(pdev);
432 if (retval)
433 return retval;
434
435 inf = dev_get_platdata(&pdev->dev);
436
437 if (!inf)
438 return -ENODEV;
439
440 irq = platform_get_irq(pdev, 0);
441 if (irq < 0) {
442 pr_err("no resource of IORESOURCE_IRQ");
443 return irq;
444 }
445
446 usb_clk = devm_clk_get(&pdev->dev, NULL);
447 if (IS_ERR(usb_clk))
448 return PTR_ERR(usb_clk);
449
450 hcd = usb_create_hcd(&ohci_pxa27x_hc_driver, &pdev->dev, "pxa27x");
451 if (!hcd)
452 return -ENOMEM;
453
454 r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
455 hcd->regs = devm_ioremap_resource(&pdev->dev, r);
456 if (IS_ERR(hcd->regs)) {
457 retval = PTR_ERR(hcd->regs);
458 goto err;
459 }
460 hcd->rsrc_start = r->start;
461 hcd->rsrc_len = resource_size(r);
462
463
464 pxa_ohci = to_pxa27x_ohci(hcd);
465 pxa_ohci->clk = usb_clk;
466 pxa_ohci->mmio_base = (void __iomem *)hcd->regs;
467
468 for (i = 0; i < 3; ++i) {
469 char name[6];
470
471 if (!(inf->flags & (ENABLE_PORT1 << i)))
472 continue;
473
474 sprintf(name, "vbus%u", i + 1);
475 pxa_ohci->vbus[i] = devm_regulator_get(&pdev->dev, name);
476 }
477
478 retval = pxa27x_start_hc(pxa_ohci, &pdev->dev);
479 if (retval < 0) {
480 pr_debug("pxa27x_start_hc failed");
481 goto err;
482 }
483
484
485 pxa27x_ohci_select_pmm(pxa_ohci, inf->port_mode);
486
487 if (inf->power_budget)
488 hcd->power_budget = inf->power_budget;
489
490
491 ohci = hcd_to_ohci(hcd);
492 ohci->num_ports = 3;
493
494 retval = usb_add_hcd(hcd, irq, 0);
495 if (retval == 0) {
496 device_wakeup_enable(hcd->self.controller);
497 return retval;
498 }
499
500 pxa27x_stop_hc(pxa_ohci, &pdev->dev);
501 err:
502 usb_put_hcd(hcd);
503 return retval;
504}
505
506
507
508
509
510
511
512
513
514
515
516
517
518
519
520static int ohci_hcd_pxa27x_remove(struct platform_device *pdev)
521{
522 struct usb_hcd *hcd = platform_get_drvdata(pdev);
523 struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd);
524 unsigned int i;
525
526 usb_remove_hcd(hcd);
527 pxa27x_stop_hc(pxa_ohci, &pdev->dev);
528
529 for (i = 0; i < 3; ++i)
530 pxa27x_ohci_set_vbus_power(pxa_ohci, i, false);
531
532 usb_put_hcd(hcd);
533 return 0;
534}
535
536
537
538#ifdef CONFIG_PM
539static int ohci_hcd_pxa27x_drv_suspend(struct device *dev)
540{
541 struct usb_hcd *hcd = dev_get_drvdata(dev);
542 struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd);
543 struct ohci_hcd *ohci = hcd_to_ohci(hcd);
544 bool do_wakeup = device_may_wakeup(dev);
545 int ret;
546
547
548 if (time_before(jiffies, ohci->next_statechange))
549 msleep(5);
550 ohci->next_statechange = jiffies;
551
552 ret = ohci_suspend(hcd, do_wakeup);
553 if (ret)
554 return ret;
555
556 pxa27x_stop_hc(pxa_ohci, dev);
557 return ret;
558}
559
560static int ohci_hcd_pxa27x_drv_resume(struct device *dev)
561{
562 struct usb_hcd *hcd = dev_get_drvdata(dev);
563 struct pxa27x_ohci *pxa_ohci = to_pxa27x_ohci(hcd);
564 struct pxaohci_platform_data *inf = dev_get_platdata(dev);
565 struct ohci_hcd *ohci = hcd_to_ohci(hcd);
566 int status;
567
568 if (time_before(jiffies, ohci->next_statechange))
569 msleep(5);
570 ohci->next_statechange = jiffies;
571
572 status = pxa27x_start_hc(pxa_ohci, dev);
573 if (status < 0)
574 return status;
575
576
577 pxa27x_ohci_select_pmm(pxa_ohci, inf->port_mode);
578
579 ohci_resume(hcd, false);
580 return 0;
581}
582
583static const struct dev_pm_ops ohci_hcd_pxa27x_pm_ops = {
584 .suspend = ohci_hcd_pxa27x_drv_suspend,
585 .resume = ohci_hcd_pxa27x_drv_resume,
586};
587#endif
588
589static struct platform_driver ohci_hcd_pxa27x_driver = {
590 .probe = ohci_hcd_pxa27x_probe,
591 .remove = ohci_hcd_pxa27x_remove,
592 .shutdown = usb_hcd_platform_shutdown,
593 .driver = {
594 .name = "pxa27x-ohci",
595 .of_match_table = of_match_ptr(pxa_ohci_dt_ids),
596#ifdef CONFIG_PM
597 .pm = &ohci_hcd_pxa27x_pm_ops,
598#endif
599 },
600};
601
602static const struct ohci_driver_overrides pxa27x_overrides __initconst = {
603 .extra_priv_size = sizeof(struct pxa27x_ohci),
604};
605
606static int __init ohci_pxa27x_init(void)
607{
608 if (usb_disabled())
609 return -ENODEV;
610
611 pr_info("%s: " DRIVER_DESC "\n", hcd_name);
612
613 ohci_init_driver(&ohci_pxa27x_hc_driver, &pxa27x_overrides);
614 ohci_pxa27x_hc_driver.hub_control = pxa27x_ohci_hub_control;
615
616 return platform_driver_register(&ohci_hcd_pxa27x_driver);
617}
618module_init(ohci_pxa27x_init);
619
620static void __exit ohci_pxa27x_cleanup(void)
621{
622 platform_driver_unregister(&ohci_hcd_pxa27x_driver);
623}
624module_exit(ohci_pxa27x_cleanup);
625
626MODULE_DESCRIPTION(DRIVER_DESC);
627MODULE_LICENSE("GPL");
628MODULE_ALIAS("platform:pxa27x-ohci");
629