1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
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 HOST_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
49typedef struct GUSState {
50 ISADevice dev;
51 GUSEmuState emu;
52 QEMUSoundCard card;
53 uint32_t freq;
54 uint32_t port;
55 int pos, left, shift, irqs;
56 GUSsample *mixbuf;
57 uint8_t himem[1024 * 1024 + 32 + 4096];
58 int samples;
59 SWVoiceOut *voice;
60 int64_t last_ticks;
61 qemu_irq pic;
62} GUSState;
63
64IO_READ_PROTO (gus_readb)
65{
66 GUSState *s = opaque;
67
68 return gus_read (&s->emu, nport, 1);
69}
70
71IO_READ_PROTO (gus_readw)
72{
73 GUSState *s = opaque;
74
75 return gus_read (&s->emu, nport, 2);
76}
77
78IO_WRITE_PROTO (gus_writeb)
79{
80 GUSState *s = opaque;
81
82 gus_write (&s->emu, nport, 1, val);
83}
84
85IO_WRITE_PROTO (gus_writew)
86{
87 GUSState *s = opaque;
88
89 gus_write (&s->emu, nport, 2, val);
90}
91
92static int write_audio (GUSState *s, int samples)
93{
94 int net = 0;
95 int pos = s->pos;
96
97 while (samples) {
98 int nbytes, wbytes, wsampl;
99
100 nbytes = samples << s->shift;
101 wbytes = AUD_write (
102 s->voice,
103 s->mixbuf + (pos << (s->shift - 1)),
104 nbytes
105 );
106
107 if (wbytes) {
108 wsampl = wbytes >> s->shift;
109
110 samples -= wsampl;
111 pos = (pos + wsampl) % s->samples;
112
113 net += wsampl;
114 }
115 else {
116 break;
117 }
118 }
119
120 return net;
121}
122
123static void GUS_callback (void *opaque, int free)
124{
125 int samples, to_play, net = 0;
126 GUSState *s = opaque;
127
128 samples = free >> s->shift;
129 to_play = audio_MIN (samples, s->left);
130
131 while (to_play) {
132 int written = write_audio (s, to_play);
133
134 if (!written) {
135 goto reset;
136 }
137
138 s->left -= written;
139 to_play -= written;
140 samples -= written;
141 net += written;
142 }
143
144 samples = audio_MIN (samples, s->samples);
145 if (samples) {
146 gus_mixvoices (&s->emu, s->freq, samples, s->mixbuf);
147
148 while (samples) {
149 int written = write_audio (s, samples);
150 if (!written) {
151 break;
152 }
153 samples -= written;
154 net += written;
155 }
156 }
157 s->left = samples;
158
159 reset:
160 gus_irqgen (&s->emu, muldiv64 (net, 1000000, s->freq));
161}
162
163int GUS_irqrequest (GUSEmuState *emu, int hwirq, int n)
164{
165 GUSState *s = emu->opaque;
166
167 qemu_irq_raise (s->pic);
168 s->irqs += n;
169 ldebug ("irqrequest %d %d %d\n", hwirq, n, s->irqs);
170 return n;
171}
172
173void GUS_irqclear (GUSEmuState *emu, int hwirq)
174{
175 GUSState *s = emu->opaque;
176 ldebug ("irqclear %d %d\n", hwirq, s->irqs);
177 qemu_irq_lower (s->pic);
178 s->irqs -= 1;
179#ifdef IRQ_STORM
180 if (s->irqs > 0) {
181 qemu_irq_raise (s->pic[hwirq]);
182 }
183#endif
184}
185
186void GUS_dmarequest (GUSEmuState *der)
187{
188
189 ldebug ("dma request %d\n", der->gusdma);
190 DMA_hold_DREQ (der->gusdma);
191}
192
193static int GUS_read_DMA (void *opaque, int nchan, int dma_pos, int dma_len)
194{
195 GUSState *s = opaque;
196 char tmpbuf[4096];
197 int pos = dma_pos, mode, left = dma_len - dma_pos;
198
199 ldebug ("read DMA %#x %d\n", dma_pos, dma_len);
200 mode = DMA_get_channel_mode (s->emu.gusdma);
201 while (left) {
202 int to_copy = audio_MIN ((size_t) left, sizeof (tmpbuf));
203 int copied;
204
205 ldebug ("left=%d to_copy=%d pos=%d\n", left, to_copy, pos);
206 copied = DMA_read_memory (nchan, tmpbuf, pos, to_copy);
207 gus_dma_transferdata (&s->emu, tmpbuf, copied, left == copied);
208 left -= copied;
209 pos += copied;
210 }
211
212 if (0 == ((mode >> 4) & 1)) {
213 DMA_release_DREQ (s->emu.gusdma);
214 }
215 return dma_len;
216}
217
218static const VMStateDescription vmstate_gus = {
219 .name = "gus",
220 .version_id = 2,
221 .minimum_version_id = 2,
222 .minimum_version_id_old = 2,
223 .fields = (VMStateField []) {
224 VMSTATE_INT32(pos, GUSState),
225 VMSTATE_INT32(left, GUSState),
226 VMSTATE_INT32(shift, GUSState),
227 VMSTATE_INT32(irqs, GUSState),
228 VMSTATE_INT32(samples, GUSState),
229 VMSTATE_INT64(last_ticks, GUSState),
230 VMSTATE_BUFFER(himem, GUSState),
231 VMSTATE_END_OF_LIST()
232 }
233};
234
235static const MemoryRegionPortio gus_portio_list1[] = {
236 {0x000, 1, 1, .write = gus_writeb },
237 {0x000, 1, 2, .write = gus_writew },
238 {0x006, 10, 1, .read = gus_readb, .write = gus_writeb },
239 {0x006, 10, 2, .read = gus_readw, .write = gus_writew },
240 {0x100, 8, 1, .read = gus_readb, .write = gus_writeb },
241 {0x100, 8, 2, .read = gus_readw, .write = gus_writew },
242 PORTIO_END_OF_LIST(),
243};
244
245static const MemoryRegionPortio gus_portio_list2[] = {
246 {0, 1, 1, .read = gus_readb },
247 {0, 1, 2, .read = gus_readw },
248 PORTIO_END_OF_LIST(),
249};
250
251static int gus_initfn (ISADevice *dev)
252{
253 GUSState *s = DO_UPCAST (GUSState, dev, dev);
254 struct audsettings as;
255
256 AUD_register_card ("gus", &s->card);
257
258 as.freq = s->freq;
259 as.nchannels = 2;
260 as.fmt = AUD_FMT_S16;
261 as.endianness = GUS_ENDIANNESS;
262
263 s->voice = AUD_open_out (
264 &s->card,
265 NULL,
266 "gus",
267 s,
268 GUS_callback,
269 &as
270 );
271
272 if (!s->voice) {
273 AUD_remove_card (&s->card);
274 return -1;
275 }
276
277 s->shift = 2;
278 s->samples = AUD_get_buffer_size_out (s->voice) >> s->shift;
279 s->mixbuf = g_malloc0 (s->samples << s->shift);
280
281 isa_register_portio_list (dev, s->port, gus_portio_list1, s, "gus");
282 isa_register_portio_list (dev, (s->port + 0x100) & 0xf00,
283 gus_portio_list2, s, "gus");
284
285 DMA_register_channel (s->emu.gusdma, GUS_read_DMA, s);
286 s->emu.himemaddr = s->himem;
287 s->emu.gusdatapos = s->emu.himemaddr + 1024 * 1024 + 32;
288 s->emu.opaque = s;
289 isa_init_irq (dev, &s->pic, s->emu.gusirq);
290
291 AUD_set_active_out (s->voice, 1);
292
293 return 0;
294}
295
296int GUS_init (qemu_irq *pic)
297{
298 isa_create_simple ("gus");
299 return 0;
300}
301
302static ISADeviceInfo gus_info = {
303 .qdev.name = "gus",
304 .qdev.desc = "Gravis Ultrasound GF1",
305 .qdev.size = sizeof (GUSState),
306 .qdev.vmsd = &vmstate_gus,
307 .init = gus_initfn,
308 .qdev.props = (Property[]) {
309 DEFINE_PROP_UINT32 ("freq", GUSState, freq, 44100),
310 DEFINE_PROP_HEX32 ("iobase", GUSState, port, 0x240),
311 DEFINE_PROP_UINT32 ("irq", GUSState, emu.gusirq, 7),
312 DEFINE_PROP_UINT32 ("dma", GUSState, emu.gusdma, 3),
313 DEFINE_PROP_END_OF_LIST (),
314 },
315};
316
317static void gus_register (void)
318{
319 isa_qdev_register (&gus_info);
320}
321device_init (gus_register)
322
