This converts two devices at once because PIC subclasses ISA and converting subclasses independently is extremely hard. Signed-off-by: Anthony Liguori <aliguori@us.ibm.com>
		
			
				
	
	
		
			328 lines
		
	
	
		
			8.2 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			328 lines
		
	
	
		
			8.2 KiB
		
	
	
	
		
			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)
 | 
						|
 | 
						|
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 const VMStateDescription vmstate_gus = {
 | 
						|
    .name = "gus",
 | 
						|
    .version_id = 2,
 | 
						|
    .minimum_version_id = 2,
 | 
						|
    .minimum_version_id_old = 2,
 | 
						|
    .fields      = (VMStateField []) {
 | 
						|
        VMSTATE_INT32(pos, GUSState),
 | 
						|
        VMSTATE_INT32(left, GUSState),
 | 
						|
        VMSTATE_INT32(shift, GUSState),
 | 
						|
        VMSTATE_INT32(irqs, GUSState),
 | 
						|
        VMSTATE_INT32(samples, GUSState),
 | 
						|
        VMSTATE_INT64(last_ticks, GUSState),
 | 
						|
        VMSTATE_BUFFER(himem, GUSState),
 | 
						|
        VMSTATE_END_OF_LIST()
 | 
						|
    }
 | 
						|
};
 | 
						|
 | 
						|
static const MemoryRegionPortio gus_portio_list1[] = {
 | 
						|
    {0x000,  1, 1, .write = gus_writeb },
 | 
						|
    {0x000,  1, 2, .write = gus_writew },
 | 
						|
    {0x006, 10, 1, .read = gus_readb, .write = gus_writeb },
 | 
						|
    {0x006, 10, 2, .read = gus_readw, .write = gus_writew },
 | 
						|
    {0x100,  8, 1, .read = gus_readb, .write = gus_writeb },
 | 
						|
    {0x100,  8, 2, .read = gus_readw, .write = gus_writew },
 | 
						|
    PORTIO_END_OF_LIST(),
 | 
						|
};
 | 
						|
 | 
						|
static const MemoryRegionPortio gus_portio_list2[] = {
 | 
						|
    {0, 1, 1, .read = gus_readb },
 | 
						|
    {0, 1, 2, .read = gus_readw },
 | 
						|
    PORTIO_END_OF_LIST(),
 | 
						|
};
 | 
						|
 | 
						|
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 = g_malloc0 (s->samples << s->shift);
 | 
						|
 | 
						|
    isa_register_portio_list (dev, s->port, gus_portio_list1, s, "gus");
 | 
						|
    isa_register_portio_list (dev, (s->port + 0x100) & 0xf00,
 | 
						|
                              gus_portio_list2, s, "gus");
 | 
						|
 | 
						|
    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);
 | 
						|
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
int GUS_init (ISABus *bus)
 | 
						|
{
 | 
						|
    isa_create_simple (bus, "gus");
 | 
						|
    return 0;
 | 
						|
}
 | 
						|
 | 
						|
static void gus_class_initfn(ObjectClass *klass, void *data)
 | 
						|
{
 | 
						|
    ISADeviceClass *ic = ISA_DEVICE_CLASS(klass);
 | 
						|
    ic->init = gus_initfn;
 | 
						|
}
 | 
						|
 | 
						|
static DeviceInfo gus_info = {
 | 
						|
    .name     = "gus",
 | 
						|
    .desc     = "Gravis Ultrasound GF1",
 | 
						|
    .size     = sizeof (GUSState),
 | 
						|
    .vmsd     = &vmstate_gus,
 | 
						|
    .class_init          = gus_class_initfn,
 | 
						|
    .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)
 |