314 lines
8.6 KiB
C
314 lines
8.6 KiB
C
/*
|
|
* Marvell 88w8618 audio emulation extracted from
|
|
* Marvell MV88w8618 / Freecom MusicPal emulation.
|
|
*
|
|
* Copyright (c) 2008 Jan Kiszka
|
|
*
|
|
* This code is licensed under the GNU GPL v2.
|
|
*
|
|
* Contributions after 2012-01-13 are licensed under the terms of the
|
|
* GNU GPL, version 2 or (at your option) any later version.
|
|
*/
|
|
|
|
#include "qemu/osdep.h"
|
|
#include "hw/sysbus.h"
|
|
#include "migration/vmstate.h"
|
|
#include "hw/irq.h"
|
|
#include "hw/qdev-properties.h"
|
|
#include "hw/audio/wm8750.h"
|
|
#include "audio/audio.h"
|
|
#include "qapi/error.h"
|
|
#include "qemu/module.h"
|
|
#include "qom/object.h"
|
|
|
|
#define MP_AUDIO_SIZE 0x00001000
|
|
|
|
/* Audio register offsets */
|
|
#define MP_AUDIO_PLAYBACK_MODE 0x00
|
|
#define MP_AUDIO_CLOCK_DIV 0x18
|
|
#define MP_AUDIO_IRQ_STATUS 0x20
|
|
#define MP_AUDIO_IRQ_ENABLE 0x24
|
|
#define MP_AUDIO_TX_START_LO 0x28
|
|
#define MP_AUDIO_TX_THRESHOLD 0x2C
|
|
#define MP_AUDIO_TX_STATUS 0x38
|
|
#define MP_AUDIO_TX_START_HI 0x40
|
|
|
|
/* Status register and IRQ enable bits */
|
|
#define MP_AUDIO_TX_HALF (1 << 6)
|
|
#define MP_AUDIO_TX_FULL (1 << 7)
|
|
|
|
/* Playback mode bits */
|
|
#define MP_AUDIO_16BIT_SAMPLE (1 << 0)
|
|
#define MP_AUDIO_PLAYBACK_EN (1 << 7)
|
|
#define MP_AUDIO_CLOCK_24MHZ (1 << 9)
|
|
#define MP_AUDIO_MONO (1 << 14)
|
|
|
|
OBJECT_DECLARE_SIMPLE_TYPE(mv88w8618_audio_state, MV88W8618_AUDIO)
|
|
|
|
struct mv88w8618_audio_state {
|
|
SysBusDevice parent_obj;
|
|
|
|
MemoryRegion iomem;
|
|
qemu_irq irq;
|
|
uint32_t playback_mode;
|
|
uint32_t status;
|
|
uint32_t irq_enable;
|
|
uint32_t phys_buf;
|
|
uint32_t target_buffer;
|
|
uint32_t threshold;
|
|
uint32_t play_pos;
|
|
uint32_t last_free;
|
|
uint32_t clock_div;
|
|
void *wm;
|
|
};
|
|
|
|
static void mv88w8618_audio_callback(void *opaque, int free_out, int free_in)
|
|
{
|
|
mv88w8618_audio_state *s = opaque;
|
|
int16_t *codec_buffer;
|
|
int8_t buf[4096];
|
|
int8_t *mem_buffer;
|
|
int pos, block_size;
|
|
|
|
if (!(s->playback_mode & MP_AUDIO_PLAYBACK_EN)) {
|
|
return;
|
|
}
|
|
if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE) {
|
|
free_out <<= 1;
|
|
}
|
|
if (!(s->playback_mode & MP_AUDIO_MONO)) {
|
|
free_out <<= 1;
|
|
}
|
|
block_size = s->threshold / 2;
|
|
if (free_out - s->last_free < block_size) {
|
|
return;
|
|
}
|
|
if (block_size > 4096) {
|
|
return;
|
|
}
|
|
cpu_physical_memory_read(s->target_buffer + s->play_pos, buf, block_size);
|
|
mem_buffer = buf;
|
|
if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE) {
|
|
if (s->playback_mode & MP_AUDIO_MONO) {
|
|
codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
|
|
for (pos = 0; pos < block_size; pos += 2) {
|
|
*codec_buffer++ = *(int16_t *)mem_buffer;
|
|
*codec_buffer++ = *(int16_t *)mem_buffer;
|
|
mem_buffer += 2;
|
|
}
|
|
} else {
|
|
memcpy(wm8750_dac_buffer(s->wm, block_size >> 2),
|
|
(uint32_t *)mem_buffer, block_size);
|
|
}
|
|
} else {
|
|
if (s->playback_mode & MP_AUDIO_MONO) {
|
|
codec_buffer = wm8750_dac_buffer(s->wm, block_size);
|
|
for (pos = 0; pos < block_size; pos++) {
|
|
*codec_buffer++ = cpu_to_le16(256 * *mem_buffer);
|
|
*codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
|
|
}
|
|
} else {
|
|
codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
|
|
for (pos = 0; pos < block_size; pos += 2) {
|
|
*codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
|
|
*codec_buffer++ = cpu_to_le16(256 * *mem_buffer++);
|
|
}
|
|
}
|
|
}
|
|
wm8750_dac_commit(s->wm);
|
|
|
|
s->last_free = free_out - block_size;
|
|
|
|
if (s->play_pos == 0) {
|
|
s->status |= MP_AUDIO_TX_HALF;
|
|
s->play_pos = block_size;
|
|
} else {
|
|
s->status |= MP_AUDIO_TX_FULL;
|
|
s->play_pos = 0;
|
|
}
|
|
|
|
if (s->status & s->irq_enable) {
|
|
qemu_irq_raise(s->irq);
|
|
}
|
|
}
|
|
|
|
static void mv88w8618_audio_clock_update(mv88w8618_audio_state *s)
|
|
{
|
|
int rate;
|
|
|
|
if (s->playback_mode & MP_AUDIO_CLOCK_24MHZ) {
|
|
rate = 24576000 / 64; /* 24.576MHz */
|
|
} else {
|
|
rate = 11289600 / 64; /* 11.2896MHz */
|
|
}
|
|
rate /= ((s->clock_div >> 8) & 0xff) + 1;
|
|
|
|
wm8750_set_bclk_in(s->wm, rate);
|
|
}
|
|
|
|
static uint64_t mv88w8618_audio_read(void *opaque, hwaddr offset,
|
|
unsigned size)
|
|
{
|
|
mv88w8618_audio_state *s = opaque;
|
|
|
|
switch (offset) {
|
|
case MP_AUDIO_PLAYBACK_MODE:
|
|
return s->playback_mode;
|
|
|
|
case MP_AUDIO_CLOCK_DIV:
|
|
return s->clock_div;
|
|
|
|
case MP_AUDIO_IRQ_STATUS:
|
|
return s->status;
|
|
|
|
case MP_AUDIO_IRQ_ENABLE:
|
|
return s->irq_enable;
|
|
|
|
case MP_AUDIO_TX_STATUS:
|
|
return s->play_pos >> 2;
|
|
|
|
default:
|
|
return 0;
|
|
}
|
|
}
|
|
|
|
static void mv88w8618_audio_write(void *opaque, hwaddr offset,
|
|
uint64_t value, unsigned size)
|
|
{
|
|
mv88w8618_audio_state *s = opaque;
|
|
|
|
switch (offset) {
|
|
case MP_AUDIO_PLAYBACK_MODE:
|
|
if (value & MP_AUDIO_PLAYBACK_EN &&
|
|
!(s->playback_mode & MP_AUDIO_PLAYBACK_EN)) {
|
|
s->status = 0;
|
|
s->last_free = 0;
|
|
s->play_pos = 0;
|
|
}
|
|
s->playback_mode = value;
|
|
mv88w8618_audio_clock_update(s);
|
|
break;
|
|
|
|
case MP_AUDIO_CLOCK_DIV:
|
|
s->clock_div = value;
|
|
s->last_free = 0;
|
|
s->play_pos = 0;
|
|
mv88w8618_audio_clock_update(s);
|
|
break;
|
|
|
|
case MP_AUDIO_IRQ_STATUS:
|
|
s->status &= ~value;
|
|
break;
|
|
|
|
case MP_AUDIO_IRQ_ENABLE:
|
|
s->irq_enable = value;
|
|
if (s->status & s->irq_enable) {
|
|
qemu_irq_raise(s->irq);
|
|
}
|
|
break;
|
|
|
|
case MP_AUDIO_TX_START_LO:
|
|
s->phys_buf = (s->phys_buf & 0xFFFF0000) | (value & 0xFFFF);
|
|
s->target_buffer = s->phys_buf;
|
|
s->play_pos = 0;
|
|
s->last_free = 0;
|
|
break;
|
|
|
|
case MP_AUDIO_TX_THRESHOLD:
|
|
s->threshold = (value + 1) * 4;
|
|
break;
|
|
|
|
case MP_AUDIO_TX_START_HI:
|
|
s->phys_buf = (s->phys_buf & 0xFFFF) | (value << 16);
|
|
s->target_buffer = s->phys_buf;
|
|
s->play_pos = 0;
|
|
s->last_free = 0;
|
|
break;
|
|
}
|
|
}
|
|
|
|
static void mv88w8618_audio_reset(DeviceState *d)
|
|
{
|
|
mv88w8618_audio_state *s = MV88W8618_AUDIO(d);
|
|
|
|
s->playback_mode = 0;
|
|
s->status = 0;
|
|
s->irq_enable = 0;
|
|
s->clock_div = 0;
|
|
s->threshold = 0;
|
|
s->phys_buf = 0;
|
|
}
|
|
|
|
static const MemoryRegionOps mv88w8618_audio_ops = {
|
|
.read = mv88w8618_audio_read,
|
|
.write = mv88w8618_audio_write,
|
|
.endianness = DEVICE_NATIVE_ENDIAN,
|
|
};
|
|
|
|
static void mv88w8618_audio_init(Object *obj)
|
|
{
|
|
SysBusDevice *dev = SYS_BUS_DEVICE(obj);
|
|
mv88w8618_audio_state *s = MV88W8618_AUDIO(dev);
|
|
|
|
sysbus_init_irq(dev, &s->irq);
|
|
|
|
memory_region_init_io(&s->iomem, obj, &mv88w8618_audio_ops, s,
|
|
"audio", MP_AUDIO_SIZE);
|
|
sysbus_init_mmio(dev, &s->iomem);
|
|
|
|
object_property_add_link(OBJECT(dev), "wm8750", TYPE_WM8750,
|
|
(Object **) &s->wm,
|
|
qdev_prop_allow_set_link_before_realize,
|
|
0);
|
|
}
|
|
|
|
static void mv88w8618_audio_realize(DeviceState *dev, Error **errp)
|
|
{
|
|
mv88w8618_audio_state *s = MV88W8618_AUDIO(dev);
|
|
|
|
wm8750_data_req_set(s->wm, mv88w8618_audio_callback, s);
|
|
}
|
|
|
|
static const VMStateDescription mv88w8618_audio_vmsd = {
|
|
.name = "mv88w8618_audio",
|
|
.version_id = 1,
|
|
.minimum_version_id = 1,
|
|
.fields = (VMStateField[]) {
|
|
VMSTATE_UINT32(playback_mode, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(status, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(irq_enable, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(phys_buf, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(target_buffer, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(threshold, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(play_pos, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(last_free, mv88w8618_audio_state),
|
|
VMSTATE_UINT32(clock_div, mv88w8618_audio_state),
|
|
VMSTATE_END_OF_LIST()
|
|
}
|
|
};
|
|
|
|
static void mv88w8618_audio_class_init(ObjectClass *klass, void *data)
|
|
{
|
|
DeviceClass *dc = DEVICE_CLASS(klass);
|
|
|
|
dc->realize = mv88w8618_audio_realize;
|
|
dc->reset = mv88w8618_audio_reset;
|
|
dc->vmsd = &mv88w8618_audio_vmsd;
|
|
dc->user_creatable = false;
|
|
}
|
|
|
|
static const TypeInfo mv88w8618_audio_info = {
|
|
.name = TYPE_MV88W8618_AUDIO,
|
|
.parent = TYPE_SYS_BUS_DEVICE,
|
|
.instance_size = sizeof(mv88w8618_audio_state),
|
|
.instance_init = mv88w8618_audio_init,
|
|
.class_init = mv88w8618_audio_class_init,
|
|
};
|
|
|
|
static void mv88w8618_register_types(void)
|
|
{
|
|
type_register_static(&mv88w8618_audio_info);
|
|
}
|
|
|
|
type_init(mv88w8618_register_types)
|