Annotation of qemu/hw/pl080.c, revision 1.1.1.9

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)

unix.superglobalmegacorp.com

This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.