MINI2440: Code cleanup
[qemu/mini2440.git] / hw / gus.c
blob070aa99a3bb997efabeaeea19b8196436078c328
1 /*
2 * QEMU Proxy for Gravis Ultrasound GF1 emulation by Tibor "TS" Schütz
4 * Copyright (c) 2002-2005 Vassili Karpov (malc)
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:
13 * The above copyright notice and this permission notice shall be included in
14 * all copies or substantial portions of the Software.
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.
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"
31 #define dolog(...) AUD_log ("audio", __VA_ARGS__)
32 #ifdef DEBUG
33 #define ldebug(...) dolog (__VA_ARGS__)
34 #else
35 #define ldebug(...)
36 #endif
38 #ifdef WORDS_BIGENDIAN
39 #define GUS_ENDIANNESS 1
40 #else
41 #define GUS_ENDIANNESS 0
42 #endif
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)
49 static struct {
50 int port;
51 int irq;
52 int dma;
53 int freq;
54 } conf = {0x240, 7, 3, 44100};
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;
69 IO_READ_PROTO (gus_readb)
71 GUSState *s = opaque;
73 return gus_read (&s->emu, nport, 1);
76 IO_READ_PROTO (gus_readw)
78 GUSState *s = opaque;
80 return gus_read (&s->emu, nport, 2);
83 IO_WRITE_PROTO (gus_writeb)
85 GUSState *s = opaque;
87 gus_write (&s->emu, nport, 1, val);
90 IO_WRITE_PROTO (gus_writew)
92 GUSState *s = opaque;
94 gus_write (&s->emu, nport, 2, val);
97 static int write_audio (GUSState *s, int samples)
99 int net = 0;
100 int pos = s->pos;
102 while (samples) {
103 int nbytes, wbytes, wsampl;
105 nbytes = samples << s->shift;
106 wbytes = AUD_write (
107 s->voice,
108 s->mixbuf + (pos << (s->shift - 1)),
109 nbytes
112 if (wbytes) {
113 wsampl = wbytes >> s->shift;
115 samples -= wsampl;
116 pos = (pos + wsampl) % s->samples;
118 net += wsampl;
120 else {
121 break;
125 return net;
128 static void GUS_callback (void *opaque, int free)
130 int samples, to_play, net = 0;
131 GUSState *s = opaque;
133 samples = free >> s->shift;
134 to_play = audio_MIN (samples, s->left);
136 while (to_play) {
137 int written = write_audio (s, to_play);
139 if (!written) {
140 goto reset;
143 s->left -= written;
144 to_play -= written;
145 samples -= written;
146 net += written;
149 samples = audio_MIN (samples, s->samples);
150 if (samples) {
151 gus_mixvoices (&s->emu, s->freq, samples, s->mixbuf);
153 while (samples) {
154 int written = write_audio (s, samples);
155 if (!written) {
156 break;
158 samples -= written;
159 net += written;
162 s->left = samples;
164 reset:
165 gus_irqgen (&s->emu, (double) (net * 1000000) / s->freq);
168 int GUS_irqrequest (GUSEmuState *emu, int hwirq, int n)
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;
178 void GUS_irqclear (GUSEmuState *emu, int hwirq)
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]);
188 #endif
191 void GUS_dmarequest (GUSEmuState *der)
193 /* GUSState *s = (GUSState *) der; */
194 ldebug ("dma request %d\n", der->gusdma);
195 DMA_hold_DREQ (der->gusdma);
198 static int GUS_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
200 GUSState *s = opaque;
201 char tmpbuf[4096];
202 int pos = dma_pos, mode, left = dma_len - dma_pos;
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;
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;
217 if (0 == ((mode >> 4) & 1)) {
218 DMA_release_DREQ (s->emu.gusdma);
220 return dma_len;
223 static void GUS_save (QEMUFile *f, void *opaque)
225 GUSState *s = opaque;
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));
236 static int GUS_load (QEMUFile *f, void *opaque, int version_id)
238 GUSState *s = opaque;
240 if (version_id != 2)
241 return -EINVAL;
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;
253 int GUS_init (AudioState *audio, qemu_irq *pic)
255 GUSState *s;
256 struct audsettings as;
258 if (!audio) {
259 dolog ("No audio state\n");
260 return -1;
263 s = qemu_mallocz (sizeof (*s));
265 AUD_register_card (audio, "gus", &s->card);
267 as.freq = conf.freq;
268 as.nchannels = 2;
269 as.fmt = AUD_FMT_S16;
270 as.endianness = GUS_ENDIANNESS;
272 s->voice = AUD_open_out (
273 &s->card,
274 NULL,
275 "gus",
277 GUS_callback,
281 if (!s->voice) {
282 AUD_remove_card (&s->card);
283 qemu_free (s);
284 return -1;
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);
291 register_ioport_write (conf.port, 1, 1, gus_writeb, s);
292 register_ioport_write (conf.port, 1, 2, gus_writew, s);
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);
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);
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);
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;
317 AUD_set_active_out (s->voice, 1);
319 register_savevm ("gus", 0, 2, GUS_save, GUS_load, s);
320 return 0;