?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
RT-AC66 3.0.0.4.374.130 core
[tomato.git] / release / src-rt-6.x / linux / linux-2.6 / arch / arm / plat-omap / usb.c
bloba5aedf964b88042d6b74765ec3b5fb6cf548eb9b
1 /*
2 * arch/arm/plat-omap/usb.c -- platform level USB initialization
3 *
4 * Copyright (C) 2004 Texas Instruments, Inc.
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 */
20
21 #undef DEBUG
22
23 #include <linux/module.h>
24 #include <linux/kernel.h>
25 #include <linux/types.h>
26 #include <linux/errno.h>
27 #include <linux/init.h>
28 #include <linux/platform_device.h>
29 #include <linux/usb/otg.h>
30
31 #include <asm/io.h>
32 #include <asm/irq.h>
33 #include <asm/system.h>
34 #include <asm/hardware.h>
35
36 #include <asm/arch/mux.h>
37 #include <asm/arch/usb.h>
38 #include <asm/arch/board.h>
39
40 #ifdef CONFIG_ARCH_OMAP1
41
42 #define INT_USB_IRQ_GEN IH2_BASE + 20
43 #define INT_USB_IRQ_NISO IH2_BASE + 30
44 #define INT_USB_IRQ_ISO IH2_BASE + 29
45 #define INT_USB_IRQ_HGEN INT_USB_HHC_1
46 #define INT_USB_IRQ_OTG IH2_BASE + 8
47
48 #else
49
50 #define INT_USB_IRQ_GEN INT_24XX_USB_IRQ_GEN
51 #define INT_USB_IRQ_NISO INT_24XX_USB_IRQ_NISO
52 #define INT_USB_IRQ_ISO INT_24XX_USB_IRQ_ISO
53 #define INT_USB_IRQ_HGEN INT_24XX_USB_IRQ_HGEN
54 #define INT_USB_IRQ_OTG INT_24XX_USB_IRQ_OTG
55
56 #endif
57
58
59 /* These routines should handle the standard chip-specific modes
60 * for usb0/1/2 ports, covering basic mux and transceiver setup.
61 *
62 * Some board-*.c files will need to set up additional mux options,
63 * like for suspend handling, vbus sensing, GPIOs, and the D+ pullup.
64 */
65
66 /* TESTED ON:
67 * - 1611B H2 (with usb1 mini-AB) using standard Mini-B or OTG cables
68 * - 5912 OSK OHCI (with usb0 standard-A), standard A-to-B cables
69 * - 5912 OSK UDC, with *nonstandard* A-to-A cable
70 * - 1510 Innovator UDC with bundled usb0 cable
71 * - 1510 Innovator OHCI with bundled usb1/usb2 cable
72 * - 1510 Innovator OHCI with custom usb0 cable, feeding 5V VBUS
73 * - 1710 custom development board using alternate pin group
74 * - 1710 H3 (with usb1 mini-AB) using standard Mini-B or OTG cables
75 */
76
77 /*-------------------------------------------------------------------------*/
78
79 #ifdef CONFIG_ARCH_OMAP_OTG
80
81 static struct otg_transceiver *xceiv;
82
83 /**
84 * otg_get_transceiver - find the (single) OTG transceiver driver
85 *
86 * Returns the transceiver driver, after getting a refcount to it; or
87 * null if there is no such transceiver. The caller is responsible for
88 * releasing that count.
89 */
90 struct otg_transceiver *otg_get_transceiver(void)
91 {
92 if (xceiv)
93 get_device(xceiv->dev);
94 return xceiv;
95 }
96 EXPORT_SYMBOL(otg_get_transceiver);
97
98 int otg_set_transceiver(struct otg_transceiver *x)
99 {
100 if (xceiv && x)
101 return -EBUSY;
102 xceiv = x;
103 return 0;
104 }
105 EXPORT_SYMBOL(otg_set_transceiver);
106
107 #endif
108
109 /*-------------------------------------------------------------------------*/
110
111 #if defined(CONFIG_ARCH_OMAP_OTG) || defined(CONFIG_ARCH_OMAP15XX)
112
113 static u32 __init omap_usb0_init(unsigned nwires, unsigned is_device)
114 {
115 u32 syscon1 = 0;
116
117 if (cpu_is_omap24xx())
118 CONTROL_DEVCONF_REG &= ~USBT0WRMODEI(USB_BIDIR_TLL);
119
120 if (nwires == 0) {
121 if (cpu_class_is_omap1() && !cpu_is_omap15xx()) {
122 /* pulldown D+/D- */
123 USB_TRANSCEIVER_CTRL_REG &= ~(3 << 1);
124 }
125 return 0;
126 }
127
128 if (is_device) {
129 if (cpu_is_omap24xx())
130 omap_cfg_reg(J20_24XX_USB0_PUEN);
131 else
132 omap_cfg_reg(W4_USB_PUEN);
133 }
134
135 /* internal transceiver (unavailable on 17xx, 24xx) */
136 if (!cpu_class_is_omap2() && nwires == 2) {
137 // omap_cfg_reg(P9_USB_DP);
138 // omap_cfg_reg(R8_USB_DM);
139
140 if (cpu_is_omap15xx()) {
141 /* This works on 1510-Innovator */
142 return 0;
143 }
144
145 /* NOTES:
146 * - peripheral should configure VBUS detection!
147 * - only peripherals may use the internal D+/D- pulldowns
148 * - OTG support on this port not yet written
149 */
150
151 USB_TRANSCEIVER_CTRL_REG &= ~(7 << 4);
152 if (!is_device)
153 USB_TRANSCEIVER_CTRL_REG |= (3 << 1);
154
155 return 3 << 16;
156 }
157
158 /* alternate pin config, external transceiver */
159 if (cpu_is_omap15xx()) {
160 printk(KERN_ERR "no usb0 alt pin config on 15xx\n");
161 return 0;
162 }
163
164 if (cpu_is_omap24xx()) {
165 omap_cfg_reg(K18_24XX_USB0_DAT);
166 omap_cfg_reg(K19_24XX_USB0_TXEN);
167 omap_cfg_reg(J14_24XX_USB0_SE0);
168 if (nwires != 3)
169 omap_cfg_reg(J18_24XX_USB0_RCV);
170 } else {
171 omap_cfg_reg(V6_USB0_TXD);
172 omap_cfg_reg(W9_USB0_TXEN);
173 omap_cfg_reg(W5_USB0_SE0);
174 if (nwires != 3)
175 omap_cfg_reg(Y5_USB0_RCV);
176 }
177
178 /* NOTE: SPEED and SUSP aren't configured here. OTG hosts
179 * may be able to use I2C requests to set those bits along
180 * with VBUS switching and overcurrent detection.
181 */
182
183 if (cpu_class_is_omap1() && nwires != 6)
184 USB_TRANSCEIVER_CTRL_REG &= ~CONF_USB2_UNI_R;
185
186 switch (nwires) {
187 case 3:
188 syscon1 = 2;
189 if (cpu_is_omap24xx())
190 CONTROL_DEVCONF_REG |= USBT0WRMODEI(USB_BIDIR);
191 break;
192 case 4:
193 syscon1 = 1;
194 if (cpu_is_omap24xx())
195 CONTROL_DEVCONF_REG |= USBT0WRMODEI(USB_BIDIR);
196 break;
197 case 6:
198 syscon1 = 3;
199 if (cpu_is_omap24xx()) {
200 omap_cfg_reg(J19_24XX_USB0_VP);
201 omap_cfg_reg(K20_24XX_USB0_VM);
202 CONTROL_DEVCONF_REG |= USBT0WRMODEI(USB_UNIDIR);
203 } else {
204 omap_cfg_reg(AA9_USB0_VP);
205 omap_cfg_reg(R9_USB0_VM);
206 USB_TRANSCEIVER_CTRL_REG |= CONF_USB2_UNI_R;
207 }
208 break;
209 default:
210 printk(KERN_ERR "illegal usb%d %d-wire transceiver\n",
211 0, nwires);
212 }
213 return syscon1 << 16;
214 }
215
216 static u32 __init omap_usb1_init(unsigned nwires)
217 {
218 u32 syscon1 = 0;
219
220 if (cpu_class_is_omap1() && !cpu_is_omap15xx() && nwires != 6)
221 USB_TRANSCEIVER_CTRL_REG &= ~CONF_USB1_UNI_R;
222 if (cpu_is_omap24xx())
223 CONTROL_DEVCONF_REG &= ~USBT1WRMODEI(USB_BIDIR_TLL);
224
225 if (nwires == 0)
226 return 0;
227
228 /* external transceiver */
229 if (cpu_class_is_omap1()) {
230 omap_cfg_reg(USB1_TXD);
231 omap_cfg_reg(USB1_TXEN);
232 if (nwires != 3)
233 omap_cfg_reg(USB1_RCV);
234 }
235
236 if (cpu_is_omap15xx()) {
237 omap_cfg_reg(USB1_SEO);
238 omap_cfg_reg(USB1_SPEED);
239 // SUSP
240 } else if (cpu_is_omap1610() || cpu_is_omap5912()) {
241 omap_cfg_reg(W13_1610_USB1_SE0);
242 omap_cfg_reg(R13_1610_USB1_SPEED);
243 // SUSP
244 } else if (cpu_is_omap1710()) {
245 omap_cfg_reg(R13_1710_USB1_SE0);
246 // SUSP
247 } else if (cpu_is_omap24xx()) {
248 /* NOTE: board-specific code must set up pin muxing for usb1,
249 * since each signal could come out on either of two balls.
250 */
251 } else {
252 pr_debug("usb%d cpu unrecognized\n", 1);
253 return 0;
254 }
255
256 switch (nwires) {
257 case 2:
258 if (!cpu_is_omap24xx())
259 goto bad;
260 /* NOTE: board-specific code must override this setting if
261 * this TLL link is not using DP/DM
262 */
263 syscon1 = 1;
264 CONTROL_DEVCONF_REG |= USBT1WRMODEI(USB_BIDIR_TLL);
265 break;
266 case 3:
267 syscon1 = 2;
268 if (cpu_is_omap24xx())
269 CONTROL_DEVCONF_REG |= USBT1WRMODEI(USB_BIDIR);
270 break;
271 case 4:
272 syscon1 = 1;
273 if (cpu_is_omap24xx())
274 CONTROL_DEVCONF_REG |= USBT1WRMODEI(USB_BIDIR);
275 break;
276 case 6:
277 if (cpu_is_omap24xx())
278 goto bad;
279 syscon1 = 3;
280 omap_cfg_reg(USB1_VP);
281 omap_cfg_reg(USB1_VM);
282 if (!cpu_is_omap15xx())
283 USB_TRANSCEIVER_CTRL_REG |= CONF_USB1_UNI_R;
284 break;
285 default:
286 bad:
287 printk(KERN_ERR "illegal usb%d %d-wire transceiver\n",
288 1, nwires);
289 }
290 return syscon1 << 20;
291 }
292
293 static u32 __init omap_usb2_init(unsigned nwires, unsigned alt_pingroup)
294 {
295 u32 syscon1 = 0;
296
297 if (cpu_is_omap24xx()) {
298 CONTROL_DEVCONF_REG &= ~(USBT2WRMODEI(USB_BIDIR_TLL)
299 | USBT2TLL5PI);
300 alt_pingroup = 0;
301 }
302
303 /* NOTE omap1 erratum: must leave USB2_UNI_R set if usb0 in use */
304 if (alt_pingroup || nwires == 0)
305 return 0;
306
307 if (cpu_class_is_omap1() && !cpu_is_omap15xx() && nwires != 6)
308 USB_TRANSCEIVER_CTRL_REG &= ~CONF_USB2_UNI_R;
309
310 /* external transceiver */
311 if (cpu_is_omap15xx()) {
312 omap_cfg_reg(USB2_TXD);
313 omap_cfg_reg(USB2_TXEN);
314 omap_cfg_reg(USB2_SEO);
315 if (nwires != 3)
316 omap_cfg_reg(USB2_RCV);
317 /* there is no USB2_SPEED */
318 } else if (cpu_is_omap16xx()) {
319 omap_cfg_reg(V6_USB2_TXD);
320 omap_cfg_reg(W9_USB2_TXEN);
321 omap_cfg_reg(W5_USB2_SE0);
322 if (nwires != 3)
323 omap_cfg_reg(Y5_USB2_RCV);
324 // FIXME omap_cfg_reg(USB2_SPEED);
325 } else if (cpu_is_omap24xx()) {
326 omap_cfg_reg(Y11_24XX_USB2_DAT);
327 omap_cfg_reg(AA10_24XX_USB2_SE0);
328 if (nwires > 2)
329 omap_cfg_reg(AA12_24XX_USB2_TXEN);
330 if (nwires > 3)
331 omap_cfg_reg(AA6_24XX_USB2_RCV);
332 } else {
333 pr_debug("usb%d cpu unrecognized\n", 1);
334 return 0;
335 }
336 // if (cpu_class_is_omap1()) omap_cfg_reg(USB2_SUSP);
337
338 switch (nwires) {
339 case 2:
340 if (!cpu_is_omap24xx())
341 goto bad;
342 /* NOTE: board-specific code must override this setting if
343 * this TLL link is not using DP/DM
344 */
345 syscon1 = 1;
346 CONTROL_DEVCONF_REG |= USBT2WRMODEI(USB_BIDIR_TLL);
347 break;
348 case 3:
349 syscon1 = 2;
350 if (cpu_is_omap24xx())
351 CONTROL_DEVCONF_REG |= USBT2WRMODEI(USB_BIDIR);
352 break;
353 case 4:
354 syscon1 = 1;
355 if (cpu_is_omap24xx())
356 CONTROL_DEVCONF_REG |= USBT2WRMODEI(USB_BIDIR);
357 break;
358 case 5:
359 if (!cpu_is_omap24xx())
360 goto bad;
361 omap_cfg_reg(AA4_24XX_USB2_TLLSE0);
362 /* NOTE: board-specific code must override this setting if
363 * this TLL link is not using DP/DM. Something must also
364 * set up OTG_SYSCON2.HMC_TLL{ATTACH,SPEED}
365 */
366 syscon1 = 3;
367 CONTROL_DEVCONF_REG |= USBT2WRMODEI(USB_UNIDIR_TLL)
368 | USBT2TLL5PI;
369 break;
370 case 6:
371 if (cpu_is_omap24xx())
372 goto bad;
373 syscon1 = 3;
374 if (cpu_is_omap15xx()) {
375 omap_cfg_reg(USB2_VP);
376 omap_cfg_reg(USB2_VM);
377 } else {
378 omap_cfg_reg(AA9_USB2_VP);
379 omap_cfg_reg(R9_USB2_VM);
380 USB_TRANSCEIVER_CTRL_REG |= CONF_USB2_UNI_R;
381 }
382 break;
383 default:
384 bad:
385 printk(KERN_ERR "illegal usb%d %d-wire transceiver\n",
386 2, nwires);
387 }
388 return syscon1 << 24;
389 }
390
391 #endif
392
393 /*-------------------------------------------------------------------------*/
394
395 #if defined(CONFIG_USB_GADGET_OMAP) || \
396 defined(CONFIG_USB_OHCI_HCD) || defined(CONFIG_USB_OHCI_HCD_MODULE) || \
397 (defined(CONFIG_USB_OTG) && defined(CONFIG_ARCH_OMAP_OTG))
398 static void usb_release(struct device *dev)
399 {
400 /* normally not freed */
401 }
402 #endif
403
404 #ifdef CONFIG_USB_GADGET_OMAP
405
406 static struct resource udc_resources[] = {
407 /* order is significant! */
408 { /* registers */
409 .start = UDC_BASE,
410 .end = UDC_BASE + 0xff,
411 .flags = IORESOURCE_MEM,
412 }, { /* general IRQ */
413 .start = INT_USB_IRQ_GEN,
414 .flags = IORESOURCE_IRQ,
415 }, { /* PIO IRQ */
416 .start = INT_USB_IRQ_NISO,
417 .flags = IORESOURCE_IRQ,
418 }, { /* SOF IRQ */
419 .start = INT_USB_IRQ_ISO,
420 .flags = IORESOURCE_IRQ,
421 },
422 };
423
424 static u64 udc_dmamask = ~(u32)0;
425
426 static struct platform_device udc_device = {
427 .name = "omap_udc",
428 .id = -1,
429 .dev = {
430 .release = usb_release,
431 .dma_mask = &udc_dmamask,
432 .coherent_dma_mask = 0xffffffff,
433 },
434 .num_resources = ARRAY_SIZE(udc_resources),
435 .resource = udc_resources,
436 };
437
438 #endif
439
440 #if defined(CONFIG_USB_OHCI_HCD) || defined(CONFIG_USB_OHCI_HCD_MODULE)
441
442 /* The dmamask must be set for OHCI to work */
443 static u64 ohci_dmamask = ~(u32)0;
444
445 static struct resource ohci_resources[] = {
446 {
447 .start = OMAP_OHCI_BASE,
448 .end = OMAP_OHCI_BASE + 0xff,
449 .flags = IORESOURCE_MEM,
450 },
451 {
452 .start = INT_USB_IRQ_HGEN,
453 .flags = IORESOURCE_IRQ,
454 },
455 };
456
457 static struct platform_device ohci_device = {
458 .name = "ohci",
459 .id = -1,
460 .dev = {
461 .release = usb_release,
462 .dma_mask = &ohci_dmamask,
463 .coherent_dma_mask = 0xffffffff,
464 },
465 .num_resources = ARRAY_SIZE(ohci_resources),
466 .resource = ohci_resources,
467 };
468
469 #endif
470
471 #if defined(CONFIG_USB_OTG) && defined(CONFIG_ARCH_OMAP_OTG)
472
473 static struct resource otg_resources[] = {
474 /* order is significant! */
475 {
476 .start = OTG_BASE,
477 .end = OTG_BASE + 0xff,
478 .flags = IORESOURCE_MEM,
479 }, {
480 .start = INT_USB_IRQ_OTG,
481 .flags = IORESOURCE_IRQ,
482 },
483 };
484
485 static struct platform_device otg_device = {
486 .name = "omap_otg",
487 .id = -1,
488 .dev = {
489 .release = usb_release,
490 },
491 .num_resources = ARRAY_SIZE(otg_resources),
492 .resource = otg_resources,
493 };
494
495 #endif
496
497 /*-------------------------------------------------------------------------*/
498
499 #define ULPD_CLOCK_CTRL_REG __REG16(ULPD_CLOCK_CTRL)
500 #define ULPD_SOFT_REQ_REG __REG16(ULPD_SOFT_REQ)
501
502
503 // FIXME correct answer depends on hmc_mode,
504 // as does (on omap1) any nonzero value for config->otg port number
505 #ifdef CONFIG_USB_GADGET_OMAP
506 #define is_usb0_device(config) 1
507 #else
508 #define is_usb0_device(config) 0
509 #endif
510
511 /*-------------------------------------------------------------------------*/
512
513 #ifdef CONFIG_ARCH_OMAP_OTG
514
515 void __init
516 omap_otg_init(struct omap_usb_config *config)
517 {
518 u32 syscon = OTG_SYSCON_1_REG & 0xffff;
519 int status;
520 int alt_pingroup = 0;
521
522 /* NOTE: no bus or clock setup (yet?) */
523
524 syscon = OTG_SYSCON_1_REG & 0xffff;
525 if (!(syscon & OTG_RESET_DONE))
526 pr_debug("USB resets not complete?\n");
527
528 // OTG_IRQ_EN_REG = 0;
529
530 /* pin muxing and transceiver pinouts */
531 if (config->pins[0] > 2) /* alt pingroup 2 */
532 alt_pingroup = 1;
533 syscon |= omap_usb0_init(config->pins[0], is_usb0_device(config));
534 syscon |= omap_usb1_init(config->pins[1]);
535 syscon |= omap_usb2_init(config->pins[2], alt_pingroup);
536 pr_debug("OTG_SYSCON_1_REG = %08x\n", syscon);
537 OTG_SYSCON_1_REG = syscon;
538
539 syscon = config->hmc_mode;
540 syscon |= USBX_SYNCHRO | (4 << 16) /* B_ASE0_BRST */;
541 #ifdef CONFIG_USB_OTG
542 if (config->otg)
543 syscon |= OTG_EN;
544 #endif
545 if (cpu_class_is_omap1())
546 pr_debug("USB_TRANSCEIVER_CTRL_REG = %03x\n", USB_TRANSCEIVER_CTRL_REG);
547 pr_debug("OTG_SYSCON_2_REG = %08x\n", syscon);
548 OTG_SYSCON_2_REG = syscon;
549
550 printk("USB: hmc %d", config->hmc_mode);
551 if (!alt_pingroup)
552 printk(", usb2 alt %d wires", config->pins[2]);
553 else if (config->pins[0])
554 printk(", usb0 %d wires%s", config->pins[0],
555 is_usb0_device(config) ? " (dev)" : "");
556 if (config->pins[1])
557 printk(", usb1 %d wires", config->pins[1]);
558 if (!alt_pingroup && config->pins[2])
559 printk(", usb2 %d wires", config->pins[2]);
560 if (config->otg)
561 printk(", Mini-AB on usb%d", config->otg - 1);
562 printk("\n");
563
564 if (cpu_class_is_omap1()) {
565 /* leave USB clocks/controllers off until needed */
566 ULPD_SOFT_REQ_REG &= ~SOFT_USB_CLK_REQ;
567 ULPD_CLOCK_CTRL_REG &= ~USB_MCLK_EN;
568 ULPD_CLOCK_CTRL_REG |= DIS_USB_PVCI_CLK;
569 }
570 syscon = OTG_SYSCON_1_REG;
571 syscon |= HST_IDLE_EN|DEV_IDLE_EN|OTG_IDLE_EN;
572
573 #ifdef CONFIG_USB_GADGET_OMAP
574 if (config->otg || config->register_dev) {
575 syscon &= ~DEV_IDLE_EN;
576 udc_device.dev.platform_data = config;
577 /* FIXME patch IRQ numbers for omap730 */
578 status = platform_device_register(&udc_device);
579 if (status)
580 pr_debug("can't register UDC device, %d\n", status);
581 }
582 #endif
583
584 #if defined(CONFIG_USB_OHCI_HCD) || defined(CONFIG_USB_OHCI_HCD_MODULE)
585 if (config->otg || config->register_host) {
586 syscon &= ~HST_IDLE_EN;
587 ohci_device.dev.platform_data = config;
588 if (cpu_is_omap730())
589 ohci_resources[1].start = INT_730_USB_HHC_1;
590 status = platform_device_register(&ohci_device);
591 if (status)
592 pr_debug("can't register OHCI device, %d\n", status);
593 }
594 #endif
595
596 #ifdef CONFIG_USB_OTG
597 if (config->otg) {
598 syscon &= ~OTG_IDLE_EN;
599 otg_device.dev.platform_data = config;
600 if (cpu_is_omap730())
601 otg_resources[1].start = INT_730_USB_OTG;
602 status = platform_device_register(&otg_device);
603 if (status)
604 pr_debug("can't register OTG device, %d\n", status);
605 }
606 #endif
607 pr_debug("OTG_SYSCON_1_REG = %08x\n", syscon);
608 OTG_SYSCON_1_REG = syscon;
609
610 status = 0;
611 }
612
613 #else
614 static inline void omap_otg_init(struct omap_usb_config *config) {}
615 #endif
616
617 /*-------------------------------------------------------------------------*/
618
619 #ifdef CONFIG_ARCH_OMAP15XX
620
621 #define ULPD_DPLL_CTRL_REG __REG16(ULPD_DPLL_CTRL)
622 #define DPLL_IOB (1 << 13)
623 #define DPLL_PLL_ENABLE (1 << 4)
624 #define DPLL_LOCK (1 << 0)
625
626 #define ULPD_APLL_CTRL_REG __REG16(ULPD_APLL_CTRL)
627 #define APLL_NDPLL_SWITCH (1 << 0)
628
629
630 static void __init omap_1510_usb_init(struct omap_usb_config *config)
631 {
632 unsigned int val;
633
634 omap_usb0_init(config->pins[0], is_usb0_device(config));
635 omap_usb1_init(config->pins[1]);
636 omap_usb2_init(config->pins[2], 0);
637
638 val = omap_readl(MOD_CONF_CTRL_0) & ~(0x3f << 1);
639 val |= (config->hmc_mode << 1);
640 omap_writel(val, MOD_CONF_CTRL_0);
641
642 printk("USB: hmc %d", config->hmc_mode);
643 if (config->pins[0])
644 printk(", usb0 %d wires%s", config->pins[0],
645 is_usb0_device(config) ? " (dev)" : "");
646 if (config->pins[1])
647 printk(", usb1 %d wires", config->pins[1]);
648 if (config->pins[2])
649 printk(", usb2 %d wires", config->pins[2]);
650 printk("\n");
651
652 /* use DPLL for 48 MHz function clock */
653 pr_debug("APLL %04x DPLL %04x REQ %04x\n", ULPD_APLL_CTRL_REG,
654 ULPD_DPLL_CTRL_REG, ULPD_SOFT_REQ_REG);
655 ULPD_APLL_CTRL_REG &= ~APLL_NDPLL_SWITCH;
656 ULPD_DPLL_CTRL_REG |= DPLL_IOB | DPLL_PLL_ENABLE;
657 ULPD_SOFT_REQ_REG |= SOFT_UDC_REQ | SOFT_DPLL_REQ;
658 while (!(ULPD_DPLL_CTRL_REG & DPLL_LOCK))
659 cpu_relax();
660
661 #ifdef CONFIG_USB_GADGET_OMAP
662 if (config->register_dev) {
663 int status;
664
665 udc_device.dev.platform_data = config;
666 status = platform_device_register(&udc_device);
667 if (status)
668 pr_debug("can't register UDC device, %d\n", status);
669 /* udc driver gates 48MHz by D+ pullup */
670 }
671 #endif
672
673 #if defined(CONFIG_USB_OHCI_HCD) || defined(CONFIG_USB_OHCI_HCD_MODULE)
674 if (config->register_host) {
675 int status;
676
677 ohci_device.dev.platform_data = config;
678 status = platform_device_register(&ohci_device);
679 if (status)
680 pr_debug("can't register OHCI device, %d\n", status);
681 /* hcd explicitly gates 48MHz */
682 }
683 #endif
684 }
685
686 #else
687 static inline void omap_1510_usb_init(struct omap_usb_config *config) {}
688 #endif
689
690 /*-------------------------------------------------------------------------*/
691
692 static struct omap_usb_config platform_data;
693
694 static int __init
695 omap_usb_init(void)
696 {
697 const struct omap_usb_config *config;
698
699 config = omap_get_config(OMAP_TAG_USB, struct omap_usb_config);
700 if (config == NULL) {
701 printk(KERN_ERR "USB: No board-specific "
702 "platform config found\n");
703 return -ENODEV;
704 }
705 platform_data = *config;
706
707 if (cpu_is_omap730() || cpu_is_omap16xx() || cpu_is_omap24xx())
708 omap_otg_init(&platform_data);
709 else if (cpu_is_omap15xx())
710 omap_1510_usb_init(&platform_data);
711 else {
712 printk(KERN_ERR "USB: No init for your chip yet\n");
713 return -ENODEV;
714 }
715 return 0;
716 }
717
718 subsys_initcall(omap_usb_init);
Tomato firmware and modifications.