|
|
1.1.1.3 root 1: /*
1.1.1.2 root 2: * Arm PrimeCell PL080/PL081 DMA controller
1.1 root 3: *
4: * Copyright (c) 2006 CodeSourcery.
5: * Written by Paul Brook
6: *
1.1.1.8 root 7: * This code is licensed under the GPL.
1.1 root 8: */
9:
1.1.1.5 root 10: #include "sysbus.h"
1.1 root 11:
1.1.1.2 root 12: #define PL080_MAX_CHANNELS 8
1.1 root 13: #define PL080_CONF_E 0x1
14: #define PL080_CONF_M1 0x2
15: #define PL080_CONF_M2 0x4
16:
17: #define PL080_CCONF_H 0x40000
18: #define PL080_CCONF_A 0x20000
19: #define PL080_CCONF_L 0x10000
20: #define PL080_CCONF_ITC 0x08000
21: #define PL080_CCONF_IE 0x04000
22: #define PL080_CCONF_E 0x00001
23:
24: #define PL080_CCTRL_I 0x80000000
25: #define PL080_CCTRL_DI 0x08000000
26: #define PL080_CCTRL_SI 0x04000000
27: #define PL080_CCTRL_D 0x02000000
28: #define PL080_CCTRL_S 0x01000000
29:
30: typedef struct {
31: uint32_t src;
32: uint32_t dest;
33: uint32_t lli;
34: uint32_t ctrl;
35: uint32_t conf;
36: } pl080_channel;
37:
38: typedef struct {
1.1.1.5 root 39: SysBusDevice busdev;
1.1.1.9 ! root 40: MemoryRegion iomem;
1.1 root 41: uint8_t tc_int;
42: uint8_t tc_mask;
43: uint8_t err_int;
44: uint8_t err_mask;
45: uint32_t conf;
46: uint32_t sync;
47: uint32_t req_single;
48: uint32_t req_burst;
1.1.1.2 root 49: pl080_channel chan[PL080_MAX_CHANNELS];
50: int nchannels;
1.1 root 51: /* Flag to avoid recursive DMA invocations. */
52: int running;
1.1.1.3 root 53: qemu_irq irq;
1.1 root 54: } pl080_state;
55:
1.1.1.7 root 56: static const VMStateDescription vmstate_pl080_channel = {
57: .name = "pl080_channel",
58: .version_id = 1,
59: .minimum_version_id = 1,
60: .fields = (VMStateField[]) {
61: VMSTATE_UINT32(src, pl080_channel),
62: VMSTATE_UINT32(dest, pl080_channel),
63: VMSTATE_UINT32(lli, pl080_channel),
64: VMSTATE_UINT32(ctrl, pl080_channel),
65: VMSTATE_UINT32(conf, pl080_channel),
66: VMSTATE_END_OF_LIST()
67: }
68: };
69:
70: static const VMStateDescription vmstate_pl080 = {
71: .name = "pl080",
72: .version_id = 1,
73: .minimum_version_id = 1,
74: .fields = (VMStateField[]) {
75: VMSTATE_UINT8(tc_int, pl080_state),
76: VMSTATE_UINT8(tc_mask, pl080_state),
77: VMSTATE_UINT8(err_int, pl080_state),
78: VMSTATE_UINT8(err_mask, pl080_state),
79: VMSTATE_UINT32(conf, pl080_state),
80: VMSTATE_UINT32(sync, pl080_state),
81: VMSTATE_UINT32(req_single, pl080_state),
82: VMSTATE_UINT32(req_burst, pl080_state),
83: VMSTATE_UINT8(tc_int, pl080_state),
84: VMSTATE_UINT8(tc_int, pl080_state),
85: VMSTATE_UINT8(tc_int, pl080_state),
86: VMSTATE_STRUCT_ARRAY(chan, pl080_state, PL080_MAX_CHANNELS,
87: 1, vmstate_pl080_channel, pl080_channel),
88: VMSTATE_INT32(running, pl080_state),
89: VMSTATE_END_OF_LIST()
90: }
91: };
92:
1.1 root 93: static const unsigned char pl080_id[] =
94: { 0x80, 0x10, 0x04, 0x0a, 0x0d, 0xf0, 0x05, 0xb1 };
95:
1.1.1.2 root 96: static const unsigned char pl081_id[] =
97: { 0x81, 0x10, 0x04, 0x0a, 0x0d, 0xf0, 0x05, 0xb1 };
98:
1.1 root 99: static void pl080_update(pl080_state *s)
100: {
101: if ((s->tc_int & s->tc_mask)
102: || (s->err_int & s->err_mask))
1.1.1.3 root 103: qemu_irq_raise(s->irq);
1.1 root 104: else
1.1.1.3 root 105: qemu_irq_lower(s->irq);
1.1 root 106: }
107:
108: static void pl080_run(pl080_state *s)
109: {
110: int c;
111: int flow;
112: pl080_channel *ch;
113: int swidth;
114: int dwidth;
115: int xsize;
116: int n;
117: int src_id;
118: int dest_id;
119: int size;
1.1.1.4 root 120: uint8_t buff[4];
1.1 root 121: uint32_t req;
122:
123: s->tc_mask = 0;
1.1.1.2 root 124: for (c = 0; c < s->nchannels; c++) {
1.1 root 125: if (s->chan[c].conf & PL080_CCONF_ITC)
126: s->tc_mask |= 1 << c;
127: if (s->chan[c].conf & PL080_CCONF_IE)
128: s->err_mask |= 1 << c;
129: }
130:
131: if ((s->conf & PL080_CONF_E) == 0)
132: return;
133:
1.1.1.5 root 134: hw_error("DMA active\n");
1.1 root 135: /* If we are already in the middle of a DMA operation then indicate that
136: there may be new DMA requests and return immediately. */
137: if (s->running) {
138: s->running++;
139: return;
140: }
141: s->running = 1;
142: while (s->running) {
1.1.1.2 root 143: for (c = 0; c < s->nchannels; c++) {
1.1 root 144: ch = &s->chan[c];
145: again:
146: /* Test if thiws channel has any pending DMA requests. */
147: if ((ch->conf & (PL080_CCONF_H | PL080_CCONF_E))
148: != PL080_CCONF_E)
149: continue;
150: flow = (ch->conf >> 11) & 7;
151: if (flow >= 4) {
1.1.1.5 root 152: hw_error(
1.1 root 153: "pl080_run: Peripheral flow control not implemented\n");
154: }
155: src_id = (ch->conf >> 1) & 0x1f;
156: dest_id = (ch->conf >> 6) & 0x1f;
157: size = ch->ctrl & 0xfff;
158: req = s->req_single | s->req_burst;
159: switch (flow) {
160: case 0:
161: break;
162: case 1:
163: if ((req & (1u << dest_id)) == 0)
164: size = 0;
165: break;
166: case 2:
167: if ((req & (1u << src_id)) == 0)
168: size = 0;
169: break;
170: case 3:
171: if ((req & (1u << src_id)) == 0
172: || (req & (1u << dest_id)) == 0)
173: size = 0;
174: break;
175: }
176: if (!size)
177: continue;
178:
179: /* Transfer one element. */
180: /* ??? Should transfer multiple elements for a burst request. */
181: /* ??? Unclear what the proper behavior is when source and
182: destination widths are different. */
183: swidth = 1 << ((ch->ctrl >> 18) & 7);
184: dwidth = 1 << ((ch->ctrl >> 21) & 7);
185: for (n = 0; n < dwidth; n+= swidth) {
186: cpu_physical_memory_read(ch->src, buff + n, swidth);
187: if (ch->ctrl & PL080_CCTRL_SI)
188: ch->src += swidth;
189: }
190: xsize = (dwidth < swidth) ? swidth : dwidth;
191: /* ??? This may pad the value incorrectly for dwidth < 32. */
192: for (n = 0; n < xsize; n += dwidth) {
193: cpu_physical_memory_write(ch->dest + n, buff + n, dwidth);
194: if (ch->ctrl & PL080_CCTRL_DI)
195: ch->dest += swidth;
196: }
197:
198: size--;
199: ch->ctrl = (ch->ctrl & 0xfffff000) | size;
200: if (size == 0) {
201: /* Transfer complete. */
202: if (ch->lli) {
1.1.1.8 root 203: ch->src = ldl_le_phys(ch->lli);
204: ch->dest = ldl_le_phys(ch->lli + 4);
205: ch->ctrl = ldl_le_phys(ch->lli + 12);
206: ch->lli = ldl_le_phys(ch->lli + 8);
1.1 root 207: } else {
208: ch->conf &= ~PL080_CCONF_E;
209: }
210: if (ch->ctrl & PL080_CCTRL_I) {
211: s->tc_int |= 1 << c;
212: }
213: }
214: goto again;
215: }
216: if (--s->running)
217: s->running = 1;
218: }
219: }
220:
1.1.1.9 ! root 221: static uint64_t pl080_read(void *opaque, target_phys_addr_t offset,
! 222: unsigned size)
1.1 root 223: {
224: pl080_state *s = (pl080_state *)opaque;
225: uint32_t i;
226: uint32_t mask;
227:
228: if (offset >= 0xfe0 && offset < 0x1000) {
1.1.1.2 root 229: if (s->nchannels == 8) {
230: return pl080_id[(offset - 0xfe0) >> 2];
231: } else {
232: return pl081_id[(offset - 0xfe0) >> 2];
233: }
1.1 root 234: }
235: if (offset >= 0x100 && offset < 0x200) {
236: i = (offset & 0xe0) >> 5;
1.1.1.2 root 237: if (i >= s->nchannels)
238: goto bad_offset;
1.1 root 239: switch (offset >> 2) {
240: case 0: /* SrcAddr */
241: return s->chan[i].src;
242: case 1: /* DestAddr */
243: return s->chan[i].dest;
244: case 2: /* LLI */
245: return s->chan[i].lli;
246: case 3: /* Control */
247: return s->chan[i].ctrl;
248: case 4: /* Configuration */
249: return s->chan[i].conf;
250: default:
251: goto bad_offset;
252: }
253: }
254: switch (offset >> 2) {
255: case 0: /* IntStatus */
256: return (s->tc_int & s->tc_mask) | (s->err_int & s->err_mask);
257: case 1: /* IntTCStatus */
258: return (s->tc_int & s->tc_mask);
259: case 3: /* IntErrorStatus */
260: return (s->err_int & s->err_mask);
261: case 5: /* RawIntTCStatus */
262: return s->tc_int;
263: case 6: /* RawIntErrorStatus */
264: return s->err_int;
265: case 7: /* EnbldChns */
266: mask = 0;
1.1.1.2 root 267: for (i = 0; i < s->nchannels; i++) {
1.1 root 268: if (s->chan[i].conf & PL080_CCONF_E)
269: mask |= 1 << i;
270: }
271: return mask;
272: case 8: /* SoftBReq */
273: case 9: /* SoftSReq */
274: case 10: /* SoftLBReq */
275: case 11: /* SoftLSReq */
276: /* ??? Implement these. */
277: return 0;
278: case 12: /* Configuration */
279: return s->conf;
280: case 13: /* Sync */
281: return s->sync;
282: default:
283: bad_offset:
1.1.1.5 root 284: hw_error("pl080_read: Bad offset %x\n", (int)offset);
1.1 root 285: return 0;
286: }
287: }
288:
289: static void pl080_write(void *opaque, target_phys_addr_t offset,
1.1.1.9 ! root 290: uint64_t value, unsigned size)
1.1 root 291: {
292: pl080_state *s = (pl080_state *)opaque;
293: int i;
294:
295: if (offset >= 0x100 && offset < 0x200) {
296: i = (offset & 0xe0) >> 5;
1.1.1.2 root 297: if (i >= s->nchannels)
298: goto bad_offset;
1.1 root 299: switch (offset >> 2) {
300: case 0: /* SrcAddr */
301: s->chan[i].src = value;
302: break;
303: case 1: /* DestAddr */
304: s->chan[i].dest = value;
305: break;
306: case 2: /* LLI */
307: s->chan[i].lli = value;
308: break;
309: case 3: /* Control */
310: s->chan[i].ctrl = value;
311: break;
312: case 4: /* Configuration */
313: s->chan[i].conf = value;
314: pl080_run(s);
315: break;
316: }
317: }
318: switch (offset >> 2) {
319: case 2: /* IntTCClear */
320: s->tc_int &= ~value;
321: break;
322: case 4: /* IntErrorClear */
323: s->err_int &= ~value;
324: break;
325: case 8: /* SoftBReq */
326: case 9: /* SoftSReq */
327: case 10: /* SoftLBReq */
328: case 11: /* SoftLSReq */
329: /* ??? Implement these. */
1.1.1.5 root 330: hw_error("pl080_write: Soft DMA not implemented\n");
1.1 root 331: break;
332: case 12: /* Configuration */
333: s->conf = value;
334: if (s->conf & (PL080_CONF_M1 | PL080_CONF_M1)) {
1.1.1.5 root 335: hw_error("pl080_write: Big-endian DMA not implemented\n");
1.1 root 336: }
337: pl080_run(s);
338: break;
339: case 13: /* Sync */
340: s->sync = value;
341: break;
342: default:
1.1.1.2 root 343: bad_offset:
1.1.1.5 root 344: hw_error("pl080_write: Bad offset %x\n", (int)offset);
1.1 root 345: }
346: pl080_update(s);
347: }
348:
1.1.1.9 ! root 349: static const MemoryRegionOps pl080_ops = {
! 350: .read = pl080_read,
! 351: .write = pl080_write,
! 352: .endianness = DEVICE_NATIVE_ENDIAN,
1.1 root 353: };
354:
1.1.1.6 root 355: static int pl08x_init(SysBusDevice *dev, int nchannels)
1.1 root 356: {
1.1.1.5 root 357: pl080_state *s = FROM_SYSBUS(pl080_state, dev);
1.1 root 358:
1.1.1.9 ! root 359: memory_region_init_io(&s->iomem, &pl080_ops, s, "pl080", 0x1000);
! 360: sysbus_init_mmio(dev, &s->iomem);
1.1.1.5 root 361: sysbus_init_irq(dev, &s->irq);
1.1.1.2 root 362: s->nchannels = nchannels;
1.1.1.6 root 363: return 0;
1.1 root 364: }
1.1.1.5 root 365:
1.1.1.6 root 366: static int pl080_init(SysBusDevice *dev)
1.1.1.5 root 367: {
1.1.1.6 root 368: return pl08x_init(dev, 8);
1.1.1.5 root 369: }
370:
1.1.1.6 root 371: static int pl081_init(SysBusDevice *dev)
1.1.1.5 root 372: {
1.1.1.6 root 373: return pl08x_init(dev, 2);
1.1.1.5 root 374: }
375:
1.1.1.9 ! root 376: static void pl080_class_init(ObjectClass *klass, void *data)
! 377: {
! 378: DeviceClass *dc = DEVICE_CLASS(klass);
! 379: SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
! 380:
! 381: k->init = pl080_init;
! 382: dc->no_user = 1;
! 383: dc->vmsd = &vmstate_pl080;
! 384: }
! 385:
! 386: static TypeInfo pl080_info = {
! 387: .name = "pl080",
! 388: .parent = TYPE_SYS_BUS_DEVICE,
! 389: .instance_size = sizeof(pl080_state),
! 390: .class_init = pl080_class_init,
1.1.1.7 root 391: };
392:
1.1.1.9 ! root 393: static void pl081_class_init(ObjectClass *klass, void *data)
! 394: {
! 395: DeviceClass *dc = DEVICE_CLASS(klass);
! 396: SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
! 397:
! 398: k->init = pl081_init;
! 399: dc->no_user = 1;
! 400: dc->vmsd = &vmstate_pl080;
! 401: }
! 402:
! 403: static TypeInfo pl081_info = {
! 404: .name = "pl081",
! 405: .parent = TYPE_SYS_BUS_DEVICE,
! 406: .instance_size = sizeof(pl080_state),
! 407: .class_init = pl081_class_init,
1.1.1.7 root 408: };
409:
1.1.1.5 root 410: /* The PL080 and PL081 are the same except for the number of channels
411: they implement (8 and 2 respectively). */
1.1.1.9 ! root 412: static void pl080_register_types(void)
1.1.1.5 root 413: {
1.1.1.9 ! root 414: type_register_static(&pl080_info);
! 415: type_register_static(&pl081_info);
1.1.1.5 root 416: }
417:
1.1.1.9 ! root 418: type_init(pl080_register_types)
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.