sparc: fix NaN handling
[qemu.git] / hw / adlib.c
blob1d8092baca729615debf6c44510e19e084cceec5
1 /*
2 * QEMU Proxy for OPL2/3 emulation by MAME team
4 * Copyright (c) 2004-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.
25 #include "hw.h"
26 #include "audiodev.h"
27 #include "audio/audio.h"
28 #include "isa.h"
30 //#define DEBUG
32 #define ADLIB_KILL_TIMERS 1
34 #ifdef DEBUG
35 #include "qemu-timer.h"
36 #endif
38 #define dolog(...) AUD_log ("adlib", __VA_ARGS__)
39 #ifdef DEBUG
40 #define ldebug(...) dolog (__VA_ARGS__)
41 #else
42 #define ldebug(...)
43 #endif
45 #ifdef HAS_YMF262
46 #include "ymf262.h"
47 void YMF262UpdateOneQEMU (int which, INT16 *dst, int length);
48 #define SHIFT 2
49 #else
50 #include "fmopl.h"
51 #define SHIFT 1
52 #endif
54 #define IO_READ_PROTO(name) \
55 uint32_t name (void *opaque, uint32_t nport)
56 #define IO_WRITE_PROTO(name) \
57 void name (void *opaque, uint32_t nport, uint32_t val)
59 static struct {
60 int port;
61 int freq;
62 } conf = {0x220, 44100};
64 typedef struct {
65 QEMUSoundCard card;
66 int ticking[2];
67 int enabled;
68 int active;
69 int bufpos;
70 #ifdef DEBUG
71 int64_t exp[2];
72 #endif
73 int16_t *mixbuf;
74 uint64_t dexp[2];
75 SWVoiceOut *voice;
76 int left, pos, samples;
77 QEMUAudioTimeStamp ats;
78 #ifndef HAS_YMF262
79 FM_OPL *opl;
80 #endif
81 } AdlibState;
83 static AdlibState glob_adlib;
85 static void adlib_stop_opl_timer (AdlibState *s, size_t n)
87 #ifdef HAS_YMF262
88 YMF262TimerOver (0, n);
89 #else
90 OPLTimerOver (s->opl, n);
91 #endif
92 s->ticking[n] = 0;
95 static void adlib_kill_timers (AdlibState *s)
97 size_t i;
99 for (i = 0; i < 2; ++i) {
100 if (s->ticking[i]) {
101 uint64_t delta;
103 delta = AUD_get_elapsed_usec_out (s->voice, &s->ats);
104 ldebug (
105 "delta = %f dexp = %f expired => %d\n",
106 delta / 1000000.0,
107 s->dexp[i] / 1000000.0,
108 delta >= s->dexp[i]
110 if (ADLIB_KILL_TIMERS || delta >= s->dexp[i]) {
111 adlib_stop_opl_timer (s, i);
112 AUD_init_time_stamp_out (s->voice, &s->ats);
118 static IO_WRITE_PROTO (adlib_write)
120 AdlibState *s = opaque;
121 int a = nport & 3;
122 int status;
124 s->active = 1;
125 AUD_set_active_out (s->voice, 1);
127 adlib_kill_timers (s);
129 #ifdef HAS_YMF262
130 status = YMF262Write (0, a, val);
131 #else
132 status = OPLWrite (s->opl, a, val);
133 #endif
136 static IO_READ_PROTO (adlib_read)
138 AdlibState *s = opaque;
139 uint8_t data;
140 int a = nport & 3;
142 adlib_kill_timers (s);
144 #ifdef HAS_YMF262
145 data = YMF262Read (0, a);
146 #else
147 data = OPLRead (s->opl, a);
148 #endif
149 return data;
152 static void timer_handler (int c, double interval_Sec)
154 AdlibState *s = &glob_adlib;
155 unsigned n = c & 1;
156 #ifdef DEBUG
157 double interval;
158 int64_t exp;
159 #endif
161 if (interval_Sec == 0.0) {
162 s->ticking[n] = 0;
163 return;
166 s->ticking[n] = 1;
167 #ifdef DEBUG
168 interval = get_ticks_per_sec() * interval_Sec;
169 exp = qemu_get_clock (vm_clock) + interval;
170 s->exp[n] = exp;
171 #endif
173 s->dexp[n] = interval_Sec * 1000000.0;
174 AUD_init_time_stamp_out (s->voice, &s->ats);
177 static int write_audio (AdlibState *s, int samples)
179 int net = 0;
180 int pos = s->pos;
182 while (samples) {
183 int nbytes, wbytes, wsampl;
185 nbytes = samples << SHIFT;
186 wbytes = AUD_write (
187 s->voice,
188 s->mixbuf + (pos << (SHIFT - 1)),
189 nbytes
192 if (wbytes) {
193 wsampl = wbytes >> SHIFT;
195 samples -= wsampl;
196 pos = (pos + wsampl) % s->samples;
198 net += wsampl;
200 else {
201 break;
205 return net;
208 static void adlib_callback (void *opaque, int free)
210 AdlibState *s = opaque;
211 int samples, net = 0, to_play, written;
213 samples = free >> SHIFT;
214 if (!(s->active && s->enabled) || !samples) {
215 return;
218 to_play = audio_MIN (s->left, samples);
219 while (to_play) {
220 written = write_audio (s, to_play);
222 if (written) {
223 s->left -= written;
224 samples -= written;
225 to_play -= written;
226 s->pos = (s->pos + written) % s->samples;
228 else {
229 return;
233 samples = audio_MIN (samples, s->samples - s->pos);
234 if (!samples) {
235 return;
238 #ifdef HAS_YMF262
239 YMF262UpdateOneQEMU (0, s->mixbuf + s->pos * 2, samples);
240 #else
241 YM3812UpdateOne (s->opl, s->mixbuf + s->pos, samples);
242 #endif
244 while (samples) {
245 written = write_audio (s, samples);
247 if (written) {
248 net += written;
249 samples -= written;
250 s->pos = (s->pos + written) % s->samples;
252 else {
253 s->left = samples;
254 return;
259 static void Adlib_fini (AdlibState *s)
261 #ifdef HAS_YMF262
262 YMF262Shutdown ();
263 #else
264 if (s->opl) {
265 OPLDestroy (s->opl);
266 s->opl = NULL;
268 #endif
270 if (s->mixbuf) {
271 qemu_free (s->mixbuf);
274 s->active = 0;
275 s->enabled = 0;
276 AUD_remove_card (&s->card);
279 int Adlib_init (qemu_irq *pic)
281 AdlibState *s = &glob_adlib;
282 struct audsettings as;
284 #ifdef HAS_YMF262
285 if (YMF262Init (1, 14318180, conf.freq)) {
286 dolog ("YMF262Init %d failed\n", conf.freq);
287 return -1;
289 else {
290 YMF262SetTimerHandler (0, timer_handler, 0);
291 s->enabled = 1;
293 #else
294 s->opl = OPLCreate (OPL_TYPE_YM3812, 3579545, conf.freq);
295 if (!s->opl) {
296 dolog ("OPLCreate %d failed\n", conf.freq);
297 return -1;
299 else {
300 OPLSetTimerHandler (s->opl, timer_handler, 0);
301 s->enabled = 1;
303 #endif
305 as.freq = conf.freq;
306 as.nchannels = SHIFT;
307 as.fmt = AUD_FMT_S16;
308 as.endianness = AUDIO_HOST_ENDIANNESS;
310 AUD_register_card ("adlib", &s->card);
312 s->voice = AUD_open_out (
313 &s->card,
314 s->voice,
315 "adlib",
317 adlib_callback,
320 if (!s->voice) {
321 Adlib_fini (s);
322 return -1;
325 s->samples = AUD_get_buffer_size_out (s->voice) >> SHIFT;
326 s->mixbuf = qemu_mallocz (s->samples << SHIFT);
328 register_ioport_read (0x388, 4, 1, adlib_read, s);
329 register_ioport_write (0x388, 4, 1, adlib_write, s);
331 register_ioport_read (conf.port, 4, 1, adlib_read, s);
332 register_ioport_write (conf.port, 4, 1, adlib_write, s);
334 register_ioport_read (conf.port + 8, 2, 1, adlib_read, s);
335 register_ioport_write (conf.port + 8, 2, 1, adlib_write, s);
337 return 0;