1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26#include <linux/kernel.h>
27#include <linux/types.h>
28#include <linux/delay.h>
29#include <linux/pm.h>
30#include <linux/err.h>
31#include <linux/platform_device.h>
32#include <linux/fsl_devices.h>
33
34#include "ehci-fsl.h"
35
36
37
38
39
40
41
42
43
44
45
46
47
48static int usb_hcd_fsl_probe(const struct hc_driver *driver,
49 struct platform_device *pdev)
50{
51 struct fsl_usb2_platform_data *pdata;
52 struct usb_hcd *hcd;
53 struct resource *res;
54 int irq;
55 int retval;
56
57 pr_debug("initializing FSL-SOC USB Controller\n");
58
59
60 pdata = (struct fsl_usb2_platform_data *)pdev->dev.platform_data;
61 if (!pdata) {
62 dev_err(&pdev->dev,
63 "No platform data for %s.\n", dev_name(&pdev->dev));
64 return -ENODEV;
65 }
66
67
68
69
70
71 if (!((pdata->operating_mode == FSL_USB2_DR_HOST) ||
72 (pdata->operating_mode == FSL_USB2_MPH_HOST) ||
73 (pdata->operating_mode == FSL_USB2_DR_OTG))) {
74 dev_err(&pdev->dev,
75 "Non Host Mode configured for %s. Wrong driver linked.\n",
76 dev_name(&pdev->dev));
77 return -ENODEV;
78 }
79
80 res = platform_get_resource(pdev, IORESOURCE_IRQ, 0);
81 if (!res) {
82 dev_err(&pdev->dev,
83 "Found HC with no IRQ. Check %s setup!\n",
84 dev_name(&pdev->dev));
85 return -ENODEV;
86 }
87 irq = res->start;
88
89 hcd = usb_create_hcd(driver, &pdev->dev, dev_name(&pdev->dev));
90 if (!hcd) {
91 retval = -ENOMEM;
92 goto err1;
93 }
94
95 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
96 if (!res) {
97 dev_err(&pdev->dev,
98 "Found HC with no register addr. Check %s setup!\n",
99 dev_name(&pdev->dev));
100 retval = -ENODEV;
101 goto err2;
102 }
103 hcd->rsrc_start = res->start;
104 hcd->rsrc_len = resource_size(res);
105 if (!request_mem_region(hcd->rsrc_start, hcd->rsrc_len,
106 driver->description)) {
107 dev_dbg(&pdev->dev, "controller already in use\n");
108 retval = -EBUSY;
109 goto err2;
110 }
111 hcd->regs = ioremap(hcd->rsrc_start, hcd->rsrc_len);
112
113 if (hcd->regs == NULL) {
114 dev_dbg(&pdev->dev, "error mapping memory\n");
115 retval = -EFAULT;
116 goto err3;
117 }
118
119 pdata->regs = hcd->regs;
120
121 if (pdata->power_budget)
122 hcd->power_budget = pdata->power_budget;
123
124
125
126
127 if (pdata->init && pdata->init(pdev)) {
128 retval = -ENODEV;
129 goto err4;
130 }
131
132
133 if (pdata->have_sysif_regs)
134 setbits32(hcd->regs + FSL_SOC_USB_CTRL, 0x4);
135
136
137
138 retval = usb_add_hcd(hcd, irq, IRQF_SHARED);
139 if (retval != 0)
140 goto err4;
141
142#ifdef CONFIG_USB_OTG
143 if (pdata->operating_mode == FSL_USB2_DR_OTG) {
144 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
145
146 hcd->phy = usb_get_phy(USB_PHY_TYPE_USB2);
147 dev_dbg(&pdev->dev, "hcd=0x%p ehci=0x%p, phy=0x%p\n",
148 hcd, ehci, hcd->phy);
149
150 if (!IS_ERR_OR_NULL(hcd->phy)) {
151 retval = otg_set_host(hcd->phy->otg,
152 &ehci_to_hcd(ehci)->self);
153 if (retval) {
154 usb_put_phy(hcd->phy);
155 goto err4;
156 }
157 } else {
158 dev_err(&pdev->dev, "can't find phy\n");
159 retval = -ENODEV;
160 goto err4;
161 }
162 }
163#endif
164 return retval;
165
166 err4:
167 iounmap(hcd->regs);
168 err3:
169 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
170 err2:
171 usb_put_hcd(hcd);
172 err1:
173 dev_err(&pdev->dev, "init %s fail, %d\n", dev_name(&pdev->dev), retval);
174 if (pdata->exit)
175 pdata->exit(pdev);
176 return retval;
177}
178
179
180
181
182
183
184
185
186
187
188
189
190static void usb_hcd_fsl_remove(struct usb_hcd *hcd,
191 struct platform_device *pdev)
192{
193 struct fsl_usb2_platform_data *pdata = pdev->dev.platform_data;
194
195 if (!IS_ERR_OR_NULL(hcd->phy)) {
196 otg_set_host(hcd->phy->otg, NULL);
197 usb_put_phy(hcd->phy);
198 }
199
200 usb_remove_hcd(hcd);
201
202
203
204
205
206 if (pdata->exit)
207 pdata->exit(pdev);
208 iounmap(hcd->regs);
209 release_mem_region(hcd->rsrc_start, hcd->rsrc_len);
210 usb_put_hcd(hcd);
211}
212
213static int ehci_fsl_setup_phy(struct usb_hcd *hcd,
214 enum fsl_usb2_phy_modes phy_mode,
215 unsigned int port_offset)
216{
217 u32 portsc;
218 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
219 void __iomem *non_ehci = hcd->regs;
220 struct device *dev = hcd->self.controller;
221 struct fsl_usb2_platform_data *pdata = dev->platform_data;
222
223 if (pdata->controller_ver < 0) {
224 dev_warn(hcd->self.controller, "Could not get controller version\n");
225 return -ENODEV;
226 }
227
228 portsc = ehci_readl(ehci, &ehci->regs->port_status[port_offset]);
229 portsc &= ~(PORT_PTS_MSK | PORT_PTS_PTW);
230
231 switch (phy_mode) {
232 case FSL_USB2_PHY_ULPI:
233 if (pdata->have_sysif_regs && pdata->controller_ver) {
234
235 setbits32(non_ehci + FSL_SOC_USB_CTRL,
236 ULPI_PHY_CLK_SEL);
237
238
239
240
241
242 clrsetbits_be32(non_ehci + FSL_SOC_USB_CTRL,
243 UTMI_PHY_EN, USB_CTRL_USB_EN);
244 }
245 portsc |= PORT_PTS_ULPI;
246 break;
247 case FSL_USB2_PHY_SERIAL:
248 portsc |= PORT_PTS_SERIAL;
249 break;
250 case FSL_USB2_PHY_UTMI_WIDE:
251 portsc |= PORT_PTS_PTW;
252
253 case FSL_USB2_PHY_UTMI:
254 if (pdata->have_sysif_regs && pdata->controller_ver) {
255
256 setbits32(non_ehci + FSL_SOC_USB_CTRL, UTMI_PHY_EN);
257 mdelay(FSL_UTMI_PHY_DLY);
258
259 }
260
261 if (pdata->have_sysif_regs)
262 setbits32(non_ehci + FSL_SOC_USB_CTRL,
263 CTRL_UTMI_PHY_EN);
264 portsc |= PORT_PTS_UTMI;
265 break;
266 case FSL_USB2_PHY_NONE:
267 break;
268 }
269
270 if (pdata->have_sysif_regs && pdata->controller_ver &&
271 (phy_mode == FSL_USB2_PHY_ULPI)) {
272
273 if (!spin_event_timeout(in_be32(non_ehci + FSL_SOC_USB_CTRL) &
274 PHY_CLK_VALID, FSL_USB_PHY_CLK_TIMEOUT, 0)) {
275 printk(KERN_WARNING "fsl-ehci: USB PHY clock invalid\n");
276 return -EINVAL;
277 }
278 }
279
280 ehci_writel(ehci, portsc, &ehci->regs->port_status[port_offset]);
281
282 if (phy_mode != FSL_USB2_PHY_ULPI && pdata->have_sysif_regs)
283 setbits32(non_ehci + FSL_SOC_USB_CTRL, USB_CTRL_USB_EN);
284
285 return 0;
286}
287
288static int ehci_fsl_usb_setup(struct ehci_hcd *ehci)
289{
290 struct usb_hcd *hcd = ehci_to_hcd(ehci);
291 struct fsl_usb2_platform_data *pdata;
292 void __iomem *non_ehci = hcd->regs;
293
294 pdata = hcd->self.controller->platform_data;
295
296 if (pdata->have_sysif_regs) {
297
298
299
300
301
302
303
304 out_be32(non_ehci + FSL_SOC_USB_SNOOP1, 0x0 | SNOOP_SIZE_2GB);
305
306 out_be32(non_ehci + FSL_SOC_USB_SNOOP2, 0x80000000 | SNOOP_SIZE_2GB);
307 }
308
309 if ((pdata->operating_mode == FSL_USB2_DR_HOST) ||
310 (pdata->operating_mode == FSL_USB2_DR_OTG))
311 if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0))
312 return -EINVAL;
313
314 if (pdata->operating_mode == FSL_USB2_MPH_HOST) {
315 unsigned int chip, rev, svr;
316
317 svr = mfspr(SPRN_SVR);
318 chip = svr >> 16;
319 rev = (svr >> 4) & 0xf;
320
321
322 if ((rev == 1) && (chip >= 0x8050) && (chip <= 0x8055))
323 ehci->has_fsl_port_bug = 1;
324
325 if (pdata->port_enables & FSL_USB2_PORT0_ENABLED)
326 if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 0))
327 return -EINVAL;
328
329 if (pdata->port_enables & FSL_USB2_PORT1_ENABLED)
330 if (ehci_fsl_setup_phy(hcd, pdata->phy_mode, 1))
331 return -EINVAL;
332 }
333
334 if (pdata->have_sysif_regs) {
335#ifdef CONFIG_FSL_SOC_BOOKE
336 out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x00000008);
337 out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000080);
338#else
339 out_be32(non_ehci + FSL_SOC_USB_PRICTRL, 0x0000000c);
340 out_be32(non_ehci + FSL_SOC_USB_AGECNTTHRSH, 0x00000040);
341#endif
342 out_be32(non_ehci + FSL_SOC_USB_SICTRL, 0x00000001);
343 }
344
345 return 0;
346}
347
348
349static int ehci_fsl_reinit(struct ehci_hcd *ehci)
350{
351 if (ehci_fsl_usb_setup(ehci))
352 return -EINVAL;
353
354 return 0;
355}
356
357
358static int ehci_fsl_setup(struct usb_hcd *hcd)
359{
360 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
361 int retval;
362 struct fsl_usb2_platform_data *pdata;
363 struct device *dev;
364
365 dev = hcd->self.controller;
366 pdata = hcd->self.controller->platform_data;
367 ehci->big_endian_desc = pdata->big_endian_desc;
368 ehci->big_endian_mmio = pdata->big_endian_mmio;
369
370
371 ehci->caps = hcd->regs + 0x100;
372
373#ifdef CONFIG_PPC_83xx
374
375
376
377
378
379 ehci->need_oc_pp_cycle = 1;
380#endif
381
382 hcd->has_tt = 1;
383
384 retval = ehci_setup(hcd);
385 if (retval)
386 return retval;
387
388 if (of_device_is_compatible(dev->parent->of_node,
389 "fsl,mpc5121-usb2-dr")) {
390
391
392
393
394 ehci_writel(ehci, SBUSCFG_INCR8,
395 hcd->regs + FSL_SOC_USB_SBUSCFG);
396 }
397
398 retval = ehci_fsl_reinit(ehci);
399 return retval;
400}
401
402struct ehci_fsl {
403 struct ehci_hcd ehci;
404
405#ifdef CONFIG_PM
406
407 u32 usb_ctrl;
408#endif
409};
410
411#ifdef CONFIG_PM
412
413#ifdef CONFIG_PPC_MPC512x
414static int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
415{
416 struct usb_hcd *hcd = dev_get_drvdata(dev);
417 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
418 struct fsl_usb2_platform_data *pdata = dev->platform_data;
419 u32 tmp;
420
421#ifdef DEBUG
422 u32 mode = ehci_readl(ehci, hcd->regs + FSL_SOC_USB_USBMODE);
423 mode &= USBMODE_CM_MASK;
424 tmp = ehci_readl(ehci, hcd->regs + 0x140);
425
426 dev_dbg(dev, "suspend=%d already_suspended=%d "
427 "mode=%d usbcmd %08x\n", pdata->suspended,
428 pdata->already_suspended, mode, tmp);
429#endif
430
431
432
433
434
435
436 if (pdata->suspended) {
437 dev_dbg(dev, "already suspended, leaving early\n");
438 pdata->already_suspended = 1;
439 return 0;
440 }
441
442 dev_dbg(dev, "suspending...\n");
443
444 ehci->rh_state = EHCI_RH_SUSPENDED;
445 dev->power.power_state = PMSG_SUSPEND;
446
447
448 clear_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
449
450
451 tmp = ehci_readl(ehci, &ehci->regs->command);
452 tmp &= ~CMD_RUN;
453 ehci_writel(ehci, tmp, &ehci->regs->command);
454
455
456 pdata->pm_command = ehci_readl(ehci, &ehci->regs->command);
457 pdata->pm_command &= ~CMD_RUN;
458 pdata->pm_status = ehci_readl(ehci, &ehci->regs->status);
459 pdata->pm_intr_enable = ehci_readl(ehci, &ehci->regs->intr_enable);
460 pdata->pm_frame_index = ehci_readl(ehci, &ehci->regs->frame_index);
461 pdata->pm_segment = ehci_readl(ehci, &ehci->regs->segment);
462 pdata->pm_frame_list = ehci_readl(ehci, &ehci->regs->frame_list);
463 pdata->pm_async_next = ehci_readl(ehci, &ehci->regs->async_next);
464 pdata->pm_configured_flag =
465 ehci_readl(ehci, &ehci->regs->configured_flag);
466 pdata->pm_portsc = ehci_readl(ehci, &ehci->regs->port_status[0]);
467 pdata->pm_usbgenctrl = ehci_readl(ehci,
468 hcd->regs + FSL_SOC_USB_USBGENCTRL);
469
470
471 pdata->pm_portsc &= cpu_to_hc32(ehci, ~PORT_RWC_BITS);
472
473 pdata->suspended = 1;
474
475
476 tmp = ehci_readl(ehci, &ehci->regs->port_status[0]);
477 tmp &= ~PORT_POWER;
478 ehci_writel(ehci, tmp, &ehci->regs->port_status[0]);
479
480 return 0;
481}
482
483static int ehci_fsl_mpc512x_drv_resume(struct device *dev)
484{
485 struct usb_hcd *hcd = dev_get_drvdata(dev);
486 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
487 struct fsl_usb2_platform_data *pdata = dev->platform_data;
488 u32 tmp;
489
490 dev_dbg(dev, "suspend=%d already_suspended=%d\n",
491 pdata->suspended, pdata->already_suspended);
492
493
494
495
496
497 if (pdata->already_suspended) {
498 dev_dbg(dev, "already suspended, leaving early\n");
499 pdata->already_suspended = 0;
500 return 0;
501 }
502
503 if (!pdata->suspended) {
504 dev_dbg(dev, "not suspended, leaving early\n");
505 return 0;
506 }
507
508 pdata->suspended = 0;
509
510 dev_dbg(dev, "resuming...\n");
511
512
513 tmp = USBMODE_CM_HOST | (pdata->es ? USBMODE_ES : 0);
514 ehci_writel(ehci, tmp, hcd->regs + FSL_SOC_USB_USBMODE);
515
516 ehci_writel(ehci, pdata->pm_usbgenctrl,
517 hcd->regs + FSL_SOC_USB_USBGENCTRL);
518 ehci_writel(ehci, ISIPHYCTRL_PXE | ISIPHYCTRL_PHYE,
519 hcd->regs + FSL_SOC_USB_ISIPHYCTRL);
520
521 ehci_writel(ehci, SBUSCFG_INCR8, hcd->regs + FSL_SOC_USB_SBUSCFG);
522
523
524 ehci_writel(ehci, pdata->pm_command, &ehci->regs->command);
525 ehci_writel(ehci, pdata->pm_intr_enable, &ehci->regs->intr_enable);
526 ehci_writel(ehci, pdata->pm_frame_index, &ehci->regs->frame_index);
527 ehci_writel(ehci, pdata->pm_segment, &ehci->regs->segment);
528 ehci_writel(ehci, pdata->pm_frame_list, &ehci->regs->frame_list);
529 ehci_writel(ehci, pdata->pm_async_next, &ehci->regs->async_next);
530 ehci_writel(ehci, pdata->pm_configured_flag,
531 &ehci->regs->configured_flag);
532 ehci_writel(ehci, pdata->pm_portsc, &ehci->regs->port_status[0]);
533
534 set_bit(HCD_FLAG_HW_ACCESSIBLE, &hcd->flags);
535 ehci->rh_state = EHCI_RH_RUNNING;
536 dev->power.power_state = PMSG_ON;
537
538 tmp = ehci_readl(ehci, &ehci->regs->command);
539 tmp |= CMD_RUN;
540 ehci_writel(ehci, tmp, &ehci->regs->command);
541
542 usb_hcd_resume_root_hub(hcd);
543
544 return 0;
545}
546#else
547static inline int ehci_fsl_mpc512x_drv_suspend(struct device *dev)
548{
549 return 0;
550}
551
552static inline int ehci_fsl_mpc512x_drv_resume(struct device *dev)
553{
554 return 0;
555}
556#endif
557
558static struct ehci_fsl *hcd_to_ehci_fsl(struct usb_hcd *hcd)
559{
560 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
561
562 return container_of(ehci, struct ehci_fsl, ehci);
563}
564
565static int ehci_fsl_drv_suspend(struct device *dev)
566{
567 struct usb_hcd *hcd = dev_get_drvdata(dev);
568 struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
569 void __iomem *non_ehci = hcd->regs;
570
571 if (of_device_is_compatible(dev->parent->of_node,
572 "fsl,mpc5121-usb2-dr")) {
573 return ehci_fsl_mpc512x_drv_suspend(dev);
574 }
575
576 ehci_prepare_ports_for_controller_suspend(hcd_to_ehci(hcd),
577 device_may_wakeup(dev));
578 if (!fsl_deep_sleep())
579 return 0;
580
581 ehci_fsl->usb_ctrl = in_be32(non_ehci + FSL_SOC_USB_CTRL);
582 return 0;
583}
584
585static int ehci_fsl_drv_resume(struct device *dev)
586{
587 struct usb_hcd *hcd = dev_get_drvdata(dev);
588 struct ehci_fsl *ehci_fsl = hcd_to_ehci_fsl(hcd);
589 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
590 void __iomem *non_ehci = hcd->regs;
591
592 if (of_device_is_compatible(dev->parent->of_node,
593 "fsl,mpc5121-usb2-dr")) {
594 return ehci_fsl_mpc512x_drv_resume(dev);
595 }
596
597 ehci_prepare_ports_for_controller_resume(ehci);
598 if (!fsl_deep_sleep())
599 return 0;
600
601 usb_root_hub_lost_power(hcd->self.root_hub);
602
603
604 out_be32(non_ehci + FSL_SOC_USB_CTRL, ehci_fsl->usb_ctrl);
605
606 ehci_reset(ehci);
607 ehci_fsl_reinit(ehci);
608
609 return 0;
610}
611
612static int ehci_fsl_drv_restore(struct device *dev)
613{
614 struct usb_hcd *hcd = dev_get_drvdata(dev);
615
616 usb_root_hub_lost_power(hcd->self.root_hub);
617 return 0;
618}
619
620static struct dev_pm_ops ehci_fsl_pm_ops = {
621 .suspend = ehci_fsl_drv_suspend,
622 .resume = ehci_fsl_drv_resume,
623 .restore = ehci_fsl_drv_restore,
624};
625
626#define EHCI_FSL_PM_OPS (&ehci_fsl_pm_ops)
627#else
628#define EHCI_FSL_PM_OPS NULL
629#endif
630
631#ifdef CONFIG_USB_OTG
632static int ehci_start_port_reset(struct usb_hcd *hcd, unsigned port)
633{
634 struct ehci_hcd *ehci = hcd_to_ehci(hcd);
635 u32 status;
636
637 if (!port)
638 return -EINVAL;
639
640 port--;
641
642
643 status = readl(&ehci->regs->port_status[port]);
644 if (!(status & PORT_CONNECT))
645 return -ENODEV;
646
647
648 if (ehci_is_TDI(ehci)) {
649 writel(PORT_RESET |
650 (status & ~(PORT_CSC | PORT_PEC | PORT_OCC)),
651 &ehci->regs->port_status[port]);
652 } else {
653 writel(PORT_RESET, &ehci->regs->port_status[port]);
654 }
655
656 return 0;
657}
658#else
659#define ehci_start_port_reset NULL
660#endif
661
662
663static const struct hc_driver ehci_fsl_hc_driver = {
664 .description = hcd_name,
665 .product_desc = "Freescale On-Chip EHCI Host Controller",
666 .hcd_priv_size = sizeof(struct ehci_fsl),
667
668
669
670
671 .irq = ehci_irq,
672 .flags = HCD_USB2 | HCD_MEMORY,
673
674
675
676
677 .reset = ehci_fsl_setup,
678 .start = ehci_run,
679 .stop = ehci_stop,
680 .shutdown = ehci_shutdown,
681
682
683
684
685 .urb_enqueue = ehci_urb_enqueue,
686 .urb_dequeue = ehci_urb_dequeue,
687 .endpoint_disable = ehci_endpoint_disable,
688 .endpoint_reset = ehci_endpoint_reset,
689
690
691
692
693 .get_frame_number = ehci_get_frame,
694
695
696
697
698 .hub_status_data = ehci_hub_status_data,
699 .hub_control = ehci_hub_control,
700 .bus_suspend = ehci_bus_suspend,
701 .bus_resume = ehci_bus_resume,
702 .start_port_reset = ehci_start_port_reset,
703 .relinquish_port = ehci_relinquish_port,
704 .port_handed_over = ehci_port_handed_over,
705
706 .clear_tt_buffer_complete = ehci_clear_tt_buffer_complete,
707};
708
709static int ehci_fsl_drv_probe(struct platform_device *pdev)
710{
711 if (usb_disabled())
712 return -ENODEV;
713
714
715 return usb_hcd_fsl_probe(&ehci_fsl_hc_driver, pdev);
716}
717
718static int ehci_fsl_drv_remove(struct platform_device *pdev)
719{
720 struct usb_hcd *hcd = platform_get_drvdata(pdev);
721
722
723 usb_hcd_fsl_remove(hcd, pdev);
724 return 0;
725}
726
727MODULE_ALIAS("platform:fsl-ehci");
728
729static struct platform_driver ehci_fsl_driver = {
730 .probe = ehci_fsl_drv_probe,
731 .remove = ehci_fsl_drv_remove,
732 .shutdown = usb_hcd_platform_shutdown,
733 .driver = {
734 .name = "fsl-ehci",
735 .pm = EHCI_FSL_PM_OPS,
736 },
737};
738