1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include "hw/hw.h"
23#include "hw/arm/omap.h"
24
25
26struct omap_mcspi_s {
27 MemoryRegion iomem;
28 qemu_irq irq;
29 int chnum;
30
31 uint32_t sysconfig;
32 uint32_t systest;
33 uint32_t irqst;
34 uint32_t irqen;
35 uint32_t wken;
36 uint32_t control;
37
38 struct omap_mcspi_ch_s {
39 qemu_irq txdrq;
40 qemu_irq rxdrq;
41 uint32_t (*txrx)(void *opaque, uint32_t, int);
42 void *opaque;
43
44 uint32_t tx;
45 uint32_t rx;
46
47 uint32_t config;
48 uint32_t status;
49 uint32_t control;
50 } ch[4];
51};
52
53static inline void omap_mcspi_interrupt_update(struct omap_mcspi_s *s)
54{
55 qemu_set_irq(s->irq, s->irqst & s->irqen);
56}
57
58static inline void omap_mcspi_dmarequest_update(struct omap_mcspi_ch_s *ch)
59{
60 qemu_set_irq(ch->txdrq,
61 (ch->control & 1) &&
62 (ch->config & (1 << 14)) &&
63 (ch->status & (1 << 1)) &&
64 ((ch->config >> 12) & 3) != 1);
65 qemu_set_irq(ch->rxdrq,
66 (ch->control & 1) &&
67 (ch->config & (1 << 15)) &&
68 (ch->status & (1 << 0)) &&
69 ((ch->config >> 12) & 3) != 2);
70}
71
72static void omap_mcspi_transfer_run(struct omap_mcspi_s *s, int chnum)
73{
74 struct omap_mcspi_ch_s *ch = s->ch + chnum;
75
76 if (!(ch->control & 1))
77 return;
78 if ((ch->status & (1 << 0)) &&
79 ((ch->config >> 12) & 3) != 2 &&
80 !(ch->config & (1 << 19)))
81 goto intr_update;
82 if ((ch->status & (1 << 1)) &&
83 ((ch->config >> 12) & 3) != 1)
84 goto intr_update;
85
86 if (!(s->control & 1) ||
87 (ch->config & (1 << 20))) {
88 if (ch->txrx)
89 ch->rx = ch->txrx(ch->opaque, ch->tx,
90 1 + (0x1f & (ch->config >> 7)));
91 }
92
93 ch->tx = 0;
94 ch->status |= 1 << 2;
95 ch->status |= 1 << 1;
96 if (((ch->config >> 12) & 3) != 2)
97 ch->status |= 1 << 0;
98
99intr_update:
100 if ((ch->status & (1 << 0)) &&
101 ((ch->config >> 12) & 3) != 2 &&
102 !(ch->config & (1 << 19)))
103 s->irqst |= 1 << (2 + 4 * chnum);
104 if ((ch->status & (1 << 1)) &&
105 ((ch->config >> 12) & 3) != 1)
106 s->irqst |= 1 << (0 + 4 * chnum);
107 omap_mcspi_interrupt_update(s);
108 omap_mcspi_dmarequest_update(ch);
109}
110
111void omap_mcspi_reset(struct omap_mcspi_s *s)
112{
113 int ch;
114
115 s->sysconfig = 0;
116 s->systest = 0;
117 s->irqst = 0;
118 s->irqen = 0;
119 s->wken = 0;
120 s->control = 4;
121
122 for (ch = 0; ch < 4; ch ++) {
123 s->ch[ch].config = 0x060000;
124 s->ch[ch].status = 2;
125 s->ch[ch].control = 0;
126
127 omap_mcspi_dmarequest_update(s->ch + ch);
128 }
129
130 omap_mcspi_interrupt_update(s);
131}
132
133static uint64_t omap_mcspi_read(void *opaque, hwaddr addr,
134 unsigned size)
135{
136 struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
137 int ch = 0;
138 uint32_t ret;
139
140 if (size != 4) {
141 return omap_badwidth_read32(opaque, addr);
142 }
143
144 switch (addr) {
145 case 0x00:
146 return 0x91;
147
148 case 0x10:
149 return s->sysconfig;
150
151 case 0x14:
152 return 1;
153
154 case 0x18:
155 return s->irqst;
156
157 case 0x1c:
158 return s->irqen;
159
160 case 0x20:
161 return s->wken;
162
163 case 0x24:
164 return s->systest;
165
166 case 0x28:
167 return s->control;
168
169 case 0x68: ch ++;
170
171 case 0x54: ch ++;
172
173 case 0x40: ch ++;
174
175 case 0x2c:
176 return s->ch[ch].config;
177
178 case 0x6c: ch ++;
179
180 case 0x58: ch ++;
181
182 case 0x44: ch ++;
183
184 case 0x30:
185 return s->ch[ch].status;
186
187 case 0x70: ch ++;
188
189 case 0x5c: ch ++;
190
191 case 0x48: ch ++;
192
193 case 0x34:
194 return s->ch[ch].control;
195
196 case 0x74: ch ++;
197
198 case 0x60: ch ++;
199
200 case 0x4c: ch ++;
201
202 case 0x38:
203 return s->ch[ch].tx;
204
205 case 0x78: ch ++;
206
207 case 0x64: ch ++;
208
209 case 0x50: ch ++;
210
211 case 0x3c:
212 s->ch[ch].status &= ~(1 << 0);
213 ret = s->ch[ch].rx;
214 omap_mcspi_transfer_run(s, ch);
215 return ret;
216 }
217
218 OMAP_BAD_REG(addr);
219 return 0;
220}
221
222static void omap_mcspi_write(void *opaque, hwaddr addr,
223 uint64_t value, unsigned size)
224{
225 struct omap_mcspi_s *s = (struct omap_mcspi_s *) opaque;
226 int ch = 0;
227
228 if (size != 4) {
229 return omap_badwidth_write32(opaque, addr, value);
230 }
231
232 switch (addr) {
233 case 0x00:
234 case 0x14:
235 case 0x30:
236 case 0x3c:
237 case 0x44:
238 case 0x50:
239 case 0x58:
240 case 0x64:
241 case 0x6c:
242 case 0x78:
243 OMAP_RO_REG(addr);
244 return;
245
246 case 0x10:
247 if (value & (1 << 1))
248 omap_mcspi_reset(s);
249 s->sysconfig = value & 0x31d;
250 break;
251
252 case 0x18:
253 if (!((s->control & (1 << 3)) && (s->systest & (1 << 11)))) {
254 s->irqst &= ~value;
255 omap_mcspi_interrupt_update(s);
256 }
257 break;
258
259 case 0x1c:
260 s->irqen = value & 0x1777f;
261 omap_mcspi_interrupt_update(s);
262 break;
263
264 case 0x20:
265 s->wken = value & 1;
266 break;
267
268 case 0x24:
269 if (s->control & (1 << 3))
270 if (value & (1 << 11)) {
271 s->irqst |= 0x1777f;
272 omap_mcspi_interrupt_update(s);
273 }
274 s->systest = value & 0xfff;
275 break;
276
277 case 0x28:
278 if (value & (1 << 3))
279 if (s->systest & (1 << 11)) {
280 s->irqst |= 0x1777f;
281 omap_mcspi_interrupt_update(s);
282 }
283 s->control = value & 0xf;
284 break;
285
286 case 0x68: ch ++;
287
288 case 0x54: ch ++;
289
290 case 0x40: ch ++;
291
292 case 0x2c:
293 if ((value ^ s->ch[ch].config) & (3 << 14))
294 omap_mcspi_dmarequest_update(s->ch + ch);
295 if (((value >> 12) & 3) == 3)
296 fprintf(stderr, "%s: invalid TRM value (3)\n", __FUNCTION__);
297 if (((value >> 7) & 0x1f) < 3)
298 fprintf(stderr, "%s: invalid WL value (%" PRIx64 ")\n",
299 __FUNCTION__, (value >> 7) & 0x1f);
300 s->ch[ch].config = value & 0x7fffff;
301 break;
302
303 case 0x70: ch ++;
304
305 case 0x5c: ch ++;
306
307 case 0x48: ch ++;
308
309 case 0x34:
310 if (value & ~s->ch[ch].control & 1) {
311 s->ch[ch].control |= 1;
312 omap_mcspi_transfer_run(s, ch);
313 } else
314 s->ch[ch].control = value & 1;
315 break;
316
317 case 0x74: ch ++;
318
319 case 0x60: ch ++;
320
321 case 0x4c: ch ++;
322
323 case 0x38:
324 s->ch[ch].tx = value;
325 s->ch[ch].status &= ~(1 << 1);
326 omap_mcspi_transfer_run(s, ch);
327 break;
328
329 default:
330 OMAP_BAD_REG(addr);
331 return;
332 }
333}
334
335static const MemoryRegionOps omap_mcspi_ops = {
336 .read = omap_mcspi_read,
337 .write = omap_mcspi_write,
338 .endianness = DEVICE_NATIVE_ENDIAN,
339};
340
341struct omap_mcspi_s *omap_mcspi_init(struct omap_target_agent_s *ta, int chnum,
342 qemu_irq irq, qemu_irq *drq, omap_clk fclk, omap_clk iclk)
343{
344 struct omap_mcspi_s *s = (struct omap_mcspi_s *)
345 g_malloc0(sizeof(struct omap_mcspi_s));
346 struct omap_mcspi_ch_s *ch = s->ch;
347
348 s->irq = irq;
349 s->chnum = chnum;
350 while (chnum --) {
351 ch->txdrq = *drq ++;
352 ch->rxdrq = *drq ++;
353 ch ++;
354 }
355 omap_mcspi_reset(s);
356
357 memory_region_init_io(&s->iomem, NULL, &omap_mcspi_ops, s, "omap.mcspi",
358 omap_l4_region_size(ta, 0));
359 omap_l4_attach(ta, 0, &s->iomem);
360
361 return s;
362}
363
364void omap_mcspi_attach(struct omap_mcspi_s *s,
365 uint32_t (*txrx)(void *opaque, uint32_t, int), void *opaque,
366 int chipselect)
367{
368 if (chipselect < 0 || chipselect >= s->chnum)
369 hw_error("%s: Bad chipselect %i\n", __FUNCTION__, chipselect);
370
371 s->ch[chipselect].txrx = txrx;
372 s->ch[chipselect].opaque = opaque;
373}
374