[qemu.git] / hw / gus.c

/*
 * QEMU Proxy for Gravis Ultrasound GF1 emulation by Tibor "TS" Schütz
 *
 * Copyright (c) 2002-2005 Vassili Karpov (malc)
 *
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
#include "hw.h"
#include "audiodev.h"
#include "audio/audio.h"
#include "isa.h"
#include "gusemu.h"
#include "gustate.h"

#define dolog(...) AUD_log ("audio", __VA_ARGS__)
#ifdef DEBUG
#define ldebug(...) dolog (__VA_ARGS__)
#else
#define ldebug(...)
#endif

#ifdef HOST_WORDS_BIGENDIAN
#define GUS_ENDIANNESS 1
#else
#define GUS_ENDIANNESS 0
#endif

#define IO_READ_PROTO(name) \
    static uint32_t name (void *opaque, uint32_t nport)
#define IO_WRITE_PROTO(name) \
    static void name (void *opaque, uint32_t nport, uint32_t val)

static struct {
    int port;
    int irq;
    int dma;
    int freq;
} conf = {0x240, 7, 3, 44100};

typedef struct GUSState {
    GUSEmuState emu;
    QEMUSoundCard card;
    int freq;
    int pos, left, shift, irqs;
    GUSsample *mixbuf;
    uint8_t himem[1024 * 1024 + 32 + 4096];
    int samples;
    SWVoiceOut *voice;
    int64_t last_ticks;
    qemu_irq *pic;
} GUSState;

IO_READ_PROTO (gus_readb)
{
    GUSState *s = opaque;

    return gus_read (&s->emu, nport, 1);
}

IO_READ_PROTO (gus_readw)
{
    GUSState *s = opaque;

    return gus_read (&s->emu, nport, 2);
}

IO_WRITE_PROTO (gus_writeb)
{
    GUSState *s = opaque;

    gus_write (&s->emu, nport, 1, val);
}

IO_WRITE_PROTO (gus_writew)
{
    GUSState *s = opaque;

    gus_write (&s->emu, nport, 2, val);
}

static int write_audio (GUSState *s, int samples)
{
    int net = 0;
    int pos = s->pos;

    while (samples) {
        int nbytes, wbytes, wsampl;

        nbytes = samples << s->shift;
        wbytes = AUD_write (
            s->voice,
            s->mixbuf + (pos << (s->shift - 1)),
            nbytes
            );

        if (wbytes) {
            wsampl = wbytes >> s->shift;

            samples -= wsampl;
            pos = (pos + wsampl) % s->samples;

            net += wsampl;
        }
        else {
            break;
        }
    }

    return net;
}

static void GUS_callback (void *opaque, int free)
{
    int samples, to_play, net = 0;
    GUSState *s = opaque;

    samples = free >> s->shift;
    to_play = audio_MIN (samples, s->left);

    while (to_play) {
        int written = write_audio (s, to_play);

        if (!written) {
            goto reset;
        }

        s->left -= written;
        to_play -= written;
        samples -= written;
        net += written;
    }

    samples = audio_MIN (samples, s->samples);
    if (samples) {
        gus_mixvoices (&s->emu, s->freq, samples, s->mixbuf);

        while (samples) {
            int written = write_audio (s, samples);
            if (!written) {
                break;
            }
            samples -= written;
            net += written;
        }
    }
    s->left = samples;

reset:
    gus_irqgen (&s->emu, (double) (net * 1000000) / s->freq);
}

int GUS_irqrequest (GUSEmuState *emu, int hwirq, int n)
{
    GUSState *s = emu->opaque;
    /* qemu_irq_lower (s->pic[hwirq]); */
    qemu_irq_raise (s->pic[hwirq]);
    s->irqs += n;
    ldebug ("irqrequest %d %d %d\n", hwirq, n, s->irqs);
    return n;
}

void GUS_irqclear (GUSEmuState *emu, int hwirq)
{
    GUSState *s = emu->opaque;
    ldebug ("irqclear %d %d\n", hwirq, s->irqs);
    qemu_irq_lower (s->pic[hwirq]);
    s->irqs -= 1;
#ifdef IRQ_STORM
    if (s->irqs > 0) {
        qemu_irq_raise (s->pic[hwirq]);
    }
#endif
}

void GUS_dmarequest (GUSEmuState *der)
{
    /* GUSState *s = (GUSState *) der; */
    ldebug ("dma request %d\n", der->gusdma);
    DMA_hold_DREQ (der->gusdma);
}

static int GUS_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
{
    GUSState *s = opaque;
    char tmpbuf[4096];
    int pos = dma_pos, mode, left = dma_len - dma_pos;

    ldebug ("read DMA %#x %d\n", dma_pos, dma_len);
    mode = DMA_get_channel_mode (s->emu.gusdma);
    while (left) {
        int to_copy = audio_MIN ((size_t) left, sizeof (tmpbuf));
        int copied;

        ldebug ("left=%d to_copy=%d pos=%d\n", left, to_copy, pos);
        copied = DMA_read_memory (nchan, tmpbuf, pos, to_copy);
        gus_dma_transferdata (&s->emu, tmpbuf, copied, left == copied);
        left -= copied;
        pos += copied;
    }

    if (0 == ((mode >> 4) & 1)) {
        DMA_release_DREQ (s->emu.gusdma);
    }
    return dma_len;
}

static void GUS_save (QEMUFile *f, void *opaque)
{
    GUSState *s = opaque;

    qemu_put_be32 (f, s->pos);
    qemu_put_be32 (f, s->left);
    qemu_put_be32 (f, s->shift);
    qemu_put_be32 (f, s->irqs);
    qemu_put_be32 (f, s->samples);
    qemu_put_be64 (f, s->last_ticks);
    qemu_put_buffer (f, s->himem, sizeof (s->himem));
}

static int GUS_load (QEMUFile *f, void *opaque, int version_id)
{
    GUSState *s = opaque;

    if (version_id != 2)
        return -EINVAL;

    s->pos = qemu_get_be32 (f);
    s->left = qemu_get_be32 (f);
    s->shift = qemu_get_be32 (f);
    s->irqs = qemu_get_be32 (f);
    s->samples = qemu_get_be32 (f);
    s->last_ticks = qemu_get_be64 (f);
    qemu_get_buffer (f, s->himem, sizeof (s->himem));
    return 0;
}

int GUS_init (qemu_irq *pic)
{
    GUSState *s;
    struct audsettings as;

    s = qemu_mallocz (sizeof (*s));

    AUD_register_card ("gus", &s->card);

    as.freq = conf.freq;
    as.nchannels = 2;
    as.fmt = AUD_FMT_S16;
    as.endianness = GUS_ENDIANNESS;

    s->voice = AUD_open_out (
        &s->card,
        NULL,
        "gus",
        s,
        GUS_callback,
        &as
        );

    if (!s->voice) {
        AUD_remove_card (&s->card);
        qemu_free (s);
        return -1;
    }

    s->shift = 2;
    s->samples = AUD_get_buffer_size_out (s->voice) >> s->shift;
    s->mixbuf = qemu_mallocz (s->samples << s->shift);

    register_ioport_write (conf.port, 1, 1, gus_writeb, s);
    register_ioport_write (conf.port, 1, 2, gus_writew, s);

    register_ioport_read ((conf.port + 0x100) & 0xf00, 1, 1, gus_readb, s);
    register_ioport_read ((conf.port + 0x100) & 0xf00, 1, 2, gus_readw, s);

    register_ioport_write (conf.port + 6, 10, 1, gus_writeb, s);
    register_ioport_write (conf.port + 6, 10, 2, gus_writew, s);
    register_ioport_read (conf.port + 6, 10, 1, gus_readb, s);
    register_ioport_read (conf.port + 6, 10, 2, gus_readw, s);


    register_ioport_write (conf.port + 0x100, 8, 1, gus_writeb, s);
    register_ioport_write (conf.port + 0x100, 8, 2, gus_writew, s);
    register_ioport_read (conf.port + 0x100, 8, 1, gus_readb, s);
    register_ioport_read (conf.port + 0x100, 8, 2, gus_readw, s);

    DMA_register_channel (conf.dma, GUS_read_DMA, s);
    s->emu.gusirq = conf.irq;
    s->emu.gusdma = conf.dma;
    s->emu.himemaddr = s->himem;
    s->emu.gusdatapos = s->emu.himemaddr + 1024 * 1024 + 32;
    s->emu.opaque = s;
    s->freq = conf.freq;
    s->pic = pic;

    AUD_set_active_out (s->voice, 1);

    register_savevm ("gus", 0, 2, GUS_save, GUS_load, s);
    return 0;
}
Commit	Line	Data
423d65f4 AZ	1	/*
	2	* QEMU Proxy for Gravis Ultrasound GF1 emulation by Tibor "TS" Schütz
	3	*
	4	* Copyright (c) 2002-2005 Vassili Karpov (malc)
	5	*
	6	* Permission is hereby granted, free of charge, to any person obtaining a copy
	7	* of this software and associated documentation files (the "Software"), to deal
	8	* in the Software without restriction, including without limitation the rights
	9	* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
	10	* copies of the Software, and to permit persons to whom the Software is
	11	* furnished to do so, subject to the following conditions:
	12	*
	13	* The above copyright notice and this permission notice shall be included in
	14	* all copies or substantial portions of the Software.
	15	*
	16	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	17	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	18	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	19	* THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
	20	* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
	21	* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
	22	* THE SOFTWARE.
	23	*/
	24	#include "hw.h"
	25	#include "audiodev.h"
	26	#include "audio/audio.h"
	27	#include "isa.h"
	28	#include "gusemu.h"
	29	#include "gustate.h"
	30
	31	#define dolog(...) AUD_log ("audio", __VA_ARGS__)
	32	#ifdef DEBUG
	33	#define ldebug(...) dolog (__VA_ARGS__)
	34	#else
	35	#define ldebug(...)
	36	#endif
	37
e2542fe2	38	#ifdef HOST_WORDS_BIGENDIAN
423d65f4 AZ	39	#define GUS_ENDIANNESS 1
	40	#else
	41	#define GUS_ENDIANNESS 0
	42	#endif
	43
	44	#define IO_READ_PROTO(name) \
371bc573	45	static uint32_t name (void *opaque, uint32_t nport)
423d65f4	46	#define IO_WRITE_PROTO(name) \
371bc573	47	static void name (void *opaque, uint32_t nport, uint32_t val)
423d65f4 AZ	48
	49	static struct {
	50	int port;
	51	int irq;
	52	int dma;
	53	int freq;
	54	} conf = {0x240, 7, 3, 44100};
	55
	56	typedef struct GUSState {
	57	GUSEmuState emu;
	58	QEMUSoundCard card;
	59	int freq;
	60	int pos, left, shift, irqs;
731ba0ce	61	GUSsample *mixbuf;
423d65f4 AZ	62	uint8_t himem[1024 * 1024 + 32 + 4096];
	63	int samples;
	64	SWVoiceOut *voice;
	65	int64_t last_ticks;
	66	qemu_irq *pic;
	67	} GUSState;
	68
	69	IO_READ_PROTO (gus_readb)
	70	{
	71	GUSState *s = opaque;
	72
	73	return gus_read (&s->emu, nport, 1);
	74	}
	75
	76	IO_READ_PROTO (gus_readw)
	77	{
	78	GUSState *s = opaque;
	79
	80	return gus_read (&s->emu, nport, 2);
	81	}
	82
	83	IO_WRITE_PROTO (gus_writeb)
	84	{
	85	GUSState *s = opaque;
	86
	87	gus_write (&s->emu, nport, 1, val);
	88	}
	89
	90	IO_WRITE_PROTO (gus_writew)
	91	{
	92	GUSState *s = opaque;
	93
	94	gus_write (&s->emu, nport, 2, val);
	95	}
	96
	97	static int write_audio (GUSState *s, int samples)
	98	{
	99	int net = 0;
	100	int pos = s->pos;
	101
	102	while (samples) {
	103	int nbytes, wbytes, wsampl;
	104
	105	nbytes = samples << s->shift;
	106	wbytes = AUD_write (
	107	s->voice,
	108	s->mixbuf + (pos << (s->shift - 1)),
	109	nbytes
	110	);
	111
	112	if (wbytes) {
	113	wsampl = wbytes >> s->shift;
	114
	115	samples -= wsampl;
	116	pos = (pos + wsampl) % s->samples;
	117
	118	net += wsampl;
	119	}
	120	else {
	121	break;
	122	}
	123	}
	124
	125	return net;
126	}
127
128	static void GUS_callback (void *opaque, int free)
129	{
130	int samples, to_play, net = 0;
131	GUSState *s = opaque;
132
133	samples = free >> s->shift;
134	to_play = audio_MIN (samples, s->left);
135
136	while (to_play) {
137	int written = write_audio (s, to_play);
138
139	if (!written) {
140	goto reset;
141	}
142
143	s->left -= written;
144	to_play -= written;
145	samples -= written;
146	net += written;
147	}
148
149	samples = audio_MIN (samples, s->samples);
150	if (samples) {
151	gus_mixvoices (&s->emu, s->freq, samples, s->mixbuf);
152
153	while (samples) {
154	int written = write_audio (s, samples);
155	if (!written) {
156	break;
157	}
158	samples -= written;
159	net += written;
160	}
161	}
162	s->left = samples;
163
164	reset:
165	gus_irqgen (&s->emu, (double) (net * 1000000) / s->freq);
166	}
167
168	int GUS_irqrequest (GUSEmuState *emu, int hwirq, int n)
169	{
170	GUSState *s = emu->opaque;
171	/* qemu_irq_lower (s->pic[hwirq]); */
172	qemu_irq_raise (s->pic[hwirq]);
173	s->irqs += n;
174	ldebug ("irqrequest %d %d %d\n", hwirq, n, s->irqs);
175	return n;
176	}
177
178	void GUS_irqclear (GUSEmuState *emu, int hwirq)
179	{
180	GUSState *s = emu->opaque;
181	ldebug ("irqclear %d %d\n", hwirq, s->irqs);
182	qemu_irq_lower (s->pic[hwirq]);
183	s->irqs -= 1;
184	#ifdef IRQ_STORM
185	if (s->irqs > 0) {
186	qemu_irq_raise (s->pic[hwirq]);
187	}
188	#endif
189	}
190
191	void GUS_dmarequest (GUSEmuState *der)
192	{
193	/* GUSState s = (GUSState ) der; */
194	ldebug ("dma request %d\n", der->gusdma);
195	DMA_hold_DREQ (der->gusdma);
196	}
197
371bc573	198	static int GUS_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
423d65f4 AZ	199	{
423d65f4 AZ	200	GUSState *s = opaque;
731ba0ce	201	char tmpbuf[4096];
423d65f4 AZ	202	int pos = dma_pos, mode, left = dma_len - dma_pos;
	203
	204	ldebug ("read DMA %#x %d\n", dma_pos, dma_len);
	205	mode = DMA_get_channel_mode (s->emu.gusdma);
	206	while (left) {
	207	int to_copy = audio_MIN ((size_t) left, sizeof (tmpbuf));
	208	int copied;
	209
	210	ldebug ("left=%d to_copy=%d pos=%d\n", left, to_copy, pos);
	211	copied = DMA_read_memory (nchan, tmpbuf, pos, to_copy);
	212	gus_dma_transferdata (&s->emu, tmpbuf, copied, left == copied);
	213	left -= copied;
	214	pos += copied;
	215	}
	216
	217	if (0 == ((mode >> 4) & 1)) {
	218	DMA_release_DREQ (s->emu.gusdma);
	219	}
	220	return dma_len;
	221	}
	222
5b5ef0db	223	static void GUS_save (QEMUFile f, void opaque)
5b5ef0db	224	{
5b5ef0db	225	GUSState *s = opaque;
5b5ef0db	226
db8baf14	227	qemu_put_be32 (f, s->pos);
	228	qemu_put_be32 (f, s->left);
	229	qemu_put_be32 (f, s->shift);
	230	qemu_put_be32 (f, s->irqs);
	231	qemu_put_be32 (f, s->samples);
	232	qemu_put_be64 (f, s->last_ticks);
5b5ef0db	233	qemu_put_buffer (f, s->himem, sizeof (s->himem));
	234	}
	235
	236	static int GUS_load (QEMUFile f, void opaque, int version_id)
	237	{
5b5ef0db	238	GUSState *s = opaque;
5b5ef0db	239
8210169a	240	if (version_id != 2)
5b5ef0db	241	return -EINVAL;
5b5ef0db	242
db8baf14	243	s->pos = qemu_get_be32 (f);
	244	s->left = qemu_get_be32 (f);
	245	s->shift = qemu_get_be32 (f);
	246	s->irqs = qemu_get_be32 (f);
	247	s->samples = qemu_get_be32 (f);
	248	s->last_ticks = qemu_get_be64 (f);
5b5ef0db	249	qemu_get_buffer (f, s->himem, sizeof (s->himem));
	250	return 0;
	251	}
	252
22d83b14	253	int GUS_init (qemu_irq *pic)
423d65f4 AZ	254	{
423d65f4 AZ	255	GUSState *s;
1ea879e5	256	struct audsettings as;
423d65f4	257
423d65f4	258	s = qemu_mallocz (sizeof (*s));
423d65f4	259
1a7dafce	260	AUD_register_card ("gus", &s->card);
423d65f4 AZ	261
	262	as.freq = conf.freq;
	263	as.nchannels = 2;
	264	as.fmt = AUD_FMT_S16;
	265	as.endianness = GUS_ENDIANNESS;
	266
	267	s->voice = AUD_open_out (
	268	&s->card,
	269	NULL,
	270	"gus",
	271	s,
	272	GUS_callback,
	273	&as
	274	);
	275
	276	if (!s->voice) {
	277	AUD_remove_card (&s->card);
	278	qemu_free (s);
	279	return -1;
	280	}
	281
	282	s->shift = 2;
	283	s->samples = AUD_get_buffer_size_out (s->voice) >> s->shift;
	284	s->mixbuf = qemu_mallocz (s->samples << s->shift);
423d65f4 AZ	285
	286	register_ioport_write (conf.port, 1, 1, gus_writeb, s);
	287	register_ioport_write (conf.port, 1, 2, gus_writew, s);
	288
	289	register_ioport_read ((conf.port + 0x100) & 0xf00, 1, 1, gus_readb, s);
	290	register_ioport_read ((conf.port + 0x100) & 0xf00, 1, 2, gus_readw, s);
	291
	292	register_ioport_write (conf.port + 6, 10, 1, gus_writeb, s);
	293	register_ioport_write (conf.port + 6, 10, 2, gus_writew, s);
	294	register_ioport_read (conf.port + 6, 10, 1, gus_readb, s);
	295	register_ioport_read (conf.port + 6, 10, 2, gus_readw, s);
	296
	297
	298	register_ioport_write (conf.port + 0x100, 8, 1, gus_writeb, s);
	299	register_ioport_write (conf.port + 0x100, 8, 2, gus_writew, s);
	300	register_ioport_read (conf.port + 0x100, 8, 1, gus_readb, s);
	301	register_ioport_read (conf.port + 0x100, 8, 2, gus_readw, s);
	302
	303	DMA_register_channel (conf.dma, GUS_read_DMA, s);
	304	s->emu.gusirq = conf.irq;
	305	s->emu.gusdma = conf.dma;
	306	s->emu.himemaddr = s->himem;
	307	s->emu.gusdatapos = s->emu.himemaddr + 1024 * 1024 + 32;
	308	s->emu.opaque = s;
	309	s->freq = conf.freq;
	310	s->pic = pic;
	311
	312	AUD_set_active_out (s->voice, 1);
5b5ef0db	313
8210169a	314	register_savevm ("gus", 0, 2, GUS_save, GUS_load, s);
423d65f4 AZ	315	return 0;
423d65f4 AZ	316	}