1
2
3
4
5
6
7
8
9
10
11
12#include <common.h>
13
14#include "musb_core.h"
15struct musb_regs *musbr;
16
17
18
19
20void musb_start(void)
21{
22#if defined(CONFIG_MUSB_HCD)
23 u8 devctl;
24 u8 busctl;
25#endif
26
27
28 writew(0, &musbr->intrtxe);
29 writew(0, &musbr->intrrxe);
30 writeb(0, &musbr->intrusbe);
31 writeb(0, &musbr->testmode);
32
33
34 writeb(MUSB_POWER_HSENAB, &musbr->power);
35#if defined(CONFIG_MUSB_HCD)
36
37 if (musb_cfg.extvbus == 1) {
38 busctl = musb_read_ulpi_buscontrol(musbr);
39 musb_write_ulpi_buscontrol(musbr, busctl | ULPI_USE_EXTVBUS);
40 }
41
42 devctl = readb(&musbr->devctl);
43 writeb(devctl | MUSB_DEVCTL_SESSION, &musbr->devctl);
44#endif
45}
46
47#ifdef MUSB_NO_DYNAMIC_FIFO
48# define config_fifo(dir, idx, addr)
49#else
50# define config_fifo(dir, idx, addr) \
51 do { \
52 writeb(idx, &musbr->dir##fifosz); \
53 writew(fifoaddr >> 3, &musbr->dir##fifoadd); \
54 } while (0)
55#endif
56
57
58
59
60
61
62
63
64
65
66void musb_configure_ep(const struct musb_epinfo *epinfo, u8 cnt)
67{
68 u16 csr;
69 u16 fifoaddr = 64;
70 u32 fifosize;
71 u8 idx;
72
73 while (cnt--) {
74
75 fifosize = epinfo->epsize >> 3;
76 idx = ffs(fifosize) - 1;
77
78 writeb(epinfo->epnum, &musbr->index);
79 if (epinfo->epdir) {
80
81 config_fifo(tx, idx, fifoaddr);
82
83 csr = readw(&musbr->txcsr);
84#if defined(CONFIG_MUSB_HCD)
85
86 writew(csr | MUSB_TXCSR_CLRDATATOG, &musbr->txcsr);
87#endif
88
89 if (csr & MUSB_TXCSR_TXPKTRDY)
90 writew(csr | MUSB_TXCSR_FLUSHFIFO,
91 &musbr->txcsr);
92 } else {
93
94 config_fifo(rx, idx, fifoaddr);
95
96 csr = readw(&musbr->rxcsr);
97#if defined(CONFIG_MUSB_HCD)
98
99 writew(csr | MUSB_RXCSR_CLRDATATOG, &musbr->rxcsr);
100#endif
101
102 if (csr & MUSB_RXCSR_RXPKTRDY)
103 writew(csr | MUSB_RXCSR_FLUSHFIFO,
104 &musbr->rxcsr);
105 }
106 fifoaddr += epinfo->epsize;
107 epinfo++;
108 }
109}
110
111
112
113
114
115
116
117
118__attribute__((weak))
119void write_fifo(u8 ep, u32 length, void *fifo_data)
120{
121 u8 *data = (u8 *)fifo_data;
122
123
124 writeb(ep, &musbr->index);
125
126
127 while (length--)
128 writeb(*data++, &musbr->fifox[ep]);
129}
130
131
132
133
134
135#ifndef CONFIG_USB_AM35X
136
137
138
139
140
141
142
143__attribute__((weak))
144void read_fifo(u8 ep, u32 length, void *fifo_data)
145{
146 u8 *data = (u8 *)fifo_data;
147
148
149 writeb(ep, &musbr->index);
150
151
152 while (length--)
153 *data++ = readb(&musbr->fifox[ep]);
154}
155#endif
156