hw/audio/pl041.c

   1 /*
   2  * Arm PrimeCell PL041 Advanced Audio Codec Interface
   3  *
   4  * Copyright (c) 2011
   5  * Written by Mathieu Sonet - www.elasticsheep.com
   6  *
   7  * This code is licensed under the GPL.
   8  *
   9  * *****************************************************************
  10  *
  11  * This driver emulates the ARM AACI interface
  12  * connected to a LM4549 codec.
  13  *
  14  * Limitations:
  15  * - Supports only a playback on one channel (Versatile/Vexpress)
  16  * - Supports only one TX FIFO in compact-mode or non-compact mode.
  17  * - Supports playback of 12, 16, 18 and 20 bits samples.
  18  * - Record is not supported.
  19  * - The PL041 is hardwired to a LM4549 codec.
  20  *
  21  */
  22
  23 #include "qemu/osdep.h"
  24 #include "hw/sysbus.h"
  25 #include "qemu/log.h"
  26
  27 #include "pl041.h"
  28 #include "lm4549.h"
  29
  30 #if 0
  31 #define PL041_DEBUG_LEVEL 1
  32 #endif
  33
  34 #if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 1)
  35 #define DBG_L1(fmt, ...) \
  36 do { printf("pl041: " fmt , ## __VA_ARGS__); } while (0)
  37 #else
  38 #define DBG_L1(fmt, ...) \
  39 do { } while (0)
  40 #endif
  41
  42 #if defined(PL041_DEBUG_LEVEL) && (PL041_DEBUG_LEVEL >= 2)
  43 #define DBG_L2(fmt, ...) \
  44 do { printf("pl041: " fmt , ## __VA_ARGS__); } while (0)
  45 #else
  46 #define DBG_L2(fmt, ...) \
  47 do { } while (0)
  48 #endif
  49
  50
  51 #define MAX_FIFO_DEPTH      (1024)
  52 #define DEFAULT_FIFO_DEPTH  (8)
  53
  54 #define SLOT1_RW    (1 << 19)
  55
  56 /* This FIFO only stores 20-bit samples on 32-bit words.
  57    So its level is independent of the selected mode */
  58 typedef struct {
  59     uint32_t level;
  60     uint32_t data[MAX_FIFO_DEPTH];
  61 } pl041_fifo;
  62
  63 typedef struct {
  64     pl041_fifo tx_fifo;
  65     uint8_t tx_enabled;
  66     uint8_t tx_compact_mode;
  67     uint8_t tx_sample_size;
  68
  69     pl041_fifo rx_fifo;
  70     uint8_t rx_enabled;
  71     uint8_t rx_compact_mode;
  72     uint8_t rx_sample_size;
  73 } pl041_channel;
  74
  75 #define TYPE_PL041 "pl041"
  76 #define PL041(obj) OBJECT_CHECK(PL041State, (obj), TYPE_PL041)
  77
  78 typedef struct PL041State {
  79     SysBusDevice parent_obj;
  80
  81     MemoryRegion iomem;
  82     qemu_irq irq;
  83
  84     uint32_t fifo_depth; /* FIFO depth in non-compact mode */
  85
  86     pl041_regfile regs;
  87     pl041_channel fifo1;
  88     lm4549_state codec;
  89 } PL041State;
  90
  91
  92 static const unsigned char pl041_default_id[8] = {
  93     0x41, 0x10, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1
  94 };
  95
  96 #if defined(PL041_DEBUG_LEVEL)
  97 #define REGISTER(name, offset) #name,
  98 static const char *pl041_regs_name[] = {
  99     #include "pl041.hx"
 100 };
 101 #undef REGISTER
 102 #endif
 103
 104
 105 #if defined(PL041_DEBUG_LEVEL)
 106 static const char *get_reg_name(hwaddr offset)
 107 {
 108     if (offset <= PL041_dr1_7) {
 109         return pl041_regs_name[offset >> 2];
 110     }
 111
 112     return "unknown";
 113 }
 114 #endif
 115
 116 static uint8_t pl041_compute_periphid3(PL041State *s)
 117 {
 118     uint8_t id3 = 1; /* One channel */
 119
 120     /* Add the fifo depth information */
 121     switch (s->fifo_depth) {
 122     case 8:
 123         id3 |= 0 << 3;
 124         break;
 125     case 32:
 126         id3 |= 1 << 3;
 127         break;
 128     case 64:
 129         id3 |= 2 << 3;
 130         break;
 131     case 128:
 132         id3 |= 3 << 3;
 133         break;
 134     case 256:
 135         id3 |= 4 << 3;
 136         break;
 137     case 512:
 138         id3 |= 5 << 3;
 139         break;
 140     case 1024:
 141         id3 |= 6 << 3;
 142         break;
 143     case 2048:
 144         id3 |= 7 << 3;
 145         break;
 146     }
 147
 148     return id3;
 149 }
 150
 151 static void pl041_reset(PL041State *s)
 152 {
 153     DBG_L1("pl041_reset\n");
 154
 155     memset(&s->regs, 0x00, sizeof(pl041_regfile));
 156
 157     s->regs.slfr = SL1TXEMPTY | SL2TXEMPTY | SL12TXEMPTY;
 158     s->regs.sr1 = TXFE | RXFE | TXHE;
 159     s->regs.isr1 = 0;
 160
 161     memset(&s->fifo1, 0x00, sizeof(s->fifo1));
 162 }
 163
 164
 165 static void pl041_fifo1_write(PL041State *s, uint32_t value)
 166 {
 167     pl041_channel *channel = &s->fifo1;
 168     pl041_fifo *fifo = &s->fifo1.tx_fifo;
 169
 170     /* Push the value in the FIFO */
 171     if (channel->tx_compact_mode == 0) {
 172         /* Non-compact mode */
 173
 174         if (fifo->level < s->fifo_depth) {
 175             /* Pad the value with 0 to obtain a 20-bit sample */
 176             switch (channel->tx_sample_size) {
 177             case 12:
 178                 value = (value << 8) & 0xFFFFF;
 179                 break;
 180             case 16:
 181                 value = (value << 4) & 0xFFFFF;
 182                 break;
 183             case 18:
 184                 value = (value << 2) & 0xFFFFF;
 185                 break;
 186             case 20:
 187             default:
 188                 break;
 189             }
 190
 191             /* Store the sample in the FIFO */
 192             fifo->data[fifo->level++] = value;
 193         }
 194 #if defined(PL041_DEBUG_LEVEL)
 195         else {
 196             DBG_L1("fifo1 write: overrun\n");
 197         }
 198 #endif
 199     } else {
 200         /* Compact mode */
 201
 202         if ((fifo->level + 2) < s->fifo_depth) {
 203             uint32_t i = 0;
 204             uint32_t sample = 0;
 205
 206             for (i = 0; i < 2; i++) {
 207                 sample = value & 0xFFFF;
 208                 value = value >> 16;
 209
 210                 /* Pad each sample with 0 to obtain a 20-bit sample */
 211                 switch (channel->tx_sample_size) {
 212                 case 12:
 213                     sample = sample << 8;
 214                     break;
 215                 case 16:
 216                 default:
 217                     sample = sample << 4;
 218                     break;
 219                 }
 220
 221                 /* Store the sample in the FIFO */
 222                 fifo->data[fifo->level++] = sample;
 223             }
 224         }
 225 #if defined(PL041_DEBUG_LEVEL)
 226         else {
 227             DBG_L1("fifo1 write: overrun\n");
 228         }
 229 #endif
 230     }
 231
 232     /* Update the status register */
 233     if (fifo->level > 0) {
 234         s->regs.sr1 &= ~(TXUNDERRUN | TXFE);
 235     }
 236
 237     if (fifo->level >= (s->fifo_depth / 2)) {
 238         s->regs.sr1 &= ~TXHE;
 239     }
 240
 241     if (fifo->level >= s->fifo_depth) {
 242         s->regs.sr1 |= TXFF;
 243     }
 244
 245     DBG_L2("fifo1_push sr1 = 0x%08x\n", s->regs.sr1);
 246 }
 247
 248 static void pl041_fifo1_transmit(PL041State *s)
 249 {
 250     pl041_channel *channel = &s->fifo1;
 251     pl041_fifo *fifo = &s->fifo1.tx_fifo;
 252     uint32_t slots = s->regs.txcr1 & TXSLOT_MASK;
 253     uint32_t written_samples;
 254
 255     /* Check if FIFO1 transmit is enabled */
 256     if ((channel->tx_enabled) && (slots & (TXSLOT3 | TXSLOT4))) {
 257         if (fifo->level >= (s->fifo_depth / 2)) {
 258             int i;
 259
 260             DBG_L1("Transfer FIFO level = %i\n", fifo->level);
 261
 262             /* Try to transfer the whole FIFO */
 263             for (i = 0; i < (fifo->level / 2); i++) {
 264                 uint32_t left = fifo->data[i * 2];
 265                 uint32_t right = fifo->data[i * 2 + 1];
 266
 267                  /* Transmit two 20-bit samples to the codec */
 268                 if (lm4549_write_samples(&s->codec, left, right) == 0) {
 269                     DBG_L1("Codec buffer full\n");
 270                     break;
 271                 }
 272             }
 273
 274             written_samples = i * 2;
 275             if (written_samples > 0) {
 276                 /* Update the FIFO level */
 277                 fifo->level -= written_samples;
 278
 279                 /* Move back the pending samples to the start of the FIFO */
 280                 for (i = 0; i < fifo->level; i++) {
 281                     fifo->data[i] = fifo->data[written_samples + i];
 282                 }
 283
 284                 /* Update the status register */
 285                 s->regs.sr1 &= ~TXFF;
 286
 287                 if (fifo->level <= (s->fifo_depth / 2)) {
 288                     s->regs.sr1 |= TXHE;
 289                 }
 290
 291                 if (fifo->level == 0) {
 292                     s->regs.sr1 |= TXFE | TXUNDERRUN;
 293                     DBG_L1("Empty FIFO\n");
 294                 }
 295             }
 296         }
 297     }
 298 }
 299
 300 static void pl041_isr1_update(PL041State *s)
 301 {
 302     /* Update ISR1 */
 303     if (s->regs.sr1 & TXUNDERRUN) {
 304         s->regs.isr1 |= URINTR;
 305     } else {
 306         s->regs.isr1 &= ~URINTR;
 307     }
 308
 309     if (s->regs.sr1 & TXHE) {
 310         s->regs.isr1 |= TXINTR;
 311     } else {
 312         s->regs.isr1 &= ~TXINTR;
 313     }
 314
 315     if (!(s->regs.sr1 & TXBUSY) && (s->regs.sr1 & TXFE)) {
 316         s->regs.isr1 |= TXCINTR;
 317     } else {
 318         s->regs.isr1 &= ~TXCINTR;
 319     }
 320
 321     /* Update the irq state */
 322     qemu_set_irq(s->irq, ((s->regs.isr1 & s->regs.ie1) > 0) ? 1 : 0);
 323     DBG_L2("Set interrupt sr1 = 0x%08x isr1 = 0x%08x masked = 0x%08x\n",
 324            s->regs.sr1, s->regs.isr1, s->regs.isr1 & s->regs.ie1);
 325 }
 326
 327 static void pl041_request_data(void *opaque)
 328 {
 329     PL041State *s = (PL041State *)opaque;
 330
 331     /* Trigger pending transfers */
 332     pl041_fifo1_transmit(s);
 333     pl041_isr1_update(s);
 334 }
 335
 336 static uint64_t pl041_read(void *opaque, hwaddr offset,
 337                                 unsigned size)
 338 {
 339     PL041State *s = (PL041State *)opaque;
 340     int value;
 341
 342     if ((offset >= PL041_periphid0) && (offset <= PL041_pcellid3)) {
 343         if (offset == PL041_periphid3) {
 344             value = pl041_compute_periphid3(s);
 345         } else {
 346             value = pl041_default_id[(offset - PL041_periphid0) >> 2];
 347         }
 348
 349         DBG_L1("pl041_read [0x%08x] => 0x%08x\n", offset, value);
 350         return value;
 351     } else if (offset <= PL041_dr4_7) {
 352         value = *((uint32_t *)&s->regs + (offset >> 2));
 353     } else {
 354         DBG_L1("pl041_read: Reserved offset %x\n", (int)offset);
 355         return 0;
 356     }
 357
 358     switch (offset) {
 359     case PL041_allints:
 360         value = s->regs.isr1 & 0x7F;
 361         break;
 362     }
 363
 364     DBG_L1("pl041_read [0x%08x] %s => 0x%08x\n", offset,
 365            get_reg_name(offset), value);
 366
 367     return value;
 368 }
 369
 370 static void pl041_write(void *opaque, hwaddr offset,
 371                              uint64_t value, unsigned size)
 372 {
 373     PL041State *s = (PL041State *)opaque;
 374     uint16_t control, data;
 375     uint32_t result;
 376
 377     DBG_L1("pl041_write [0x%08x] %s <= 0x%08x\n", offset,
 378            get_reg_name(offset), (unsigned int)value);
 379
 380     /* Write the register */
 381     if (offset <= PL041_dr4_7) {
 382         *((uint32_t *)&s->regs + (offset >> 2)) = value;
 383     } else {
 384         DBG_L1("pl041_write: Reserved offset %x\n", (int)offset);
 385         return;
 386     }
 387
 388     /* Execute the actions */
 389     switch (offset) {
 390     case PL041_txcr1:
 391     {
 392         pl041_channel *channel = &s->fifo1;
 393
 394         uint32_t txen = s->regs.txcr1 & TXEN;
 395         uint32_t tsize = (s->regs.txcr1 & TSIZE_MASK) >> TSIZE_MASK_BIT;
 396         uint32_t compact_mode = (s->regs.txcr1 & TXCOMPACT) ? 1 : 0;
 397 #if defined(PL041_DEBUG_LEVEL)
 398         uint32_t slots = (s->regs.txcr1 & TXSLOT_MASK) >> TXSLOT_MASK_BIT;
 399         uint32_t txfen = (s->regs.txcr1 & TXFEN) > 0 ? 1 : 0;
 400 #endif
 401
 402         DBG_L1("=> txen = %i slots = 0x%01x tsize = %i compact = %i "
 403                "txfen = %i\n", txen, slots,  tsize, compact_mode, txfen);
 404
 405         channel->tx_enabled = txen;
 406         channel->tx_compact_mode = compact_mode;
 407
 408         switch (tsize) {
 409         case 0:
 410             channel->tx_sample_size = 16;
 411             break;
 412         case 1:
 413             channel->tx_sample_size = 18;
 414             break;
 415         case 2:
 416             channel->tx_sample_size = 20;
 417             break;
 418         case 3:
 419             channel->tx_sample_size = 12;
 420             break;
 421         }
 422
 423         DBG_L1("TX enabled = %i\n", channel->tx_enabled);
 424         DBG_L1("TX compact mode = %i\n", channel->tx_compact_mode);
 425         DBG_L1("TX sample width = %i\n", channel->tx_sample_size);
 426
 427         /* Check if compact mode is allowed with selected tsize */
 428         if (channel->tx_compact_mode == 1) {
 429             if ((channel->tx_sample_size == 18) ||
 430                 (channel->tx_sample_size == 20)) {
 431                 channel->tx_compact_mode = 0;
 432                 DBG_L1("Compact mode not allowed with 18/20-bit sample size\n");
 433             }
 434         }
 435
 436         break;
 437     }
 438     case PL041_sl1tx:
 439         s->regs.slfr &= ~SL1TXEMPTY;
 440
 441         control = (s->regs.sl1tx >> 12) & 0x7F;
 442         data = (s->regs.sl2tx >> 4) & 0xFFFF;
 443
 444         if ((s->regs.sl1tx & SLOT1_RW) == 0) {
 445             /* Write operation */
 446             lm4549_write(&s->codec, control, data);
 447         } else {
 448             /* Read operation */
 449             result = lm4549_read(&s->codec, control);
 450
 451             /* Store the returned value */
 452             s->regs.sl1rx = s->regs.sl1tx & ~SLOT1_RW;
 453             s->regs.sl2rx = result << 4;
 454
 455             s->regs.slfr &= ~(SL1RXBUSY | SL2RXBUSY);
 456             s->regs.slfr |= SL1RXVALID | SL2RXVALID;
 457         }
 458         break;
 459
 460     case PL041_sl2tx:
 461         s->regs.sl2tx = value;
 462         s->regs.slfr &= ~SL2TXEMPTY;
 463         break;
 464
 465     case PL041_intclr:
 466         DBG_L1("=> Clear interrupt intclr = 0x%08x isr1 = 0x%08x\n",
 467                s->regs.intclr, s->regs.isr1);
 468
 469         if (s->regs.intclr & TXUEC1) {
 470             s->regs.sr1 &= ~TXUNDERRUN;
 471         }
 472         break;
 473
 474     case PL041_maincr:
 475     {
 476 #if defined(PL041_DEBUG_LEVEL)
 477         char debug[] = " AACIFE  SL1RXEN  SL1TXEN";
 478         if (!(value & AACIFE)) {
 479             debug[0] = '!';
 480         }
 481         if (!(value & SL1RXEN)) {
 482             debug[8] = '!';
 483         }
 484         if (!(value & SL1TXEN)) {
 485             debug[17] = '!';
 486         }
 487         DBG_L1("%s\n", debug);
 488 #endif
 489
 490         if ((s->regs.maincr & AACIFE) == 0) {
 491             pl041_reset(s);
 492         }
 493         break;
 494     }
 495
 496     case PL041_dr1_0:
 497     case PL041_dr1_1:
 498     case PL041_dr1_2:
 499     case PL041_dr1_3:
 500         pl041_fifo1_write(s, value);
 501         break;
 502     }
 503
 504     /* Transmit the FIFO content */
 505     pl041_fifo1_transmit(s);
 506
 507     /* Update the ISR1 register */
 508     pl041_isr1_update(s);
 509 }
 510
 511 static void pl041_device_reset(DeviceState *d)
 512 {
 513     PL041State *s = PL041(d);
 514
 515     pl041_reset(s);
 516 }
 517
 518 static const MemoryRegionOps pl041_ops = {
 519     .read = pl041_read,
 520     .write = pl041_write,
 521     .endianness = DEVICE_NATIVE_ENDIAN,
 522 };
 523
 524 static int pl041_init(SysBusDevice *dev)
 525 {
 526     PL041State *s = PL041(dev);
 527
 528     DBG_L1("pl041_init 0x%08x\n", (uint32_t)s);
 529
 530     /* Check the device properties */
 531     switch (s->fifo_depth) {
 532     case 8:
 533     case 32:
 534     case 64:
 535     case 128:
 536     case 256:
 537     case 512:
 538     case 1024:
 539     case 2048:
 540         break;
 541     case 16:
 542     default:
 543         /* NC FIFO depth of 16 is not allowed because its id bits in
 544            AACIPERIPHID3 overlap with the id for the default NC FIFO depth */
 545         qemu_log_mask(LOG_UNIMP,
 546                       "pl041: unsupported non-compact fifo depth [%i]\n",
 547                       s->fifo_depth);
 548         return -1;
 549     }
 550
 551     /* Connect the device to the sysbus */
 552     memory_region_init_io(&s->iomem, OBJECT(s), &pl041_ops, s, "pl041", 0x1000);
 553     sysbus_init_mmio(dev, &s->iomem);
 554     sysbus_init_irq(dev, &s->irq);
 555
 556     /* Init the codec */
 557     lm4549_init(&s->codec, &pl041_request_data, (void *)s);
 558
 559     return 0;
 560 }
 561
 562 static const VMStateDescription vmstate_pl041_regfile = {
 563     .name = "pl041_regfile",
 564     .version_id = 1,
 565     .minimum_version_id = 1,
 566     .fields = (VMStateField[]) {
 567 #define REGISTER(name, offset) VMSTATE_UINT32(name, pl041_regfile),
 568         #include "pl041.hx"
 569 #undef REGISTER
 570         VMSTATE_END_OF_LIST()
 571     }
 572 };
 573
 574 static const VMStateDescription vmstate_pl041_fifo = {
 575     .name = "pl041_fifo",
 576     .version_id = 1,
 577     .minimum_version_id = 1,
 578     .fields = (VMStateField[]) {
 579         VMSTATE_UINT32(level, pl041_fifo),
 580         VMSTATE_UINT32_ARRAY(data, pl041_fifo, MAX_FIFO_DEPTH),
 581         VMSTATE_END_OF_LIST()
 582     }
 583 };
 584
 585 static const VMStateDescription vmstate_pl041_channel = {
 586     .name = "pl041_channel",
 587     .version_id = 1,
 588     .minimum_version_id = 1,
 589     .fields = (VMStateField[]) {
 590         VMSTATE_STRUCT(tx_fifo, pl041_channel, 0,
 591                        vmstate_pl041_fifo, pl041_fifo),
 592         VMSTATE_UINT8(tx_enabled, pl041_channel),
 593         VMSTATE_UINT8(tx_compact_mode, pl041_channel),
 594         VMSTATE_UINT8(tx_sample_size, pl041_channel),
 595         VMSTATE_STRUCT(rx_fifo, pl041_channel, 0,
 596                        vmstate_pl041_fifo, pl041_fifo),
 597         VMSTATE_UINT8(rx_enabled, pl041_channel),
 598         VMSTATE_UINT8(rx_compact_mode, pl041_channel),
 599         VMSTATE_UINT8(rx_sample_size, pl041_channel),
 600         VMSTATE_END_OF_LIST()
 601     }
 602 };
 603
 604 static const VMStateDescription vmstate_pl041 = {
 605     .name = "pl041",
 606     .version_id = 1,
 607     .minimum_version_id = 1,
 608     .fields = (VMStateField[]) {
 609         VMSTATE_UINT32(fifo_depth, PL041State),
 610         VMSTATE_STRUCT(regs, PL041State, 0,
 611                        vmstate_pl041_regfile, pl041_regfile),
 612         VMSTATE_STRUCT(fifo1, PL041State, 0,
 613                        vmstate_pl041_channel, pl041_channel),
 614         VMSTATE_STRUCT(codec, PL041State, 0,
 615                        vmstate_lm4549_state, lm4549_state),
 616         VMSTATE_END_OF_LIST()
 617     }
 618 };
 619
 620 static Property pl041_device_properties[] = {
 621     /* Non-compact FIFO depth property */
 622     DEFINE_PROP_UINT32("nc_fifo_depth", PL041State, fifo_depth,
 623                        DEFAULT_FIFO_DEPTH),
 624     DEFINE_PROP_END_OF_LIST(),
 625 };
 626
 627 static void pl041_device_class_init(ObjectClass *klass, void *data)
 628 {
 629     DeviceClass *dc = DEVICE_CLASS(klass);
 630     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
 631
 632     k->init = pl041_init;
 633     set_bit(DEVICE_CATEGORY_SOUND, dc->categories);
 634     dc->reset = pl041_device_reset;
 635     dc->vmsd = &vmstate_pl041;
 636     dc->props = pl041_device_properties;
 637 }
 638
 639 static const TypeInfo pl041_device_info = {
 640     .name          = TYPE_PL041,
 641     .parent        = TYPE_SYS_BUS_DEVICE,
 642     .instance_size = sizeof(PL041State),
 643     .class_init    = pl041_device_class_init,
 644 };
 645
 646 static void pl041_register_types(void)
 647 {
 648     type_register_static(&pl041_device_info);
 649 }
 650
 651 type_init(pl041_register_types)