shpc: unparent device before free
[qemu/ar7.git] / hw / adlib.c
blobd39cd97384d26e1ca752ab3dc65d739f3b3b9b48
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;
123 s->active = 1;
124 AUD_set_active_out (s->voice, 1);
126 adlib_kill_timers (s);
128 #ifdef HAS_YMF262
129 YMF262Write (0, a, val);
130 #else
131 OPLWrite (s->opl, a, val);
132 #endif
135 static IO_READ_PROTO (adlib_read)
137 AdlibState *s = opaque;
138 uint8_t data;
139 int a = nport & 3;
141 adlib_kill_timers (s);
143 #ifdef HAS_YMF262
144 data = YMF262Read (0, a);
145 #else
146 data = OPLRead (s->opl, a);
147 #endif
148 return data;
151 static void timer_handler (int c, double interval_Sec)
153 AdlibState *s = &glob_adlib;
154 unsigned n = c & 1;
155 #ifdef DEBUG
156 double interval;
157 int64_t exp;
158 #endif
160 if (interval_Sec == 0.0) {
161 s->ticking[n] = 0;
162 return;
165 s->ticking[n] = 1;
166 #ifdef DEBUG
167 interval = get_ticks_per_sec () * interval_Sec;
168 exp = qemu_get_clock_ns (vm_clock) + interval;
169 s->exp[n] = exp;
170 #endif
172 s->dexp[n] = interval_Sec * 1000000.0;
173 AUD_init_time_stamp_out (s->voice, &s->ats);
176 static int write_audio (AdlibState *s, int samples)
178 int net = 0;
179 int pos = s->pos;
181 while (samples) {
182 int nbytes, wbytes, wsampl;
184 nbytes = samples << SHIFT;
185 wbytes = AUD_write (
186 s->voice,
187 s->mixbuf + (pos << (SHIFT - 1)),
188 nbytes
191 if (wbytes) {
192 wsampl = wbytes >> SHIFT;
194 samples -= wsampl;
195 pos = (pos + wsampl) % s->samples;
197 net += wsampl;
199 else {
200 break;
204 return net;
207 static void adlib_callback (void *opaque, int free)
209 AdlibState *s = opaque;
210 int samples, net = 0, to_play, written;
212 samples = free >> SHIFT;
213 if (!(s->active && s->enabled) || !samples) {
214 return;
217 to_play = audio_MIN (s->left, samples);
218 while (to_play) {
219 written = write_audio (s, to_play);
221 if (written) {
222 s->left -= written;
223 samples -= written;
224 to_play -= written;
225 s->pos = (s->pos + written) % s->samples;
227 else {
228 return;
232 samples = audio_MIN (samples, s->samples - s->pos);
233 if (!samples) {
234 return;
237 #ifdef HAS_YMF262
238 YMF262UpdateOneQEMU (0, s->mixbuf + s->pos * 2, samples);
239 #else
240 YM3812UpdateOne (s->opl, s->mixbuf + s->pos, samples);
241 #endif
243 while (samples) {
244 written = write_audio (s, samples);
246 if (written) {
247 net += written;
248 samples -= written;
249 s->pos = (s->pos + written) % s->samples;
251 else {
252 s->left = samples;
253 return;
258 static void Adlib_fini (AdlibState *s)
260 #ifdef HAS_YMF262
261 YMF262Shutdown ();
262 #else
263 if (s->opl) {
264 OPLDestroy (s->opl);
265 s->opl = NULL;
267 #endif
269 if (s->mixbuf) {
270 g_free (s->mixbuf);
273 s->active = 0;
274 s->enabled = 0;
275 AUD_remove_card (&s->card);
278 int Adlib_init (ISABus *bus)
280 AdlibState *s = &glob_adlib;
281 struct audsettings as;
283 #ifdef HAS_YMF262
284 if (YMF262Init (1, 14318180, conf.freq)) {
285 dolog ("YMF262Init %d failed\n", conf.freq);
286 return -1;
288 else {
289 YMF262SetTimerHandler (0, timer_handler, 0);
290 s->enabled = 1;
292 #else
293 s->opl = OPLCreate (OPL_TYPE_YM3812, 3579545, conf.freq);
294 if (!s->opl) {
295 dolog ("OPLCreate %d failed\n", conf.freq);
296 return -1;
298 else {
299 OPLSetTimerHandler (s->opl, timer_handler, 0);
300 s->enabled = 1;
302 #endif
304 as.freq = conf.freq;
305 as.nchannels = SHIFT;
306 as.fmt = AUD_FMT_S16;
307 as.endianness = AUDIO_HOST_ENDIANNESS;
309 AUD_register_card ("adlib", &s->card);
311 s->voice = AUD_open_out (
312 &s->card,
313 s->voice,
314 "adlib",
316 adlib_callback,
319 if (!s->voice) {
320 Adlib_fini (s);
321 return -1;
324 s->samples = AUD_get_buffer_size_out (s->voice) >> SHIFT;
325 s->mixbuf = g_malloc0 (s->samples << SHIFT);
327 register_ioport_read (0x388, 4, 1, adlib_read, s);
328 register_ioport_write (0x388, 4, 1, adlib_write, s);
330 register_ioport_read (conf.port, 4, 1, adlib_read, s);
331 register_ioport_write (conf.port, 4, 1, adlib_write, s);
333 register_ioport_read (conf.port + 8, 2, 1, adlib_read, s);
334 register_ioport_write (conf.port + 8, 2, 1, adlib_write, s);
336 return 0;