[qemu.git] / hw / audio / marvell_88w8618.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 "hw/sysbus.h"
#include "hw/hw.h"
#include "hw/i2c/i2c.h"
#include "audio/audio.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)

#define TYPE_MV88W8618_AUDIO "mv88w8618_audio"
#define MV88W8618_AUDIO(obj) \
    OBJECT_CHECK(mv88w8618_audio_state, (obj), TYPE_MV88W8618_AUDIO)

typedef 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;
} mv88w8618_audio_state;

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 int mv88w8618_audio_init(SysBusDevice *dev)
{
    mv88w8618_audio_state *s = MV88W8618_AUDIO(dev);

    sysbus_init_irq(dev, &s->irq);

    wm8750_data_req_set(s->wm, mv88w8618_audio_callback, s);

    memory_region_init_io(&s->iomem, OBJECT(s), &mv88w8618_audio_ops, s,
                          "audio", MP_AUDIO_SIZE);
    sysbus_init_mmio(dev, &s->iomem);

    return 0;
}

static const VMStateDescription mv88w8618_audio_vmsd = {
    .name = "mv88w8618_audio",
    .version_id = 1,
    .minimum_version_id = 1,
    .minimum_version_id_old = 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 Property mv88w8618_audio_properties[] = {
    DEFINE_PROP_PTR("wm8750", mv88w8618_audio_state, wm),
    {/* end of list */},
};

static void mv88w8618_audio_class_init(ObjectClass *klass, void *data)
{
    DeviceClass *dc = DEVICE_CLASS(klass);
    SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);

    k->init = mv88w8618_audio_init;
    dc->reset = mv88w8618_audio_reset;
    dc->vmsd = &mv88w8618_audio_vmsd;
    dc->props = mv88w8618_audio_properties;
    /* Reason: pointer property "wm8750" */
    dc->cannot_instantiate_with_device_add_yet = true;
}

static const TypeInfo mv88w8618_audio_info = {
    .name          = TYPE_MV88W8618_AUDIO,
    .parent        = TYPE_SYS_BUS_DEVICE,
    .instance_size = sizeof(mv88w8618_audio_state),
    .class_init    = mv88w8618_audio_class_init,
};

static void mv88w8618_register_types(void)
{
    type_register_static(&mv88w8618_audio_info);
}

type_init(mv88w8618_register_types)
Commit	Line	Data
ef07b491 AZ	1	/*
	2	* Marvell 88w8618 audio emulation extracted from
	3	* Marvell MV88w8618 / Freecom MusicPal emulation.
	4	*
	5	* Copyright (c) 2008 Jan Kiszka
	6	*
8e31bf38	7	* This code is licensed under the GNU GPL v2.
6b620ca3 PB	8	*
	9	* Contributions after 2012-01-13 are licensed under the terms of the
	10	* GNU GPL, version 2 or (at your option) any later version.
ef07b491	11	*/
83c9f4ca PB	12	#include "hw/sysbus.h"
83c9f4ca PB	13	#include "hw/hw.h"
0d09e41a	14	#include "hw/i2c/i2c.h"
ef07b491 AZ	15	#include "audio/audio.h"
	16
	17	#define MP_AUDIO_SIZE 0x00001000
	18
	19	/* Audio register offsets */
	20	#define MP_AUDIO_PLAYBACK_MODE 0x00
	21	#define MP_AUDIO_CLOCK_DIV 0x18
	22	#define MP_AUDIO_IRQ_STATUS 0x20
	23	#define MP_AUDIO_IRQ_ENABLE 0x24
	24	#define MP_AUDIO_TX_START_LO 0x28
	25	#define MP_AUDIO_TX_THRESHOLD 0x2C
	26	#define MP_AUDIO_TX_STATUS 0x38
	27	#define MP_AUDIO_TX_START_HI 0x40
	28
	29	/* Status register and IRQ enable bits */
	30	#define MP_AUDIO_TX_HALF (1 << 6)
	31	#define MP_AUDIO_TX_FULL (1 << 7)
	32
	33	/* Playback mode bits */
	34	#define MP_AUDIO_16BIT_SAMPLE (1 << 0)
	35	#define MP_AUDIO_PLAYBACK_EN (1 << 7)
	36	#define MP_AUDIO_CLOCK_24MHZ (1 << 9)
	37	#define MP_AUDIO_MONO (1 << 14)
	38
9e3f8599 AF	39	#define TYPE_MV88W8618_AUDIO "mv88w8618_audio"
	40	#define MV88W8618_AUDIO(obj) \
	41	OBJECT_CHECK(mv88w8618_audio_state, (obj), TYPE_MV88W8618_AUDIO)
	42
ef07b491	43	typedef struct mv88w8618_audio_state {
9e3f8599 AF	44	SysBusDevice parent_obj;
9e3f8599 AF	45
e2ba99e9	46	MemoryRegion iomem;
ef07b491 AZ	47	qemu_irq irq;
	48	uint32_t playback_mode;
	49	uint32_t status;
	50	uint32_t irq_enable;
d5b61ddd	51	uint32_t phys_buf;
ef07b491	52	uint32_t target_buffer;
d5b61ddd JK	53	uint32_t threshold;
	54	uint32_t play_pos;
	55	uint32_t last_free;
ef07b491	56	uint32_t clock_div;
e855761c	57	void *wm;
ef07b491 AZ	58	} mv88w8618_audio_state;
	59
	60	static void mv88w8618_audio_callback(void *opaque, int free_out, int free_in)
	61	{
	62	mv88w8618_audio_state *s = opaque;
	63	int16_t *codec_buffer;
	64	int8_t buf[4096];
	65	int8_t *mem_buffer;
	66	int pos, block_size;
	67
49fedd0d	68	if (!(s->playback_mode & MP_AUDIO_PLAYBACK_EN)) {
ef07b491	69	return;
49fedd0d JK	70	}
49fedd0d JK	71	if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE) {
ef07b491	72	free_out <<= 1;
49fedd0d JK	73	}
49fedd0d JK	74	if (!(s->playback_mode & MP_AUDIO_MONO)) {
ef07b491	75	free_out <<= 1;
49fedd0d	76	}
ef07b491	77	block_size = s->threshold / 2;
49fedd0d	78	if (free_out - s->last_free < block_size) {
ef07b491	79	return;
49fedd0d JK	80	}
49fedd0d JK	81	if (block_size > 4096) {
ef07b491	82	return;
49fedd0d	83	}
e1fe50dc	84	cpu_physical_memory_read(s->target_buffer + s->play_pos, buf, block_size);
ef07b491 AZ	85	mem_buffer = buf;
	86	if (s->playback_mode & MP_AUDIO_16BIT_SAMPLE) {
	87	if (s->playback_mode & MP_AUDIO_MONO) {
	88	codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
	89	for (pos = 0; pos < block_size; pos += 2) {
	90	codec_buffer++ = (int16_t *)mem_buffer;
	91	codec_buffer++ = (int16_t *)mem_buffer;
	92	mem_buffer += 2;
	93	}
49fedd0d	94	} else {
ef07b491 AZ	95	memcpy(wm8750_dac_buffer(s->wm, block_size >> 2),
ef07b491 AZ	96	(uint32_t *)mem_buffer, block_size);
49fedd0d	97	}
ef07b491 AZ	98	} else {
	99	if (s->playback_mode & MP_AUDIO_MONO) {
	100	codec_buffer = wm8750_dac_buffer(s->wm, block_size);
	101	for (pos = 0; pos < block_size; pos++) {
	102	codec_buffer++ = cpu_to_le16(256 *mem_buffer);
	103	codec_buffer++ = cpu_to_le16(256 *mem_buffer++);
	104	}
	105	} else {
	106	codec_buffer = wm8750_dac_buffer(s->wm, block_size >> 1);
	107	for (pos = 0; pos < block_size; pos += 2) {
	108	codec_buffer++ = cpu_to_le16(256 *mem_buffer++);
	109	codec_buffer++ = cpu_to_le16(256 *mem_buffer++);
	110	}
	111	}
	112	}
	113	wm8750_dac_commit(s->wm);
	114
	115	s->last_free = free_out - block_size;
	116
	117	if (s->play_pos == 0) {
	118	s->status \|= MP_AUDIO_TX_HALF;
	119	s->play_pos = block_size;
	120	} else {
	121	s->status \|= MP_AUDIO_TX_FULL;
	122	s->play_pos = 0;
	123	}
	124
49fedd0d	125	if (s->status & s->irq_enable) {
ef07b491	126	qemu_irq_raise(s->irq);
49fedd0d	127	}
ef07b491 AZ	128	}
	129
	130	static void mv88w8618_audio_clock_update(mv88w8618_audio_state *s)
	131	{
	132	int rate;
	133
49fedd0d	134	if (s->playback_mode & MP_AUDIO_CLOCK_24MHZ) {
ef07b491	135	rate = 24576000 / 64; /* 24.576MHz */
49fedd0d	136	} else {
ef07b491	137	rate = 11289600 / 64; /* 11.2896MHz */
49fedd0d	138	}
ef07b491 AZ	139	rate /= ((s->clock_div >> 8) & 0xff) + 1;
	140
	141	wm8750_set_bclk_in(s->wm, rate);
	142	}
	143
a8170e5e	144	static uint64_t mv88w8618_audio_read(void *opaque, hwaddr offset,
e2ba99e9	145	unsigned size)
ef07b491 AZ	146	{
	147	mv88w8618_audio_state *s = opaque;
	148
	149	switch (offset) {
	150	case MP_AUDIO_PLAYBACK_MODE:
	151	return s->playback_mode;
	152
	153	case MP_AUDIO_CLOCK_DIV:
	154	return s->clock_div;
	155
	156	case MP_AUDIO_IRQ_STATUS:
	157	return s->status;
	158
	159	case MP_AUDIO_IRQ_ENABLE:
	160	return s->irq_enable;
	161
	162	case MP_AUDIO_TX_STATUS:
	163	return s->play_pos >> 2;
	164
	165	default:
	166	return 0;
	167	}
	168	}
	169
a8170e5e	170	static void mv88w8618_audio_write(void *opaque, hwaddr offset,
e2ba99e9	171	uint64_t value, unsigned size)
ef07b491 AZ	172	{
	173	mv88w8618_audio_state *s = opaque;
	174
	175	switch (offset) {
	176	case MP_AUDIO_PLAYBACK_MODE:
	177	if (value & MP_AUDIO_PLAYBACK_EN &&
	178	!(s->playback_mode & MP_AUDIO_PLAYBACK_EN)) {
	179	s->status = 0;
	180	s->last_free = 0;
	181	s->play_pos = 0;
	182	}
	183	s->playback_mode = value;
	184	mv88w8618_audio_clock_update(s);
	185	break;
	186
	187	case MP_AUDIO_CLOCK_DIV:
	188	s->clock_div = value;
	189	s->last_free = 0;
	190	s->play_pos = 0;
	191	mv88w8618_audio_clock_update(s);
	192	break;
	193
	194	case MP_AUDIO_IRQ_STATUS:
	195	s->status &= ~value;
	196	break;
	197
	198	case MP_AUDIO_IRQ_ENABLE:
	199	s->irq_enable = value;
49fedd0d	200	if (s->status & s->irq_enable) {
ef07b491	201	qemu_irq_raise(s->irq);
49fedd0d	202	}
ef07b491 AZ	203	break;
	204
	205	case MP_AUDIO_TX_START_LO:
	206	s->phys_buf = (s->phys_buf & 0xFFFF0000) \| (value & 0xFFFF);
	207	s->target_buffer = s->phys_buf;
	208	s->play_pos = 0;
	209	s->last_free = 0;
	210	break;
	211
	212	case MP_AUDIO_TX_THRESHOLD:
	213	s->threshold = (value + 1) * 4;
	214	break;
	215
	216	case MP_AUDIO_TX_START_HI:
	217	s->phys_buf = (s->phys_buf & 0xFFFF) \| (value << 16);
	218	s->target_buffer = s->phys_buf;
	219	s->play_pos = 0;
	220	s->last_free = 0;
	221	break;
	222	}
	223	}
	224
d5b61ddd	225	static void mv88w8618_audio_reset(DeviceState *d)
ef07b491	226	{
9e3f8599	227	mv88w8618_audio_state *s = MV88W8618_AUDIO(d);
ef07b491 AZ	228
	229	s->playback_mode = 0;
	230	s->status = 0;
	231	s->irq_enable = 0;
267c4840 JK	232	s->clock_div = 0;
	233	s->threshold = 0;
	234	s->phys_buf = 0;
ef07b491 AZ	235	}
ef07b491 AZ	236
e2ba99e9 BC	237	static const MemoryRegionOps mv88w8618_audio_ops = {
	238	.read = mv88w8618_audio_read,
	239	.write = mv88w8618_audio_write,
	240	.endianness = DEVICE_NATIVE_ENDIAN,
ef07b491 AZ	241	};
ef07b491 AZ	242
81a322d4	243	static int mv88w8618_audio_init(SysBusDevice *dev)
ef07b491	244	{
9e3f8599	245	mv88w8618_audio_state *s = MV88W8618_AUDIO(dev);
ef07b491 AZ	246
	247	sysbus_init_irq(dev, &s->irq);
	248
	249	wm8750_data_req_set(s->wm, mv88w8618_audio_callback, s);
	250
64bde0f3	251	memory_region_init_io(&s->iomem, OBJECT(s), &mv88w8618_audio_ops, s,
e2ba99e9	252	"audio", MP_AUDIO_SIZE);
750ecd44	253	sysbus_init_mmio(dev, &s->iomem);
ef07b491	254
81a322d4	255	return 0;
ef07b491 AZ	256	}
ef07b491 AZ	257
d5b61ddd JK	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
999e12bb AL	277	static Property mv88w8618_audio_properties[] = {
	278	DEFINE_PROP_PTR("wm8750", mv88w8618_audio_state, wm),
	279	{/* end of list */},
	280	};
	281
	282	static void mv88w8618_audio_class_init(ObjectClass klass, void data)
	283	{
39bffca2	284	DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb AL	285	SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
	286
	287	k->init = mv88w8618_audio_init;
39bffca2 AL	288	dc->reset = mv88w8618_audio_reset;
	289	dc->vmsd = &mv88w8618_audio_vmsd;
	290	dc->props = mv88w8618_audio_properties;
1b111dc1 MA	291	/* Reason: pointer property "wm8750" */
1b111dc1 MA	292	dc->cannot_instantiate_with_device_add_yet = true;
999e12bb AL	293	}
999e12bb AL	294
8c43a6f0	295	static const TypeInfo mv88w8618_audio_info = {
9e3f8599	296	.name = TYPE_MV88W8618_AUDIO,
39bffca2 AL	297	.parent = TYPE_SYS_BUS_DEVICE,
	298	.instance_size = sizeof(mv88w8618_audio_state),
	299	.class_init = mv88w8618_audio_class_init,
ef07b491	300	};
ef07b491	301
83f7d43a	302	static void mv88w8618_register_types(void)
ef07b491	303	{
39bffca2	304	type_register_static(&mv88w8618_audio_info);
ef07b491 AZ	305	}
ef07b491 AZ	306
83f7d43a	307	type_init(mv88w8618_register_types)