hw/marvell_88w8618_audio.c

   1 /*
   2  * Marvell 88w8618 audio emulation extracted from
   3  * Marvell MV88w8618 / Freecom MusicPal emulation.
   4  *
   5  * Copyright (c) 2008 Jan Kiszka
   6  *
   7  * This code is licenced under the GNU GPL v2.
   8  */
   9 #include "sysbus.h"
  10 #include "hw.h"
  11 #include "i2c.h"
  12 #include "sysbus.h"
  13 #include "audio/audio.h"
  14
  15 #define MP_AUDIO_SIZE           0x00001000
  16
  17 /* Audio register offsets */
  18 #define MP_AUDIO_PLAYBACK_MODE  0x00
  19 #define MP_AUDIO_CLOCK_DIV      0x18
  20 #define MP_AUDIO_IRQ_STATUS     0x20
  21 #define MP_AUDIO_IRQ_ENABLE     0x24
  22 #define MP_AUDIO_TX_START_LO    0x28
  23 #define MP_AUDIO_TX_THRESHOLD   0x2C
  24 #define MP_AUDIO_TX_STATUS      0x38
  25 #define MP_AUDIO_TX_START_HI    0x40
  26
  27 /* Status register and IRQ enable bits */
  28 #define MP_AUDIO_TX_HALF        (1 << 6)
  29 #define MP_AUDIO_TX_FULL        (1 << 7)
  30
  31 /* Playback mode bits */
  32 #define MP_AUDIO_16BIT_SAMPLE   (1 << 0)
  33 #define MP_AUDIO_PLAYBACK_EN    (1 << 7)
  34 #define MP_AUDIO_CLOCK_24MHZ    (1 << 9)
  35 #define MP_AUDIO_MONO           (1 << 14)
  36
  37 typedef struct mv88w8618_audio_state {
  38     SysBusDevice busdev;
  39     qemu_irq irq;
  40     uint32_t playback_mode;
  41     uint32_t status;
  42     uint32_t irq_enable;
  43     uint32_t phys_buf;
  44     uint32_t target_buffer;
  45     uint32_t threshold;
  46     uint32_t play_pos;
  47     uint32_t last_free;
  48     uint32_t clock_div;
  49     DeviceState *wm;
  50 } mv88w8618_audio_state;
  51
  52 static void mv88w8618_audio_callback(void *opaque, int free_out, int free_in)
  53 {
  54     mv88w8618_audio_state *s = opaque;
  55     int16_t *codec_buffer;
  56     int8_t buf[4096];
  57     int8_t *mem_buffer;
  58     int pos, block_size;
  59
  60     if (!(s->playback_mode & MP_AUDIO_PLAYBACK_EN)) {
  61         return;
  62     }
  63     if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE) {
  64         free_out <<= 1;
  65     }
  66     if (!(s->playback_mode & MP_AUDIO_MONO)) {
  67         free_out <<= 1;
  68     }
  69     block_size = s->threshold / 2;
  70     if (free_out - s->last_free < block_size) {
  71         return;
  72     }
  73     if (block_size > 4096) {
  74         return;
  75     }
  76     cpu_physical_memory_read(s->target_buffer + s->play_pos, (void *)buf,
  77                              block_size);
  78     mem_buffer = buf;
  79     if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE) {
  80         if (s->playback_mode & MP_AUDIO_MONO) {
  81             codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
  82             for (pos = 0; pos < block_size; pos += 2) {
  83                 *codec_buffer++ = *(int16_t *)mem_buffer;
  84                 *codec_buffer++ = *(int16_t *)mem_buffer;
  85                 mem_buffer += 2;
  86             }
  87         } else {
  88             memcpy(wm8750_dac_buffer(s->wm, block_size >> 2),
  89                    (uint32_t *)mem_buffer, block_size);
  90         }
  91     } else {
  92         if (s->playback_mode & MP_AUDIO_MONO) {
  93             codec_buffer = wm8750_dac_buffer(s->wm, block_size);
  94             for (pos = 0; pos < block_size; pos++) {
  95                 *codec_buffer++ = cpu_to_le16(256 * *mem_buffer);
  96                 *codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
  97             }
  98         } else {
  99             codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
 100             for (pos = 0; pos < block_size; pos += 2) {
 101                 *codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
 102                 *codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
 103             }
 104         }
 105     }
 106     wm8750_dac_commit(s->wm);
 107
 108     s->last_free = free_out - block_size;
 109
 110     if (s->play_pos == 0) {
 111         s->status |= MP_AUDIO_TX_HALF;
 112         s->play_pos = block_size;
 113     } else {
 114         s->status |= MP_AUDIO_TX_FULL;
 115         s->play_pos = 0;
 116     }
 117
 118     if (s->status & s->irq_enable) {
 119         qemu_irq_raise(s->irq);
 120     }
 121 }
 122
 123 static void mv88w8618_audio_clock_update(mv88w8618_audio_state *s)
 124 {
 125     int rate;
 126
 127     if (s->playback_mode & MP_AUDIO_CLOCK_24MHZ) {
 128         rate = 24576000 / 64; /* 24.576MHz */
 129     } else {
 130         rate = 11289600 / 64; /* 11.2896MHz */
 131     }
 132     rate /= ((s->clock_div >> 8) & 0xff) + 1;
 133
 134     wm8750_set_bclk_in(s->wm, rate);
 135 }
 136
 137 static uint32_t mv88w8618_audio_read(void *opaque, target_phys_addr_t offset)
 138 {
 139     mv88w8618_audio_state *s = opaque;
 140
 141     switch (offset) {
 142     case MP_AUDIO_PLAYBACK_MODE:
 143         return s->playback_mode;
 144
 145     case MP_AUDIO_CLOCK_DIV:
 146         return s->clock_div;
 147
 148     case MP_AUDIO_IRQ_STATUS:
 149         return s->status;
 150
 151     case MP_AUDIO_IRQ_ENABLE:
 152         return s->irq_enable;
 153
 154     case MP_AUDIO_TX_STATUS:
 155         return s->play_pos >> 2;
 156
 157     default:
 158         return 0;
 159     }
 160 }
 161
 162 static void mv88w8618_audio_write(void *opaque, target_phys_addr_t offset,
 163                                  uint32_t value)
 164 {
 165     mv88w8618_audio_state *s = opaque;
 166
 167     switch (offset) {
 168     case MP_AUDIO_PLAYBACK_MODE:
 169         if (value & MP_AUDIO_PLAYBACK_EN &&
 170             !(s->playback_mode & MP_AUDIO_PLAYBACK_EN)) {
 171             s->status = 0;
 172             s->last_free = 0;
 173             s->play_pos = 0;
 174         }
 175         s->playback_mode = value;
 176         mv88w8618_audio_clock_update(s);
 177         break;
 178
 179     case MP_AUDIO_CLOCK_DIV:
 180         s->clock_div = value;
 181         s->last_free = 0;
 182         s->play_pos = 0;
 183         mv88w8618_audio_clock_update(s);
 184         break;
 185
 186     case MP_AUDIO_IRQ_STATUS:
 187         s->status &= ~value;
 188         break;
 189
 190     case MP_AUDIO_IRQ_ENABLE:
 191         s->irq_enable = value;
 192         if (s->status & s->irq_enable) {
 193             qemu_irq_raise(s->irq);
 194         }
 195         break;
 196
 197     case MP_AUDIO_TX_START_LO:
 198         s->phys_buf = (s->phys_buf & 0xFFFF0000) | (value & 0xFFFF);
 199         s->target_buffer = s->phys_buf;
 200         s->play_pos = 0;
 201         s->last_free = 0;
 202         break;
 203
 204     case MP_AUDIO_TX_THRESHOLD:
 205         s->threshold = (value + 1) * 4;
 206         break;
 207
 208     case MP_AUDIO_TX_START_HI:
 209         s->phys_buf = (s->phys_buf & 0xFFFF) | (value << 16);
 210         s->target_buffer = s->phys_buf;
 211         s->play_pos = 0;
 212         s->last_free = 0;
 213         break;
 214     }
 215 }
 216
 217 static void mv88w8618_audio_reset(DeviceState *d)
 218 {
 219     mv88w8618_audio_state *s = FROM_SYSBUS(mv88w8618_audio_state,
 220                                            sysbus_from_qdev(d));
 221
 222     s->playback_mode = 0;
 223     s->status = 0;
 224     s->irq_enable = 0;
 225     s->clock_div = 0;
 226     s->threshold = 0;
 227     s->phys_buf = 0;
 228 }
 229
 230 static CPUReadMemoryFunc * const mv88w8618_audio_readfn[] = {
 231     mv88w8618_audio_read,
 232     mv88w8618_audio_read,
 233     mv88w8618_audio_read
 234 };
 235
 236 static CPUWriteMemoryFunc * const mv88w8618_audio_writefn[] = {
 237     mv88w8618_audio_write,
 238     mv88w8618_audio_write,
 239     mv88w8618_audio_write
 240 };
 241
 242 static int mv88w8618_audio_init(SysBusDevice *dev)
 243 {
 244     mv88w8618_audio_state *s = FROM_SYSBUS(mv88w8618_audio_state, dev);
 245     int iomemtype;
 246
 247     sysbus_init_irq(dev, &s->irq);
 248
 249     wm8750_data_req_set(s->wm, mv88w8618_audio_callback, s);
 250
 251     iomemtype = cpu_register_io_memory(mv88w8618_audio_readfn,
 252                                        mv88w8618_audio_writefn, s);
 253     sysbus_init_mmio(dev, MP_AUDIO_SIZE, iomemtype);
 254
 255     return 0;
 256 }
 257
 258 static const VMStateDescription mv88w8618_audio_vmsd = {
 259     .name = "mv88w8618_audio",
 260     .version_id = 1,
 261     .minimum_version_id = 1,
 262     .minimum_version_id_old = 1,
 263     .fields = (VMStateField[]) {
 264         VMSTATE_UINT32(playback_mode, mv88w8618_audio_state),
 265         VMSTATE_UINT32(status, mv88w8618_audio_state),
 266         VMSTATE_UINT32(irq_enable, mv88w8618_audio_state),
 267         VMSTATE_UINT32(phys_buf, mv88w8618_audio_state),
 268         VMSTATE_UINT32(target_buffer, mv88w8618_audio_state),
 269         VMSTATE_UINT32(threshold, mv88w8618_audio_state),
 270         VMSTATE_UINT32(play_pos, mv88w8618_audio_state),
 271         VMSTATE_UINT32(last_free, mv88w8618_audio_state),
 272         VMSTATE_UINT32(clock_div, mv88w8618_audio_state),
 273         VMSTATE_END_OF_LIST()
 274     }
 275 };
 276
 277 static SysBusDeviceInfo mv88w8618_audio_info = {
 278     .init = mv88w8618_audio_init,
 279     .qdev.name  = "mv88w8618_audio",
 280     .qdev.size  = sizeof(mv88w8618_audio_state),
 281     .qdev.reset = mv88w8618_audio_reset,
 282     .qdev.vmsd  = &mv88w8618_audio_vmsd,
 283     .qdev.props = (Property[]) {
 284         {
 285             .name   = "wm8750",
 286             .info   = &qdev_prop_ptr,
 287             .offset = offsetof(mv88w8618_audio_state, wm),
 288         },
 289         {/* end of list */}
 290     }
 291 };
 292
 293 static void mv88w8618_register_devices(void)
 294 {
 295     sysbus_register_withprop(&mv88w8618_audio_info);
 296 }
 297
 298 device_init(mv88w8618_register_devices)