hw/gus.c - qemu - Git at Google

 /*
  * 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)

 typedef struct GUSState {
     ISADevice dev;
     GUSEmuState emu;
     QEMUSoundCard card;
     uint32_t freq;
     uint32_t port;
     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, muldiv64 (net, 1000000, s->freq));
 }

 int GUS_irqrequest (GUSEmuState *emu, int hwirq, int n)
 {
     GUSState *s = emu->opaque;
     /* qemu_irq_lower (s->pic); */
     qemu_irq_raise (s->pic);
     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);
     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;
 }

 static int gus_initfn (ISADevice *dev)
 {
     GUSState *s = DO_UPCAST(GUSState, dev, dev);
     struct audsettings as;

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

     as.freq = s->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);
         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 (s->port, 1, 1, gus_writeb, s);
     register_ioport_write (s->port, 1, 2, gus_writew, s);

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

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


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

     DMA_register_channel (s->emu.gusdma, GUS_read_DMA, s);
     s->emu.himemaddr = s->himem;
     s->emu.gusdatapos = s->emu.himemaddr + 1024 * 1024 + 32;
     s->emu.opaque = s;
     isa_init_irq (dev, &s->pic, s->emu.gusirq);

     AUD_set_active_out (s->voice, 1);

     register_savevm ("gus", 0, 2, GUS_save, GUS_load, s);
     return 0;
 }

 int GUS_init (qemu_irq *pic)
 {
     isa_create_simple ("gus");
     return 0;
 }

 static ISADeviceInfo gus_info = {
     .qdev.name     = "gus",
     .qdev.desc     = "Gravis Ultrasound GF1",
     .qdev.size     = sizeof (GUSState),
     .init          = gus_initfn,
     .qdev.props    = (Property[]) {
         DEFINE_PROP_UINT32 ("freq",    GUSState, freq,        44100),
         DEFINE_PROP_HEX32  ("iobase",  GUSState, port,        0x240),
         DEFINE_PROP_UINT32 ("irq",     GUSState, emu.gusirq,  7),
         DEFINE_PROP_UINT32 ("dma",     GUSState, emu.gusdma,  3),
         DEFINE_PROP_END_OF_LIST (),
     },
 };

 static void gus_register (void)
 {
     isa_qdev_register (&gus_info);
 }
 device_init (gus_register)
	/*
	* 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)

	typedef struct GUSState {
	ISADevice dev;
	GUSEmuState emu;
	QEMUSoundCard card;
	uint32_t freq;
	uint32_t port;
	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, muldiv64 (net, 1000000, s->freq));
	}

	int GUS_irqrequest (GUSEmuState *emu, int hwirq, int n)
	{
	GUSState *s = emu->opaque;
	/* qemu_irq_lower (s->pic); */
	qemu_irq_raise (s->pic);
	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);
	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;
	}

	static int gus_initfn (ISADevice *dev)
	{
	GUSState *s = DO_UPCAST(GUSState, dev, dev);
	struct audsettings as;

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

	as.freq = s->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);
	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 (s->port, 1, 1, gus_writeb, s);
	register_ioport_write (s->port, 1, 2, gus_writew, s);

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

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


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

	DMA_register_channel (s->emu.gusdma, GUS_read_DMA, s);
	s->emu.himemaddr = s->himem;
	s->emu.gusdatapos = s->emu.himemaddr + 1024 * 1024 + 32;
	s->emu.opaque = s;
	isa_init_irq (dev, &s->pic, s->emu.gusirq);

	AUD_set_active_out (s->voice, 1);

	register_savevm ("gus", 0, 2, GUS_save, GUS_load, s);
	return 0;
	}

	int GUS_init (qemu_irq *pic)
	{
	isa_create_simple ("gus");
	return 0;
	}

	static ISADeviceInfo gus_info = {
	.qdev.name = "gus",
	.qdev.desc = "Gravis Ultrasound GF1",
	.qdev.size = sizeof (GUSState),
	.init = gus_initfn,
	.qdev.props = (Property[]) {
	DEFINE_PROP_UINT32 ("freq", GUSState, freq, 44100),
	DEFINE_PROP_HEX32 ("iobase", GUSState, port, 0x240),
	DEFINE_PROP_UINT32 ("irq", GUSState, emu.gusirq, 7),
	DEFINE_PROP_UINT32 ("dma", GUSState, emu.gusdma, 3),
	DEFINE_PROP_END_OF_LIST (),
	},
	};

	static void gus_register (void)
	{
	isa_qdev_register (&gus_info);
	}
	device_init (gus_register)