git.maemo.org Git - qemu/blob - hw/gus.c

   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
  38 #ifdef WORDS_BIGENDIAN
  39 #define GUS_ENDIANNESS 1
  40 #else
  41 #define GUS_ENDIANNESS 0
  42 #endif
  43
  44 #define IO_READ_PROTO(name) \
  45     static uint32_t name (void *opaque, uint32_t nport)
  46 #define IO_WRITE_PROTO(name) \
  47     static void name (void *opaque, uint32_t nport, uint32_t val)
  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;
  61     GUSsample *mixbuf;
  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
 198 static int GUS_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
 199 {
 200     GUSState *s = opaque;
 201     char tmpbuf[4096];
 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
 223 static void GUS_save (QEMUFile *f, void *opaque)
 224 {
 225     GUSState *s = opaque;
 226
 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);
 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 {
 238     GUSState *s = opaque;
 239
 240     if (version_id != 2)
 241         return -EINVAL;
 242
 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);
 249     qemu_get_buffer (f, s->himem, sizeof (s->himem));
 250     return 0;
 251 }
 252
 253 int GUS_init (AudioState *audio, qemu_irq *pic)
 254 {
 255     GUSState *s;
 256     struct audsettings as;
 257
 258     if (!audio) {
 259         dolog ("No audio state\n");
 260         return -1;
 261     }
 262
 263     s = qemu_mallocz (sizeof (*s));
 264
 265     AUD_register_card (audio, "gus", &s->card);
 266
 267     as.freq = conf.freq;
 268     as.nchannels = 2;
 269     as.fmt = AUD_FMT_S16;
 270     as.endianness = GUS_ENDIANNESS;
 271
 272     s->voice = AUD_open_out (
 273         &s->card,
 274         NULL,
 275         "gus",
 276         s,
 277         GUS_callback,
 278         &as
 279         );
 280
 281     if (!s->voice) {
 282         AUD_remove_card (&s->card);
 283         qemu_free (s);
 284         return -1;
 285     }
 286
 287     s->shift = 2;
 288     s->samples = AUD_get_buffer_size_out (s->voice) >> s->shift;
 289     s->mixbuf = qemu_mallocz (s->samples << s->shift);
 290
 291     register_ioport_write (conf.port, 1, 1, gus_writeb, s);
 292     register_ioport_write (conf.port, 1, 2, gus_writew, s);
 293
 294     register_ioport_read ((conf.port + 0x100) & 0xf00, 1, 1, gus_readb, s);
 295     register_ioport_read ((conf.port + 0x100) & 0xf00, 1, 2, gus_readw, s);
 296
 297     register_ioport_write (conf.port + 6, 10, 1, gus_writeb, s);
 298     register_ioport_write (conf.port + 6, 10, 2, gus_writew, s);
 299     register_ioport_read (conf.port + 6, 10, 1, gus_readb, s);
 300     register_ioport_read (conf.port + 6, 10, 2, gus_readw, s);
 301
 302
 303     register_ioport_write (conf.port + 0x100, 8, 1, gus_writeb, s);
 304     register_ioport_write (conf.port + 0x100, 8, 2, gus_writew, s);
 305     register_ioport_read (conf.port + 0x100, 8, 1, gus_readb, s);
 306     register_ioport_read (conf.port + 0x100, 8, 2, gus_readw, s);
 307
 308     DMA_register_channel (conf.dma, GUS_read_DMA, s);
 309     s->emu.gusirq = conf.irq;
 310     s->emu.gusdma = conf.dma;
 311     s->emu.himemaddr = s->himem;
 312     s->emu.gusdatapos = s->emu.himemaddr + 1024 * 1024 + 32;
 313     s->emu.opaque = s;
 314     s->freq = conf.freq;
 315     s->pic = pic;
 316
 317     AUD_set_active_out (s->voice, 1);
 318
 319     register_savevm ("gus", 0, 2, GUS_save, GUS_load, s);
 320     return 0;
 321 }