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
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43#include <linux/kernel.h>
44#include <linux/module.h>
45#include <linux/moduleparam.h>
46#include <linux/spinlock.h>
47#include <linux/interrupt.h>
48#include <linux/dma-mapping.h>
49#include <linux/delay.h>
50#include <linux/io.h>
51#include <linux/slab.h>
52#include <linux/usb.h>
53
54#include <linux/usb/hcd.h>
55#include <linux/usb/ch11.h>
56
57#include "core.h"
58#include "hcd.h"
59
60
61
62
63
64
65
66
67int dwc2_backup_global_registers(struct dwc2_hsotg *hsotg)
68{
69 struct dwc2_gregs_backup *gr;
70
71 dev_dbg(hsotg->dev, "%s\n", __func__);
72
73
74 gr = &hsotg->gr_backup;
75
76 gr->gotgctl = dwc2_readl(hsotg, GOTGCTL);
77 gr->gintmsk = dwc2_readl(hsotg, GINTMSK);
78 gr->gahbcfg = dwc2_readl(hsotg, GAHBCFG);
79 gr->gusbcfg = dwc2_readl(hsotg, GUSBCFG);
80 gr->grxfsiz = dwc2_readl(hsotg, GRXFSIZ);
81 gr->gnptxfsiz = dwc2_readl(hsotg, GNPTXFSIZ);
82 gr->gdfifocfg = dwc2_readl(hsotg, GDFIFOCFG);
83 gr->pcgcctl1 = dwc2_readl(hsotg, PCGCCTL1);
84 gr->glpmcfg = dwc2_readl(hsotg, GLPMCFG);
85 gr->gi2cctl = dwc2_readl(hsotg, GI2CCTL);
86 gr->pcgcctl = dwc2_readl(hsotg, PCGCTL);
87
88 gr->valid = true;
89 return 0;
90}
91
92
93
94
95
96
97
98
99int dwc2_restore_global_registers(struct dwc2_hsotg *hsotg)
100{
101 struct dwc2_gregs_backup *gr;
102
103 dev_dbg(hsotg->dev, "%s\n", __func__);
104
105
106 gr = &hsotg->gr_backup;
107 if (!gr->valid) {
108 dev_err(hsotg->dev, "%s: no global registers to restore\n",
109 __func__);
110 return -EINVAL;
111 }
112 gr->valid = false;
113
114 dwc2_writel(hsotg, 0xffffffff, GINTSTS);
115 dwc2_writel(hsotg, gr->gotgctl, GOTGCTL);
116 dwc2_writel(hsotg, gr->gintmsk, GINTMSK);
117 dwc2_writel(hsotg, gr->gusbcfg, GUSBCFG);
118 dwc2_writel(hsotg, gr->gahbcfg, GAHBCFG);
119 dwc2_writel(hsotg, gr->grxfsiz, GRXFSIZ);
120 dwc2_writel(hsotg, gr->gnptxfsiz, GNPTXFSIZ);
121 dwc2_writel(hsotg, gr->gdfifocfg, GDFIFOCFG);
122 dwc2_writel(hsotg, gr->pcgcctl1, PCGCCTL1);
123 dwc2_writel(hsotg, gr->glpmcfg, GLPMCFG);
124 dwc2_writel(hsotg, gr->pcgcctl, PCGCTL);
125 dwc2_writel(hsotg, gr->gi2cctl, GI2CCTL);
126
127 return 0;
128}
129
130
131
132
133
134
135
136int dwc2_exit_partial_power_down(struct dwc2_hsotg *hsotg, bool restore)
137{
138 u32 pcgcctl;
139 int ret = 0;
140
141 if (hsotg->params.power_down != DWC2_POWER_DOWN_PARAM_PARTIAL)
142 return -ENOTSUPP;
143
144 pcgcctl = dwc2_readl(hsotg, PCGCTL);
145 pcgcctl &= ~PCGCTL_STOPPCLK;
146 dwc2_writel(hsotg, pcgcctl, PCGCTL);
147
148 pcgcctl = dwc2_readl(hsotg, PCGCTL);
149 pcgcctl &= ~PCGCTL_PWRCLMP;
150 dwc2_writel(hsotg, pcgcctl, PCGCTL);
151
152 pcgcctl = dwc2_readl(hsotg, PCGCTL);
153 pcgcctl &= ~PCGCTL_RSTPDWNMODULE;
154 dwc2_writel(hsotg, pcgcctl, PCGCTL);
155
156 udelay(100);
157 if (restore) {
158 ret = dwc2_restore_global_registers(hsotg);
159 if (ret) {
160 dev_err(hsotg->dev, "%s: failed to restore registers\n",
161 __func__);
162 return ret;
163 }
164 if (dwc2_is_host_mode(hsotg)) {
165 ret = dwc2_restore_host_registers(hsotg);
166 if (ret) {
167 dev_err(hsotg->dev, "%s: failed to restore host registers\n",
168 __func__);
169 return ret;
170 }
171 } else {
172 ret = dwc2_restore_device_registers(hsotg, 0);
173 if (ret) {
174 dev_err(hsotg->dev, "%s: failed to restore device registers\n",
175 __func__);
176 return ret;
177 }
178 }
179 }
180
181 return ret;
182}
183
184
185
186
187
188
189int dwc2_enter_partial_power_down(struct dwc2_hsotg *hsotg)
190{
191 u32 pcgcctl;
192 int ret = 0;
193
194 if (!hsotg->params.power_down)
195 return -ENOTSUPP;
196
197
198 ret = dwc2_backup_global_registers(hsotg);
199 if (ret) {
200 dev_err(hsotg->dev, "%s: failed to backup global registers\n",
201 __func__);
202 return ret;
203 }
204
205 if (dwc2_is_host_mode(hsotg)) {
206 ret = dwc2_backup_host_registers(hsotg);
207 if (ret) {
208 dev_err(hsotg->dev, "%s: failed to backup host registers\n",
209 __func__);
210 return ret;
211 }
212 } else {
213 ret = dwc2_backup_device_registers(hsotg);
214 if (ret) {
215 dev_err(hsotg->dev, "%s: failed to backup device registers\n",
216 __func__);
217 return ret;
218 }
219 }
220
221
222
223
224
225 dwc2_writel(hsotg, 0xffffffff, GINTSTS);
226
227
228 pcgcctl = dwc2_readl(hsotg, PCGCTL);
229
230 pcgcctl |= PCGCTL_PWRCLMP;
231 dwc2_writel(hsotg, pcgcctl, PCGCTL);
232 ndelay(20);
233
234 pcgcctl |= PCGCTL_RSTPDWNMODULE;
235 dwc2_writel(hsotg, pcgcctl, PCGCTL);
236 ndelay(20);
237
238 pcgcctl |= PCGCTL_STOPPCLK;
239 dwc2_writel(hsotg, pcgcctl, PCGCTL);
240
241 return ret;
242}
243
244
245
246
247
248
249
250
251static void dwc2_restore_essential_regs(struct dwc2_hsotg *hsotg, int rmode,
252 int is_host)
253{
254 u32 pcgcctl;
255 struct dwc2_gregs_backup *gr;
256 struct dwc2_dregs_backup *dr;
257 struct dwc2_hregs_backup *hr;
258
259 gr = &hsotg->gr_backup;
260 dr = &hsotg->dr_backup;
261 hr = &hsotg->hr_backup;
262
263 dev_dbg(hsotg->dev, "%s: restoring essential regs\n", __func__);
264
265
266 pcgcctl = (gr->pcgcctl & 0xffffc000);
267
268 if (is_host) {
269 if (!(pcgcctl & PCGCTL_P2HD_PRT_SPD_MASK))
270 pcgcctl |= BIT(17);
271 } else {
272 if (!(pcgcctl & PCGCTL_P2HD_DEV_ENUM_SPD_MASK))
273 pcgcctl |= BIT(17);
274 }
275 dwc2_writel(hsotg, pcgcctl, PCGCTL);
276
277
278 dwc2_writel(hsotg, gr->gahbcfg | GAHBCFG_GLBL_INTR_EN, GAHBCFG);
279
280
281 dwc2_writel(hsotg, 0xffffffff, GINTSTS);
282
283
284 dwc2_writel(hsotg, GINTSTS_RESTOREDONE, GINTMSK);
285
286
287 dwc2_writel(hsotg, gr->gusbcfg, GUSBCFG);
288
289 if (is_host) {
290 dwc2_writel(hsotg, hr->hcfg, HCFG);
291 if (rmode)
292 pcgcctl |= PCGCTL_RESTOREMODE;
293 dwc2_writel(hsotg, pcgcctl, PCGCTL);
294 udelay(10);
295
296 pcgcctl |= PCGCTL_ESS_REG_RESTORED;
297 dwc2_writel(hsotg, pcgcctl, PCGCTL);
298 udelay(10);
299 } else {
300 dwc2_writel(hsotg, dr->dcfg, DCFG);
301 if (!rmode)
302 pcgcctl |= PCGCTL_RESTOREMODE | PCGCTL_RSTPDWNMODULE;
303 dwc2_writel(hsotg, pcgcctl, PCGCTL);
304 udelay(10);
305
306 pcgcctl |= PCGCTL_ESS_REG_RESTORED;
307 dwc2_writel(hsotg, pcgcctl, PCGCTL);
308 udelay(10);
309 }
310}
311
312
313
314
315
316
317
318
319void dwc2_hib_restore_common(struct dwc2_hsotg *hsotg, int rem_wakeup,
320 int is_host)
321{
322 u32 gpwrdn;
323
324
325 gpwrdn = dwc2_readl(hsotg, GPWRDN);
326 gpwrdn &= ~GPWRDN_PWRDNSWTCH;
327 dwc2_writel(hsotg, gpwrdn, GPWRDN);
328 udelay(10);
329
330
331 gpwrdn = dwc2_readl(hsotg, GPWRDN);
332 gpwrdn &= ~GPWRDN_PWRDNRSTN;
333 dwc2_writel(hsotg, gpwrdn, GPWRDN);
334 udelay(10);
335
336
337 gpwrdn = dwc2_readl(hsotg, GPWRDN);
338 gpwrdn |= GPWRDN_RESTORE;
339 dwc2_writel(hsotg, gpwrdn, GPWRDN);
340 udelay(10);
341
342
343 gpwrdn = dwc2_readl(hsotg, GPWRDN);
344 gpwrdn &= ~GPWRDN_PWRDNCLMP;
345 dwc2_writel(hsotg, gpwrdn, GPWRDN);
346 udelay(50);
347
348 if (!is_host && rem_wakeup)
349 udelay(70);
350
351
352 gpwrdn = dwc2_readl(hsotg, GPWRDN);
353 gpwrdn |= GPWRDN_PWRDNRSTN;
354 dwc2_writel(hsotg, gpwrdn, GPWRDN);
355 udelay(10);
356
357
358 gpwrdn = dwc2_readl(hsotg, GPWRDN);
359 gpwrdn &= ~GPWRDN_PMUINTSEL;
360 dwc2_writel(hsotg, gpwrdn, GPWRDN);
361 udelay(10);
362
363
364 dwc2_restore_essential_regs(hsotg, rem_wakeup, is_host);
365
366
367
368
369
370 if (dwc2_hsotg_wait_bit_set(hsotg, GINTSTS, GINTSTS_RESTOREDONE,
371 20000)) {
372 dev_dbg(hsotg->dev,
373 "%s: Restore Done wan't generated here\n",
374 __func__);
375 } else {
376 dev_dbg(hsotg->dev, "restore done generated here\n");
377 }
378}
379
380
381
382
383
384
385static void dwc2_wait_for_mode(struct dwc2_hsotg *hsotg,
386 bool host_mode)
387{
388 ktime_t start;
389 ktime_t end;
390 unsigned int timeout = 110;
391
392 dev_vdbg(hsotg->dev, "Waiting for %s mode\n",
393 host_mode ? "host" : "device");
394
395 start = ktime_get();
396
397 while (1) {
398 s64 ms;
399
400 if (dwc2_is_host_mode(hsotg) == host_mode) {
401 dev_vdbg(hsotg->dev, "%s mode set\n",
402 host_mode ? "Host" : "Device");
403 break;
404 }
405
406 end = ktime_get();
407 ms = ktime_to_ms(ktime_sub(end, start));
408
409 if (ms >= (s64)timeout) {
410 dev_warn(hsotg->dev, "%s: Couldn't set %s mode\n",
411 __func__, host_mode ? "host" : "device");
412 break;
413 }
414
415 usleep_range(1000, 2000);
416 }
417}
418
419
420
421
422
423
424
425static bool dwc2_iddig_filter_enabled(struct dwc2_hsotg *hsotg)
426{
427 u32 gsnpsid;
428 u32 ghwcfg4;
429
430 if (!dwc2_hw_is_otg(hsotg))
431 return false;
432
433
434 ghwcfg4 = dwc2_readl(hsotg, GHWCFG4);
435 if (!(ghwcfg4 & GHWCFG4_IDDIG_FILT_EN))
436 return false;
437
438
439
440
441
442 gsnpsid = dwc2_readl(hsotg, GSNPSID);
443 if (gsnpsid >= DWC2_CORE_REV_3_10a) {
444 u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);
445
446 if (gotgctl & GOTGCTL_DBNCE_FLTR_BYPASS)
447 return false;
448 }
449
450 return true;
451}
452
453
454
455
456
457
458
459
460
461int dwc2_enter_hibernation(struct dwc2_hsotg *hsotg, int is_host)
462{
463 if (hsotg->params.power_down != DWC2_POWER_DOWN_PARAM_HIBERNATION)
464 return -ENOTSUPP;
465
466 if (is_host)
467 return dwc2_host_enter_hibernation(hsotg);
468 else
469 return dwc2_gadget_enter_hibernation(hsotg);
470}
471
472
473
474
475
476
477
478
479
480
481
482int dwc2_exit_hibernation(struct dwc2_hsotg *hsotg, int rem_wakeup,
483 int reset, int is_host)
484{
485 if (is_host)
486 return dwc2_host_exit_hibernation(hsotg, rem_wakeup, reset);
487 else
488 return dwc2_gadget_exit_hibernation(hsotg, rem_wakeup, reset);
489}
490
491
492
493
494
495int dwc2_core_reset(struct dwc2_hsotg *hsotg, bool skip_wait)
496{
497 u32 greset;
498 bool wait_for_host_mode = false;
499
500 dev_vdbg(hsotg->dev, "%s()\n", __func__);
501
502
503
504
505
506
507
508
509
510
511
512 if (dwc2_iddig_filter_enabled(hsotg)) {
513 u32 gotgctl = dwc2_readl(hsotg, GOTGCTL);
514 u32 gusbcfg = dwc2_readl(hsotg, GUSBCFG);
515
516 if (!(gotgctl & GOTGCTL_CONID_B) ||
517 (gusbcfg & GUSBCFG_FORCEHOSTMODE)) {
518 wait_for_host_mode = true;
519 }
520 }
521
522
523 greset = dwc2_readl(hsotg, GRSTCTL);
524 greset |= GRSTCTL_CSFTRST;
525 dwc2_writel(hsotg, greset, GRSTCTL);
526
527 if (dwc2_hsotg_wait_bit_clear(hsotg, GRSTCTL, GRSTCTL_CSFTRST, 10000)) {
528 dev_warn(hsotg->dev, "%s: HANG! Soft Reset timeout GRSTCTL GRSTCTL_CSFTRST\n",
529 __func__);
530 return -EBUSY;
531 }
532
533
534 if (dwc2_hsotg_wait_bit_set(hsotg, GRSTCTL, GRSTCTL_AHBIDLE, 10000)) {
535 dev_warn(hsotg->dev, "%s: HANG! AHB Idle timeout GRSTCTL GRSTCTL_AHBIDLE\n",
536 __func__);
537 return -EBUSY;
538 }
539
540 if (wait_for_host_mode && !skip_wait)
541 dwc2_wait_for_mode(hsotg, true);
542
543 return 0;
544}
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573void dwc2_force_mode(struct dwc2_hsotg *hsotg, bool host)
574{
575 u32 gusbcfg;
576 u32 set;
577 u32 clear;
578
579 dev_dbg(hsotg->dev, "Forcing mode to %s\n", host ? "host" : "device");
580
581
582
583
584 if (!dwc2_hw_is_otg(hsotg))
585 return;
586
587
588
589
590
591 if (WARN_ON(host && hsotg->dr_mode == USB_DR_MODE_PERIPHERAL))
592 return;
593
594 if (WARN_ON(!host && hsotg->dr_mode == USB_DR_MODE_HOST))
595 return;
596
597 gusbcfg = dwc2_readl(hsotg, GUSBCFG);
598
599 set = host ? GUSBCFG_FORCEHOSTMODE : GUSBCFG_FORCEDEVMODE;
600 clear = host ? GUSBCFG_FORCEDEVMODE : GUSBCFG_FORCEHOSTMODE;
601
602 gusbcfg &= ~clear;
603 gusbcfg |= set;
604 dwc2_writel(hsotg, gusbcfg, GUSBCFG);
605
606 dwc2_wait_for_mode(hsotg, host);
607 return;
608}
609
610
611
612
613
614
615
616
617
618
619
620
621static void dwc2_clear_force_mode(struct dwc2_hsotg *hsotg)
622{
623 u32 gusbcfg;
624
625 if (!dwc2_hw_is_otg(hsotg))
626 return;
627
628 dev_dbg(hsotg->dev, "Clearing force mode bits\n");
629
630 gusbcfg = dwc2_readl(hsotg, GUSBCFG);
631 gusbcfg &= ~GUSBCFG_FORCEHOSTMODE;
632 gusbcfg &= ~GUSBCFG_FORCEDEVMODE;
633 dwc2_writel(hsotg, gusbcfg, GUSBCFG);
634
635 if (dwc2_iddig_filter_enabled(hsotg))
636 msleep(100);
637}
638
639
640
641
642void dwc2_force_dr_mode(struct dwc2_hsotg *hsotg)
643{
644 switch (hsotg->dr_mode) {
645 case USB_DR_MODE_HOST:
646
647
648
649
650 if (!dwc2_hw_is_otg(hsotg))
651 msleep(50);
652
653 break;
654 case USB_DR_MODE_PERIPHERAL:
655 dwc2_force_mode(hsotg, false);
656 break;
657 case USB_DR_MODE_OTG:
658 dwc2_clear_force_mode(hsotg);
659 break;
660 default:
661 dev_warn(hsotg->dev, "%s() Invalid dr_mode=%d\n",
662 __func__, hsotg->dr_mode);
663 break;
664 }
665}
666
667
668
669
670void dwc2_enable_acg(struct dwc2_hsotg *hsotg)
671{
672 if (hsotg->params.acg_enable) {
673 u32 pcgcctl1 = dwc2_readl(hsotg, PCGCCTL1);
674
675 dev_dbg(hsotg->dev, "Enabling Active Clock Gating\n");
676 pcgcctl1 |= PCGCCTL1_GATEEN;
677 dwc2_writel(hsotg, pcgcctl1, PCGCCTL1);
678 }
679}
680
681
682
683
684
685
686
687
688
689void dwc2_dump_host_registers(struct dwc2_hsotg *hsotg)
690{
691#ifdef DEBUG
692 u32 __iomem *addr;
693 int i;
694
695 dev_dbg(hsotg->dev, "Host Global Registers\n");
696 addr = hsotg->regs + HCFG;
697 dev_dbg(hsotg->dev, "HCFG @0x%08lX : 0x%08X\n",
698 (unsigned long)addr, dwc2_readl(hsotg, HCFG));
699 addr = hsotg->regs + HFIR;
700 dev_dbg(hsotg->dev, "HFIR @0x%08lX : 0x%08X\n",
701 (unsigned long)addr, dwc2_readl(hsotg, HFIR));
702 addr = hsotg->regs + HFNUM;
703 dev_dbg(hsotg->dev, "HFNUM @0x%08lX : 0x%08X\n",
704 (unsigned long)addr, dwc2_readl(hsotg, HFNUM));
705 addr = hsotg->regs + HPTXSTS;
706 dev_dbg(hsotg->dev, "HPTXSTS @0x%08lX : 0x%08X\n",
707 (unsigned long)addr, dwc2_readl(hsotg, HPTXSTS));
708 addr = hsotg->regs + HAINT;
709 dev_dbg(hsotg->dev, "HAINT @0x%08lX : 0x%08X\n",
710 (unsigned long)addr, dwc2_readl(hsotg, HAINT));
711 addr = hsotg->regs + HAINTMSK;
712 dev_dbg(hsotg->dev, "HAINTMSK @0x%08lX : 0x%08X\n",
713 (unsigned long)addr, dwc2_readl(hsotg, HAINTMSK));
714 if (hsotg->params.dma_desc_enable) {
715 addr = hsotg->regs + HFLBADDR;
716 dev_dbg(hsotg->dev, "HFLBADDR @0x%08lX : 0x%08X\n",
717 (unsigned long)addr, dwc2_readl(hsotg, HFLBADDR));
718 }
719
720 addr = hsotg->regs + HPRT0;
721 dev_dbg(hsotg->dev, "HPRT0 @0x%08lX : 0x%08X\n",
722 (unsigned long)addr, dwc2_readl(hsotg, HPRT0));
723
724 for (i = 0; i < hsotg->params.host_channels; i++) {
725 dev_dbg(hsotg->dev, "Host Channel %d Specific Registers\n", i);
726 addr = hsotg->regs + HCCHAR(i);
727 dev_dbg(hsotg->dev, "HCCHAR @0x%08lX : 0x%08X\n",
728 (unsigned long)addr, dwc2_readl(hsotg, HCCHAR(i)));
729 addr = hsotg->regs + HCSPLT(i);
730 dev_dbg(hsotg->dev, "HCSPLT @0x%08lX : 0x%08X\n",
731 (unsigned long)addr, dwc2_readl(hsotg, HCSPLT(i)));
732 addr = hsotg->regs + HCINT(i);
733 dev_dbg(hsotg->dev, "HCINT @0x%08lX : 0x%08X\n",
734 (unsigned long)addr, dwc2_readl(hsotg, HCINT(i)));
735 addr = hsotg->regs + HCINTMSK(i);
736 dev_dbg(hsotg->dev, "HCINTMSK @0x%08lX : 0x%08X\n",
737 (unsigned long)addr, dwc2_readl(hsotg, HCINTMSK(i)));
738 addr = hsotg->regs + HCTSIZ(i);
739 dev_dbg(hsotg->dev, "HCTSIZ @0x%08lX : 0x%08X\n",
740 (unsigned long)addr, dwc2_readl(hsotg, HCTSIZ(i)));
741 addr = hsotg->regs + HCDMA(i);
742 dev_dbg(hsotg->dev, "HCDMA @0x%08lX : 0x%08X\n",
743 (unsigned long)addr, dwc2_readl(hsotg, HCDMA(i)));
744 if (hsotg->params.dma_desc_enable) {
745 addr = hsotg->regs + HCDMAB(i);
746 dev_dbg(hsotg->dev, "HCDMAB @0x%08lX : 0x%08X\n",
747 (unsigned long)addr, dwc2_readl(hsotg,
748 HCDMAB(i)));
749 }
750 }
751#endif
752}
753
754
755
756
757
758
759
760
761
762void dwc2_dump_global_registers(struct dwc2_hsotg *hsotg)
763{
764#ifdef DEBUG
765 u32 __iomem *addr;
766
767 dev_dbg(hsotg->dev, "Core Global Registers\n");
768 addr = hsotg->regs + GOTGCTL;
769 dev_dbg(hsotg->dev, "GOTGCTL @0x%08lX : 0x%08X\n",
770 (unsigned long)addr, dwc2_readl(hsotg, GOTGCTL));
771 addr = hsotg->regs + GOTGINT;
772 dev_dbg(hsotg->dev, "GOTGINT @0x%08lX : 0x%08X\n",
773 (unsigned long)addr, dwc2_readl(hsotg, GOTGINT));
774 addr = hsotg->regs + GAHBCFG;
775 dev_dbg(hsotg->dev, "GAHBCFG @0x%08lX : 0x%08X\n",
776 (unsigned long)addr, dwc2_readl(hsotg, GAHBCFG));
777 addr = hsotg->regs + GUSBCFG;
778 dev_dbg(hsotg->dev, "GUSBCFG @0x%08lX : 0x%08X\n",
779 (unsigned long)addr, dwc2_readl(hsotg, GUSBCFG));
780 addr = hsotg->regs + GRSTCTL;
781 dev_dbg(hsotg->dev, "GRSTCTL @0x%08lX : 0x%08X\n",
782 (unsigned long)addr, dwc2_readl(hsotg, GRSTCTL));
783 addr = hsotg->regs + GINTSTS;
784 dev_dbg(hsotg->dev, "GINTSTS @0x%08lX : 0x%08X\n",
785 (unsigned long)addr, dwc2_readl(hsotg, GINTSTS));
786 addr = hsotg->regs + GINTMSK;
787 dev_dbg(hsotg->dev, "GINTMSK @0x%08lX : 0x%08X\n",
788 (unsigned long)addr, dwc2_readl(hsotg, GINTMSK));
789 addr = hsotg->regs + GRXSTSR;
790 dev_dbg(hsotg->dev, "GRXSTSR @0x%08lX : 0x%08X\n",
791 (unsigned long)addr, dwc2_readl(hsotg, GRXSTSR));
792 addr = hsotg->regs + GRXFSIZ;
793 dev_dbg(hsotg->dev, "GRXFSIZ @0x%08lX : 0x%08X\n",
794 (unsigned long)addr, dwc2_readl(hsotg, GRXFSIZ));
795 addr = hsotg->regs + GNPTXFSIZ;
796 dev_dbg(hsotg->dev, "GNPTXFSIZ @0x%08lX : 0x%08X\n",
797 (unsigned long)addr, dwc2_readl(hsotg, GNPTXFSIZ));
798 addr = hsotg->regs + GNPTXSTS;
799 dev_dbg(hsotg->dev, "GNPTXSTS @0x%08lX : 0x%08X\n",
800 (unsigned long)addr, dwc2_readl(hsotg, GNPTXSTS));
801 addr = hsotg->regs + GI2CCTL;
802 dev_dbg(hsotg->dev, "GI2CCTL @0x%08lX : 0x%08X\n",
803 (unsigned long)addr, dwc2_readl(hsotg, GI2CCTL));
804 addr = hsotg->regs + GPVNDCTL;
805 dev_dbg(hsotg->dev, "GPVNDCTL @0x%08lX : 0x%08X\n",
806 (unsigned long)addr, dwc2_readl(hsotg, GPVNDCTL));
807 addr = hsotg->regs + GGPIO;
808 dev_dbg(hsotg->dev, "GGPIO @0x%08lX : 0x%08X\n",
809 (unsigned long)addr, dwc2_readl(hsotg, GGPIO));
810 addr = hsotg->regs + GUID;
811 dev_dbg(hsotg->dev, "GUID @0x%08lX : 0x%08X\n",
812 (unsigned long)addr, dwc2_readl(hsotg, GUID));
813 addr = hsotg->regs + GSNPSID;
814 dev_dbg(hsotg->dev, "GSNPSID @0x%08lX : 0x%08X\n",
815 (unsigned long)addr, dwc2_readl(hsotg, GSNPSID));
816 addr = hsotg->regs + GHWCFG1;
817 dev_dbg(hsotg->dev, "GHWCFG1 @0x%08lX : 0x%08X\n",
818 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG1));
819 addr = hsotg->regs + GHWCFG2;
820 dev_dbg(hsotg->dev, "GHWCFG2 @0x%08lX : 0x%08X\n",
821 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG2));
822 addr = hsotg->regs + GHWCFG3;
823 dev_dbg(hsotg->dev, "GHWCFG3 @0x%08lX : 0x%08X\n",
824 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG3));
825 addr = hsotg->regs + GHWCFG4;
826 dev_dbg(hsotg->dev, "GHWCFG4 @0x%08lX : 0x%08X\n",
827 (unsigned long)addr, dwc2_readl(hsotg, GHWCFG4));
828 addr = hsotg->regs + GLPMCFG;
829 dev_dbg(hsotg->dev, "GLPMCFG @0x%08lX : 0x%08X\n",
830 (unsigned long)addr, dwc2_readl(hsotg, GLPMCFG));
831 addr = hsotg->regs + GPWRDN;
832 dev_dbg(hsotg->dev, "GPWRDN @0x%08lX : 0x%08X\n",
833 (unsigned long)addr, dwc2_readl(hsotg, GPWRDN));
834 addr = hsotg->regs + GDFIFOCFG;
835 dev_dbg(hsotg->dev, "GDFIFOCFG @0x%08lX : 0x%08X\n",
836 (unsigned long)addr, dwc2_readl(hsotg, GDFIFOCFG));
837 addr = hsotg->regs + HPTXFSIZ;
838 dev_dbg(hsotg->dev, "HPTXFSIZ @0x%08lX : 0x%08X\n",
839 (unsigned long)addr, dwc2_readl(hsotg, HPTXFSIZ));
840
841 addr = hsotg->regs + PCGCTL;
842 dev_dbg(hsotg->dev, "PCGCTL @0x%08lX : 0x%08X\n",
843 (unsigned long)addr, dwc2_readl(hsotg, PCGCTL));
844#endif
845}
846
847
848
849
850
851
852
853void dwc2_flush_tx_fifo(struct dwc2_hsotg *hsotg, const int num)
854{
855 u32 greset;
856
857 dev_vdbg(hsotg->dev, "Flush Tx FIFO %d\n", num);
858
859
860 if (dwc2_hsotg_wait_bit_set(hsotg, GRSTCTL, GRSTCTL_AHBIDLE, 10000))
861 dev_warn(hsotg->dev, "%s: HANG! AHB Idle GRSCTL\n",
862 __func__);
863
864 greset = GRSTCTL_TXFFLSH;
865 greset |= num << GRSTCTL_TXFNUM_SHIFT & GRSTCTL_TXFNUM_MASK;
866 dwc2_writel(hsotg, greset, GRSTCTL);
867
868 if (dwc2_hsotg_wait_bit_clear(hsotg, GRSTCTL, GRSTCTL_TXFFLSH, 10000))
869 dev_warn(hsotg->dev, "%s: HANG! timeout GRSTCTL GRSTCTL_TXFFLSH\n",
870 __func__);
871
872
873 udelay(1);
874}
875
876
877
878
879
880
881void dwc2_flush_rx_fifo(struct dwc2_hsotg *hsotg)
882{
883 u32 greset;
884
885 dev_vdbg(hsotg->dev, "%s()\n", __func__);
886
887
888 if (dwc2_hsotg_wait_bit_set(hsotg, GRSTCTL, GRSTCTL_AHBIDLE, 10000))
889 dev_warn(hsotg->dev, "%s: HANG! AHB Idle GRSCTL\n",
890 __func__);
891
892 greset = GRSTCTL_RXFFLSH;
893 dwc2_writel(hsotg, greset, GRSTCTL);
894
895
896 if (dwc2_hsotg_wait_bit_clear(hsotg, GRSTCTL, GRSTCTL_RXFFLSH, 10000))
897 dev_warn(hsotg->dev, "%s: HANG! timeout GRSTCTL GRSTCTL_RXFFLSH\n",
898 __func__);
899
900
901 udelay(1);
902}
903
904bool dwc2_is_controller_alive(struct dwc2_hsotg *hsotg)
905{
906 if (dwc2_readl(hsotg, GSNPSID) == 0xffffffff)
907 return false;
908 else
909 return true;
910}
911
912
913
914
915
916
917
918void dwc2_enable_global_interrupts(struct dwc2_hsotg *hsotg)
919{
920 u32 ahbcfg = dwc2_readl(hsotg, GAHBCFG);
921
922 ahbcfg |= GAHBCFG_GLBL_INTR_EN;
923 dwc2_writel(hsotg, ahbcfg, GAHBCFG);
924}
925
926
927
928
929
930
931
932void dwc2_disable_global_interrupts(struct dwc2_hsotg *hsotg)
933{
934 u32 ahbcfg = dwc2_readl(hsotg, GAHBCFG);
935
936 ahbcfg &= ~GAHBCFG_GLBL_INTR_EN;
937 dwc2_writel(hsotg, ahbcfg, GAHBCFG);
938}
939
940
941unsigned int dwc2_op_mode(struct dwc2_hsotg *hsotg)
942{
943 u32 ghwcfg2 = dwc2_readl(hsotg, GHWCFG2);
944
945 return (ghwcfg2 & GHWCFG2_OP_MODE_MASK) >>
946 GHWCFG2_OP_MODE_SHIFT;
947}
948
949
950bool dwc2_hw_is_otg(struct dwc2_hsotg *hsotg)
951{
952 unsigned int op_mode = dwc2_op_mode(hsotg);
953
954 return (op_mode == GHWCFG2_OP_MODE_HNP_SRP_CAPABLE) ||
955 (op_mode == GHWCFG2_OP_MODE_SRP_ONLY_CAPABLE) ||
956 (op_mode == GHWCFG2_OP_MODE_NO_HNP_SRP_CAPABLE);
957}
958
959
960bool dwc2_hw_is_host(struct dwc2_hsotg *hsotg)
961{
962 unsigned int op_mode = dwc2_op_mode(hsotg);
963
964 return (op_mode == GHWCFG2_OP_MODE_SRP_CAPABLE_HOST) ||
965 (op_mode == GHWCFG2_OP_MODE_NO_SRP_CAPABLE_HOST);
966}
967
968
969bool dwc2_hw_is_device(struct dwc2_hsotg *hsotg)
970{
971 unsigned int op_mode = dwc2_op_mode(hsotg);
972
973 return (op_mode == GHWCFG2_OP_MODE_SRP_CAPABLE_DEVICE) ||
974 (op_mode == GHWCFG2_OP_MODE_NO_SRP_CAPABLE_DEVICE);
975}
976
977
978
979
980
981
982
983
984
985
986int dwc2_hsotg_wait_bit_set(struct dwc2_hsotg *hsotg, u32 offset, u32 mask,
987 u32 timeout)
988{
989 u32 i;
990
991 for (i = 0; i < timeout; i++) {
992 if (dwc2_readl(hsotg, offset) & mask)
993 return 0;
994 udelay(1);
995 }
996
997 return -ETIMEDOUT;
998}
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009int dwc2_hsotg_wait_bit_clear(struct dwc2_hsotg *hsotg, u32 offset, u32 mask,
1010 u32 timeout)
1011{
1012 u32 i;
1013
1014 for (i = 0; i < timeout; i++) {
1015 if (!(dwc2_readl(hsotg, offset) & mask))
1016 return 0;
1017 udelay(1);
1018 }
1019
1020 return -ETIMEDOUT;
1021}
1022
1023
1024
1025
1026
1027void dwc2_init_fs_ls_pclk_sel(struct dwc2_hsotg *hsotg)
1028{
1029 u32 hcfg, val;
1030
1031 if ((hsotg->hw_params.hs_phy_type == GHWCFG2_HS_PHY_TYPE_ULPI &&
1032 hsotg->hw_params.fs_phy_type == GHWCFG2_FS_PHY_TYPE_DEDICATED &&
1033 hsotg->params.ulpi_fs_ls) ||
1034 hsotg->params.phy_type == DWC2_PHY_TYPE_PARAM_FS) {
1035
1036 val = HCFG_FSLSPCLKSEL_48_MHZ;
1037 } else {
1038
1039 val = HCFG_FSLSPCLKSEL_30_60_MHZ;
1040 }
1041
1042 dev_dbg(hsotg->dev, "Initializing HCFG.FSLSPClkSel to %08x\n", val);
1043 hcfg = dwc2_readl(hsotg, HCFG);
1044 hcfg &= ~HCFG_FSLSPCLKSEL_MASK;
1045 hcfg |= val << HCFG_FSLSPCLKSEL_SHIFT;
1046 dwc2_writel(hsotg, hcfg, HCFG);
1047}
1048
1049static int dwc2_fs_phy_init(struct dwc2_hsotg *hsotg, bool select_phy)
1050{
1051 u32 usbcfg, ggpio, i2cctl;
1052 int retval = 0;
1053
1054
1055
1056
1057
1058 if (select_phy) {
1059 dev_dbg(hsotg->dev, "FS PHY selected\n");
1060
1061 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1062 if (!(usbcfg & GUSBCFG_PHYSEL)) {
1063 usbcfg |= GUSBCFG_PHYSEL;
1064 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1065
1066
1067 retval = dwc2_core_reset(hsotg, false);
1068
1069 if (retval) {
1070 dev_err(hsotg->dev,
1071 "%s: Reset failed, aborting", __func__);
1072 return retval;
1073 }
1074 }
1075
1076 if (hsotg->params.activate_stm_fs_transceiver) {
1077 ggpio = dwc2_readl(hsotg, GGPIO);
1078 if (!(ggpio & GGPIO_STM32_OTG_GCCFG_PWRDWN)) {
1079 dev_dbg(hsotg->dev, "Activating transceiver\n");
1080
1081
1082
1083
1084 ggpio |= GGPIO_STM32_OTG_GCCFG_PWRDWN;
1085 dwc2_writel(hsotg, ggpio, GGPIO);
1086 }
1087 }
1088 }
1089
1090
1091
1092
1093
1094
1095 if (dwc2_is_host_mode(hsotg))
1096 dwc2_init_fs_ls_pclk_sel(hsotg);
1097
1098 if (hsotg->params.i2c_enable) {
1099 dev_dbg(hsotg->dev, "FS PHY enabling I2C\n");
1100
1101
1102 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1103 usbcfg |= GUSBCFG_OTG_UTMI_FS_SEL;
1104 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1105
1106
1107 i2cctl = dwc2_readl(hsotg, GI2CCTL);
1108 i2cctl &= ~GI2CCTL_I2CDEVADDR_MASK;
1109 i2cctl |= 1 << GI2CCTL_I2CDEVADDR_SHIFT;
1110 i2cctl &= ~GI2CCTL_I2CEN;
1111 dwc2_writel(hsotg, i2cctl, GI2CCTL);
1112 i2cctl |= GI2CCTL_I2CEN;
1113 dwc2_writel(hsotg, i2cctl, GI2CCTL);
1114 }
1115
1116 return retval;
1117}
1118
1119static int dwc2_hs_phy_init(struct dwc2_hsotg *hsotg, bool select_phy)
1120{
1121 u32 usbcfg, usbcfg_old;
1122 int retval = 0;
1123
1124 if (!select_phy)
1125 return 0;
1126
1127 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1128 usbcfg_old = usbcfg;
1129
1130
1131
1132
1133
1134
1135 switch (hsotg->params.phy_type) {
1136 case DWC2_PHY_TYPE_PARAM_ULPI:
1137
1138 dev_dbg(hsotg->dev, "HS ULPI PHY selected\n");
1139 usbcfg |= GUSBCFG_ULPI_UTMI_SEL;
1140 usbcfg &= ~(GUSBCFG_PHYIF16 | GUSBCFG_DDRSEL);
1141 if (hsotg->params.phy_ulpi_ddr)
1142 usbcfg |= GUSBCFG_DDRSEL;
1143
1144
1145 if (hsotg->params.oc_disable)
1146 usbcfg |= (GUSBCFG_ULPI_INT_VBUS_IND |
1147 GUSBCFG_INDICATORPASSTHROUGH);
1148 break;
1149 case DWC2_PHY_TYPE_PARAM_UTMI:
1150
1151 dev_dbg(hsotg->dev, "HS UTMI+ PHY selected\n");
1152 usbcfg &= ~(GUSBCFG_ULPI_UTMI_SEL | GUSBCFG_PHYIF16);
1153 if (hsotg->params.phy_utmi_width == 16)
1154 usbcfg |= GUSBCFG_PHYIF16;
1155
1156
1157 if (dwc2_is_device_mode(hsotg)) {
1158 usbcfg &= ~GUSBCFG_USBTRDTIM_MASK;
1159 if (hsotg->params.phy_utmi_width == 16)
1160 usbcfg |= 5 << GUSBCFG_USBTRDTIM_SHIFT;
1161 else
1162 usbcfg |= 9 << GUSBCFG_USBTRDTIM_SHIFT;
1163 }
1164 break;
1165 default:
1166 dev_err(hsotg->dev, "FS PHY selected at HS!\n");
1167 break;
1168 }
1169
1170 if (usbcfg != usbcfg_old) {
1171 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1172
1173
1174 retval = dwc2_core_reset(hsotg, false);
1175 if (retval) {
1176 dev_err(hsotg->dev,
1177 "%s: Reset failed, aborting", __func__);
1178 return retval;
1179 }
1180 }
1181
1182 return retval;
1183}
1184
1185int dwc2_phy_init(struct dwc2_hsotg *hsotg, bool select_phy)
1186{
1187 u32 usbcfg;
1188 int retval = 0;
1189
1190 if ((hsotg->params.speed == DWC2_SPEED_PARAM_FULL ||
1191 hsotg->params.speed == DWC2_SPEED_PARAM_LOW) &&
1192 hsotg->params.phy_type == DWC2_PHY_TYPE_PARAM_FS) {
1193
1194 retval = dwc2_fs_phy_init(hsotg, select_phy);
1195 if (retval)
1196 return retval;
1197 } else {
1198
1199 retval = dwc2_hs_phy_init(hsotg, select_phy);
1200 if (retval)
1201 return retval;
1202 }
1203
1204 if (hsotg->hw_params.hs_phy_type == GHWCFG2_HS_PHY_TYPE_ULPI &&
1205 hsotg->hw_params.fs_phy_type == GHWCFG2_FS_PHY_TYPE_DEDICATED &&
1206 hsotg->params.ulpi_fs_ls) {
1207 dev_dbg(hsotg->dev, "Setting ULPI FSLS\n");
1208 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1209 usbcfg |= GUSBCFG_ULPI_FS_LS;
1210 usbcfg |= GUSBCFG_ULPI_CLK_SUSP_M;
1211 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1212 } else {
1213 usbcfg = dwc2_readl(hsotg, GUSBCFG);
1214 usbcfg &= ~GUSBCFG_ULPI_FS_LS;
1215 usbcfg &= ~GUSBCFG_ULPI_CLK_SUSP_M;
1216 dwc2_writel(hsotg, usbcfg, GUSBCFG);
1217 }
1218
1219 return retval;
1220}
1221
1222MODULE_DESCRIPTION("DESIGNWARE HS OTG Core");
1223MODULE_AUTHOR("Synopsys, Inc.");
1224MODULE_LICENSE("Dual BSD/GPL");
1225