1
2
3
4
5
6
7
8
9
10
11#include "hw.h"
12#include "pxa.h"
13#include "sysbus.h"
14
15#define PXA255_DMA_NUM_CHANNELS 16
16#define PXA27X_DMA_NUM_CHANNELS 32
17
18#define PXA2XX_DMA_NUM_REQUESTS 75
19
20typedef struct {
21 uint32_t descr;
22 uint32_t src;
23 uint32_t dest;
24 uint32_t cmd;
25 uint32_t state;
26 int request;
27} PXA2xxDMAChannel;
28
29typedef struct PXA2xxDMAState {
30 SysBusDevice busdev;
31 MemoryRegion iomem;
32 qemu_irq irq;
33
34 uint32_t stopintr;
35 uint32_t eorintr;
36 uint32_t rasintr;
37 uint32_t startintr;
38 uint32_t endintr;
39
40 uint32_t align;
41 uint32_t pio;
42
43 int channels;
44 PXA2xxDMAChannel *chan;
45
46 uint8_t req[PXA2XX_DMA_NUM_REQUESTS];
47
48
49 int running;
50} PXA2xxDMAState;
51
52#define DCSR0 0x0000
53#define DCSR31 0x007c
54#define DALGN 0x00a0
55#define DPCSR 0x00a4
56#define DRQSR0 0x00e0
57#define DRQSR1 0x00e4
58#define DRQSR2 0x00e8
59#define DINT 0x00f0
60#define DRCMR0 0x0100
61#define DRCMR63 0x01fc
62#define D_CH0 0x0200
63#define DRCMR64 0x1100
64#define DRCMR74 0x1128
65
66
67#define DDADR 0x00
68#define DSADR 0x01
69#define DTADR 0x02
70#define DCMD 0x03
71
72
73#define DRCMR_CHLNUM 0x1f
74#define DRCMR_MAPVLD (1 << 7)
75#define DDADR_STOP (1 << 0)
76#define DDADR_BREN (1 << 1)
77#define DCMD_LEN 0x1fff
78#define DCMD_WIDTH(x) (1 << ((((x) >> 14) & 3) - 1))
79#define DCMD_SIZE(x) (4 << (((x) >> 16) & 3))
80#define DCMD_FLYBYT (1 << 19)
81#define DCMD_FLYBYS (1 << 20)
82#define DCMD_ENDIRQEN (1 << 21)
83#define DCMD_STARTIRQEN (1 << 22)
84#define DCMD_CMPEN (1 << 25)
85#define DCMD_FLOWTRG (1 << 28)
86#define DCMD_FLOWSRC (1 << 29)
87#define DCMD_INCTRGADDR (1 << 30)
88#define DCMD_INCSRCADDR (1 << 31)
89#define DCSR_BUSERRINTR (1 << 0)
90#define DCSR_STARTINTR (1 << 1)
91#define DCSR_ENDINTR (1 << 2)
92#define DCSR_STOPINTR (1 << 3)
93#define DCSR_RASINTR (1 << 4)
94#define DCSR_REQPEND (1 << 8)
95#define DCSR_EORINT (1 << 9)
96#define DCSR_CMPST (1 << 10)
97#define DCSR_MASKRUN (1 << 22)
98#define DCSR_RASIRQEN (1 << 23)
99#define DCSR_CLRCMPST (1 << 24)
100#define DCSR_SETCMPST (1 << 25)
101#define DCSR_EORSTOPEN (1 << 26)
102#define DCSR_EORJMPEN (1 << 27)
103#define DCSR_EORIRQEN (1 << 28)
104#define DCSR_STOPIRQEN (1 << 29)
105#define DCSR_NODESCFETCH (1 << 30)
106#define DCSR_RUN (1 << 31)
107
108static inline void pxa2xx_dma_update(PXA2xxDMAState *s, int ch)
109{
110 if (ch >= 0) {
111 if ((s->chan[ch].state & DCSR_STOPIRQEN) &&
112 (s->chan[ch].state & DCSR_STOPINTR))
113 s->stopintr |= 1 << ch;
114 else
115 s->stopintr &= ~(1 << ch);
116
117 if ((s->chan[ch].state & DCSR_EORIRQEN) &&
118 (s->chan[ch].state & DCSR_EORINT))
119 s->eorintr |= 1 << ch;
120 else
121 s->eorintr &= ~(1 << ch);
122
123 if ((s->chan[ch].state & DCSR_RASIRQEN) &&
124 (s->chan[ch].state & DCSR_RASINTR))
125 s->rasintr |= 1 << ch;
126 else
127 s->rasintr &= ~(1 << ch);
128
129 if (s->chan[ch].state & DCSR_STARTINTR)
130 s->startintr |= 1 << ch;
131 else
132 s->startintr &= ~(1 << ch);
133
134 if (s->chan[ch].state & DCSR_ENDINTR)
135 s->endintr |= 1 << ch;
136 else
137 s->endintr &= ~(1 << ch);
138 }
139
140 if (s->stopintr | s->eorintr | s->rasintr | s->startintr | s->endintr)
141 qemu_irq_raise(s->irq);
142 else
143 qemu_irq_lower(s->irq);
144}
145
146static inline void pxa2xx_dma_descriptor_fetch(
147 PXA2xxDMAState *s, int ch)
148{
149 uint32_t desc[4];
150 target_phys_addr_t daddr = s->chan[ch].descr & ~0xf;
151 if ((s->chan[ch].descr & DDADR_BREN) && (s->chan[ch].state & DCSR_CMPST))
152 daddr += 32;
153
154 cpu_physical_memory_read(daddr, (uint8_t *) desc, 16);
155 s->chan[ch].descr = desc[DDADR];
156 s->chan[ch].src = desc[DSADR];
157 s->chan[ch].dest = desc[DTADR];
158 s->chan[ch].cmd = desc[DCMD];
159
160 if (s->chan[ch].cmd & DCMD_FLOWSRC)
161 s->chan[ch].src &= ~3;
162 if (s->chan[ch].cmd & DCMD_FLOWTRG)
163 s->chan[ch].dest &= ~3;
164
165 if (s->chan[ch].cmd & (DCMD_CMPEN | DCMD_FLYBYS | DCMD_FLYBYT))
166 printf("%s: unsupported mode in channel %i\n", __FUNCTION__, ch);
167
168 if (s->chan[ch].cmd & DCMD_STARTIRQEN)
169 s->chan[ch].state |= DCSR_STARTINTR;
170}
171
172static void pxa2xx_dma_run(PXA2xxDMAState *s)
173{
174 int c, srcinc, destinc;
175 uint32_t n, size;
176 uint32_t width;
177 uint32_t length;
178 uint8_t buffer[32];
179 PXA2xxDMAChannel *ch;
180
181 if (s->running ++)
182 return;
183
184 while (s->running) {
185 s->running = 1;
186 for (c = 0; c < s->channels; c ++) {
187 ch = &s->chan[c];
188
189 while ((ch->state & DCSR_RUN) && !(ch->state & DCSR_STOPINTR)) {
190
191 if ((ch->cmd & (DCMD_FLOWSRC | DCMD_FLOWTRG)) && !ch->request)
192 break;
193
194 length = ch->cmd & DCMD_LEN;
195 size = DCMD_SIZE(ch->cmd);
196 width = DCMD_WIDTH(ch->cmd);
197
198 srcinc = (ch->cmd & DCMD_INCSRCADDR) ? width : 0;
199 destinc = (ch->cmd & DCMD_INCTRGADDR) ? width : 0;
200
201 while (length) {
202 size = MIN(length, size);
203
204 for (n = 0; n < size; n += width) {
205 cpu_physical_memory_read(ch->src, buffer + n, width);
206 ch->src += srcinc;
207 }
208
209 for (n = 0; n < size; n += width) {
210 cpu_physical_memory_write(ch->dest, buffer + n, width);
211 ch->dest += destinc;
212 }
213
214 length -= size;
215
216 if ((ch->cmd & (DCMD_FLOWSRC | DCMD_FLOWTRG)) &&
217 !ch->request) {
218 ch->state |= DCSR_EORINT;
219 if (ch->state & DCSR_EORSTOPEN)
220 ch->state |= DCSR_STOPINTR;
221 if ((ch->state & DCSR_EORJMPEN) &&
222 !(ch->state & DCSR_NODESCFETCH))
223 pxa2xx_dma_descriptor_fetch(s, c);
224 break;
225 }
226 }
227
228 ch->cmd = (ch->cmd & ~DCMD_LEN) | length;
229
230
231 if (!length) {
232 if (ch->cmd & DCMD_ENDIRQEN)
233 ch->state |= DCSR_ENDINTR;
234
235 if ((ch->state & DCSR_NODESCFETCH) ||
236 (ch->descr & DDADR_STOP) ||
237 (ch->state & DCSR_EORSTOPEN)) {
238 ch->state |= DCSR_STOPINTR;
239 ch->state &= ~DCSR_RUN;
240
241 break;
242 }
243
244 ch->state |= DCSR_STOPINTR;
245 break;
246 }
247 }
248 }
249
250 s->running --;
251 }
252}
253
254static uint64_t pxa2xx_dma_read(void *opaque, target_phys_addr_t offset,
255 unsigned size)
256{
257 PXA2xxDMAState *s = (PXA2xxDMAState *) opaque;
258 unsigned int channel;
259
260 if (size != 4) {
261 hw_error("%s: Bad access width\n", __FUNCTION__);
262 return 5;
263 }
264
265 switch (offset) {
266 case DRCMR64 ... DRCMR74:
267 offset -= DRCMR64 - DRCMR0 - (64 << 2);
268
269 case DRCMR0 ... DRCMR63:
270 channel = (offset - DRCMR0) >> 2;
271 return s->req[channel];
272
273 case DRQSR0:
274 case DRQSR1:
275 case DRQSR2:
276 return 0;
277
278 case DCSR0 ... DCSR31:
279 channel = offset >> 2;
280 if (s->chan[channel].request)
281 return s->chan[channel].state | DCSR_REQPEND;
282 return s->chan[channel].state;
283
284 case DINT:
285 return s->stopintr | s->eorintr | s->rasintr |
286 s->startintr | s->endintr;
287
288 case DALGN:
289 return s->align;
290
291 case DPCSR:
292 return s->pio;
293 }
294
295 if (offset >= D_CH0 && offset < D_CH0 + (s->channels << 4)) {
296 channel = (offset - D_CH0) >> 4;
297 switch ((offset & 0x0f) >> 2) {
298 case DDADR:
299 return s->chan[channel].descr;
300 case DSADR:
301 return s->chan[channel].src;
302 case DTADR:
303 return s->chan[channel].dest;
304 case DCMD:
305 return s->chan[channel].cmd;
306 }
307 }
308
309 hw_error("%s: Bad offset 0x" TARGET_FMT_plx "\n", __FUNCTION__, offset);
310 return 7;
311}
312
313static void pxa2xx_dma_write(void *opaque, target_phys_addr_t offset,
314 uint64_t value, unsigned size)
315{
316 PXA2xxDMAState *s = (PXA2xxDMAState *) opaque;
317 unsigned int channel;
318
319 if (size != 4) {
320 hw_error("%s: Bad access width\n", __FUNCTION__);
321 return;
322 }
323
324 switch (offset) {
325 case DRCMR64 ... DRCMR74:
326 offset -= DRCMR64 - DRCMR0 - (64 << 2);
327
328 case DRCMR0 ... DRCMR63:
329 channel = (offset - DRCMR0) >> 2;
330
331 if (value & DRCMR_MAPVLD)
332 if ((value & DRCMR_CHLNUM) > s->channels)
333 hw_error("%s: Bad DMA channel %i\n",
334 __FUNCTION__, (unsigned)value & DRCMR_CHLNUM);
335
336 s->req[channel] = value;
337 break;
338
339 case DRQSR0:
340 case DRQSR1:
341 case DRQSR2:
342
343 break;
344
345 case DCSR0 ... DCSR31:
346 channel = offset >> 2;
347 s->chan[channel].state &= 0x0000071f & ~(value &
348 (DCSR_EORINT | DCSR_ENDINTR |
349 DCSR_STARTINTR | DCSR_BUSERRINTR));
350 s->chan[channel].state |= value & 0xfc800000;
351
352 if (s->chan[channel].state & DCSR_STOPIRQEN)
353 s->chan[channel].state &= ~DCSR_STOPINTR;
354
355 if (value & DCSR_NODESCFETCH) {
356
357 if (value & DCSR_RUN) {
358 s->chan[channel].state &= ~DCSR_STOPINTR;
359 pxa2xx_dma_run(s);
360 }
361 } else {
362
363 if (value & DCSR_RUN) {
364 s->chan[channel].state &= ~DCSR_STOPINTR;
365 pxa2xx_dma_descriptor_fetch(s, channel);
366 pxa2xx_dma_run(s);
367 }
368 }
369
370
371 if (!(value & (DCSR_RUN | DCSR_MASKRUN)))
372 s->chan[channel].state |= DCSR_STOPINTR;
373
374 if (value & DCSR_CLRCMPST)
375 s->chan[channel].state &= ~DCSR_CMPST;
376 if (value & DCSR_SETCMPST)
377 s->chan[channel].state |= DCSR_CMPST;
378
379 pxa2xx_dma_update(s, channel);
380 break;
381
382 case DALGN:
383 s->align = value;
384 break;
385
386 case DPCSR:
387 s->pio = value & 0x80000001;
388 break;
389
390 default:
391 if (offset >= D_CH0 && offset < D_CH0 + (s->channels << 4)) {
392 channel = (offset - D_CH0) >> 4;
393 switch ((offset & 0x0f) >> 2) {
394 case DDADR:
395 s->chan[channel].descr = value;
396 break;
397 case DSADR:
398 s->chan[channel].src = value;
399 break;
400 case DTADR:
401 s->chan[channel].dest = value;
402 break;
403 case DCMD:
404 s->chan[channel].cmd = value;
405 break;
406 default:
407 goto fail;
408 }
409
410 break;
411 }
412 fail:
413 hw_error("%s: Bad offset " TARGET_FMT_plx "\n", __FUNCTION__, offset);
414 }
415}
416
417static const MemoryRegionOps pxa2xx_dma_ops = {
418 .read = pxa2xx_dma_read,
419 .write = pxa2xx_dma_write,
420 .endianness = DEVICE_NATIVE_ENDIAN,
421};
422
423static void pxa2xx_dma_request(void *opaque, int req_num, int on)
424{
425 PXA2xxDMAState *s = opaque;
426 int ch;
427 if (req_num < 0 || req_num >= PXA2XX_DMA_NUM_REQUESTS)
428 hw_error("%s: Bad DMA request %i\n", __FUNCTION__, req_num);
429
430 if (!(s->req[req_num] & DRCMR_MAPVLD))
431 return;
432 ch = s->req[req_num] & DRCMR_CHLNUM;
433
434 if (!s->chan[ch].request && on)
435 s->chan[ch].state |= DCSR_RASINTR;
436 else
437 s->chan[ch].state &= ~DCSR_RASINTR;
438 if (s->chan[ch].request && !on)
439 s->chan[ch].state |= DCSR_EORINT;
440
441 s->chan[ch].request = on;
442 if (on) {
443 pxa2xx_dma_run(s);
444 pxa2xx_dma_update(s, ch);
445 }
446}
447
448static int pxa2xx_dma_init(SysBusDevice *dev)
449{
450 int i;
451 PXA2xxDMAState *s;
452 s = FROM_SYSBUS(PXA2xxDMAState, dev);
453
454 if (s->channels <= 0) {
455 return -1;
456 }
457
458 s->chan = g_malloc0(sizeof(PXA2xxDMAChannel) * s->channels);
459
460 memset(s->chan, 0, sizeof(PXA2xxDMAChannel) * s->channels);
461 for (i = 0; i < s->channels; i ++)
462 s->chan[i].state = DCSR_STOPINTR;
463
464 memset(s->req, 0, sizeof(uint8_t) * PXA2XX_DMA_NUM_REQUESTS);
465
466 qdev_init_gpio_in(&dev->qdev, pxa2xx_dma_request, PXA2XX_DMA_NUM_REQUESTS);
467
468 memory_region_init_io(&s->iomem, &pxa2xx_dma_ops, s,
469 "pxa2xx.dma", 0x00010000);
470 sysbus_init_mmio(dev, &s->iomem);
471 sysbus_init_irq(dev, &s->irq);
472
473 return 0;
474}
475
476DeviceState *pxa27x_dma_init(target_phys_addr_t base, qemu_irq irq)
477{
478 DeviceState *dev;
479
480 dev = qdev_create(NULL, "pxa2xx-dma");
481 qdev_prop_set_int32(dev, "channels", PXA27X_DMA_NUM_CHANNELS);
482 qdev_init_nofail(dev);
483
484 sysbus_mmio_map(sysbus_from_qdev(dev), 0, base);
485 sysbus_connect_irq(sysbus_from_qdev(dev), 0, irq);
486
487 return dev;
488}
489
490DeviceState *pxa255_dma_init(target_phys_addr_t base, qemu_irq irq)
491{
492 DeviceState *dev;
493
494 dev = qdev_create(NULL, "pxa2xx-dma");
495 qdev_prop_set_int32(dev, "channels", PXA27X_DMA_NUM_CHANNELS);
496 qdev_init_nofail(dev);
497
498 sysbus_mmio_map(sysbus_from_qdev(dev), 0, base);
499 sysbus_connect_irq(sysbus_from_qdev(dev), 0, irq);
500
501 return dev;
502}
503
504static bool is_version_0(void *opaque, int version_id)
505{
506 return version_id == 0;
507}
508
509static VMStateDescription vmstate_pxa2xx_dma_chan = {
510 .name = "pxa2xx_dma_chan",
511 .version_id = 1,
512 .minimum_version_id = 1,
513 .minimum_version_id_old = 1,
514 .fields = (VMStateField[]) {
515 VMSTATE_UINT32(descr, PXA2xxDMAChannel),
516 VMSTATE_UINT32(src, PXA2xxDMAChannel),
517 VMSTATE_UINT32(dest, PXA2xxDMAChannel),
518 VMSTATE_UINT32(cmd, PXA2xxDMAChannel),
519 VMSTATE_UINT32(state, PXA2xxDMAChannel),
520 VMSTATE_INT32(request, PXA2xxDMAChannel),
521 VMSTATE_END_OF_LIST(),
522 },
523};
524
525static VMStateDescription vmstate_pxa2xx_dma = {
526 .name = "pxa2xx_dma",
527 .version_id = 1,
528 .minimum_version_id = 0,
529 .minimum_version_id_old = 0,
530 .fields = (VMStateField[]) {
531 VMSTATE_UNUSED_TEST(is_version_0, 4),
532 VMSTATE_UINT32(stopintr, PXA2xxDMAState),
533 VMSTATE_UINT32(eorintr, PXA2xxDMAState),
534 VMSTATE_UINT32(rasintr, PXA2xxDMAState),
535 VMSTATE_UINT32(startintr, PXA2xxDMAState),
536 VMSTATE_UINT32(endintr, PXA2xxDMAState),
537 VMSTATE_UINT32(align, PXA2xxDMAState),
538 VMSTATE_UINT32(pio, PXA2xxDMAState),
539 VMSTATE_BUFFER(req, PXA2xxDMAState),
540 VMSTATE_STRUCT_VARRAY_POINTER_INT32(chan, PXA2xxDMAState, channels,
541 vmstate_pxa2xx_dma_chan, PXA2xxDMAChannel),
542 VMSTATE_END_OF_LIST(),
543 },
544};
545
546static Property pxa2xx_dma_properties[] = {
547 DEFINE_PROP_INT32("channels", PXA2xxDMAState, channels, -1),
548 DEFINE_PROP_END_OF_LIST(),
549};
550
551static void pxa2xx_dma_class_init(ObjectClass *klass, void *data)
552{
553 DeviceClass *dc = DEVICE_CLASS(klass);
554 SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
555
556 k->init = pxa2xx_dma_init;
557 dc->desc = "PXA2xx DMA controller";
558 dc->vmsd = &vmstate_pxa2xx_dma;
559 dc->props = pxa2xx_dma_properties;
560}
561
562static TypeInfo pxa2xx_dma_info = {
563 .name = "pxa2xx-dma",
564 .parent = TYPE_SYS_BUS_DEVICE,
565 .instance_size = sizeof(PXA2xxDMAState),
566 .class_init = pxa2xx_dma_class_init,
567};
568
569static void pxa2xx_dma_register_types(void)
570{
571 type_register_static(&pxa2xx_dma_info);
572}
573
574type_init(pxa2xx_dma_register_types)
575
