• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * QEMU FMOD audio driver
3  *
4  * Copyright (c) 2004-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 <fmod.h>
25 #include <fmod_errors.h>
26 #include "audio.h"
27 
28 #define AUDIO_CAP "fmod"
29 #include "audio_int.h"
30 
31 typedef struct FMODVoiceOut {
32     HWVoiceOut hw;
33     unsigned int old_pos;
34     FSOUND_SAMPLE *fmod_sample;
35     int channel;
36 } FMODVoiceOut;
37 
38 typedef struct FMODVoiceIn {
39     HWVoiceIn hw;
40     FSOUND_SAMPLE *fmod_sample;
41 } FMODVoiceIn;
42 
43 static struct {
44     const char *drvname;
45     int nb_samples;
46     int freq;
47     int nb_channels;
48     int bufsize;
49     int threshold;
50     int broken_adc;
51 } conf = {
52     NULL,
53     2048 * 2,
54     44100,
55     2,
56     0,
57     0,
58     0
59 };
60 
fmod_logerr(const char * fmt,...)61 static void GCC_FMT_ATTR (1, 2) fmod_logerr (const char *fmt, ...)
62 {
63     va_list ap;
64 
65     va_start (ap, fmt);
66     AUD_vlog (AUDIO_CAP, fmt, ap);
67     va_end (ap);
68 
69     AUD_log (AUDIO_CAP, "Reason: %s\n",
70              FMOD_ErrorString (FSOUND_GetError ()));
71 }
72 
fmod_logerr2(const char * typ,const char * fmt,...)73 static void GCC_FMT_ATTR (2, 3) fmod_logerr2 (
74     const char *typ,
75     const char *fmt,
76     ...
77     )
78 {
79     va_list ap;
80 
81     AUD_log (AUDIO_CAP, "Could not initialize %s\n", typ);
82 
83     va_start (ap, fmt);
84     AUD_vlog (AUDIO_CAP, fmt, ap);
85     va_end (ap);
86 
87     AUD_log (AUDIO_CAP, "Reason: %s\n",
88              FMOD_ErrorString (FSOUND_GetError ()));
89 }
90 
fmod_write(SWVoiceOut * sw,void * buf,int len)91 static int fmod_write (SWVoiceOut *sw, void *buf, int len)
92 {
93     return audio_pcm_sw_write (sw, buf, len);
94 }
95 
fmod_clear_sample(FMODVoiceOut * fmd)96 static void fmod_clear_sample (FMODVoiceOut *fmd)
97 {
98     HWVoiceOut *hw = &fmd->hw;
99     int status;
100     void *p1 = 0, *p2 = 0;
101     unsigned int len1 = 0, len2 = 0;
102 
103     status = FSOUND_Sample_Lock (
104         fmd->fmod_sample,
105         0,
106         hw->samples << hw->info.shift,
107         &p1,
108         &p2,
109         &len1,
110         &len2
111         );
112 
113     if (!status) {
114         fmod_logerr ("Failed to lock sample\n");
115         return;
116     }
117 
118     if ((len1 & hw->info.align) || (len2 & hw->info.align)) {
119         dolog ("Lock returned misaligned length %d, %d, alignment %d\n",
120                len1, len2, hw->info.align + 1);
121         goto fail;
122     }
123 
124     if ((len1 + len2) - (hw->samples << hw->info.shift)) {
125         dolog ("Lock returned incomplete length %d, %d\n",
126                len1 + len2, hw->samples << hw->info.shift);
127         goto fail;
128     }
129 
130     audio_pcm_info_clear_buf (&hw->info, p1, hw->samples);
131 
132  fail:
133     status = FSOUND_Sample_Unlock (fmd->fmod_sample, p1, p2, len1, len2);
134     if (!status) {
135         fmod_logerr ("Failed to unlock sample\n");
136     }
137 }
138 
fmod_write_sample(HWVoiceOut * hw,uint8_t * dst,int dst_len)139 static void fmod_write_sample (HWVoiceOut *hw, uint8_t *dst, int dst_len)
140 {
141     int src_len1 = dst_len;
142     int src_len2 = 0;
143     int pos = hw->rpos + dst_len;
144     st_sample_t *src1 = hw->mix_buf + hw->rpos;
145     st_sample_t *src2 = NULL;
146 
147     if (pos > hw->samples) {
148         src_len1 = hw->samples - hw->rpos;
149         src2 = hw->mix_buf;
150         src_len2 = dst_len - src_len1;
151         pos = src_len2;
152     }
153 
154     if (src_len1) {
155         hw->clip (dst, src1, src_len1);
156     }
157 
158     if (src_len2) {
159         dst = advance (dst, src_len1 << hw->info.shift);
160         hw->clip (dst, src2, src_len2);
161     }
162 
163     hw->rpos = pos % hw->samples;
164 }
165 
fmod_unlock_sample(FSOUND_SAMPLE * sample,void * p1,void * p2,unsigned int blen1,unsigned int blen2)166 static int fmod_unlock_sample (FSOUND_SAMPLE *sample, void *p1, void *p2,
167                                unsigned int blen1, unsigned int blen2)
168 {
169     int status = FSOUND_Sample_Unlock (sample, p1, p2, blen1, blen2);
170     if (!status) {
171         fmod_logerr ("Failed to unlock sample\n");
172         return -1;
173     }
174     return 0;
175 }
176 
fmod_lock_sample(FSOUND_SAMPLE * sample,struct audio_pcm_info * info,int pos,int len,void ** p1,void ** p2,unsigned int * blen1,unsigned int * blen2)177 static int fmod_lock_sample (
178     FSOUND_SAMPLE *sample,
179     struct audio_pcm_info *info,
180     int pos,
181     int len,
182     void **p1,
183     void **p2,
184     unsigned int *blen1,
185     unsigned int *blen2
186     )
187 {
188     int status;
189 
190     status = FSOUND_Sample_Lock (
191         sample,
192         pos << info->shift,
193         len << info->shift,
194         p1,
195         p2,
196         blen1,
197         blen2
198         );
199 
200     if (!status) {
201         fmod_logerr ("Failed to lock sample\n");
202         return -1;
203     }
204 
205     if ((*blen1 & info->align) || (*blen2 & info->align)) {
206         dolog ("Lock returned misaligned length %d, %d, alignment %d\n",
207                *blen1, *blen2, info->align + 1);
208 
209         fmod_unlock_sample (sample, *p1, *p2, *blen1, *blen2);
210 
211         *p1 = NULL - 1;
212         *p2 = NULL - 1;
213         *blen1 = ~0U;
214         *blen2 = ~0U;
215         return -1;
216     }
217 
218     if (!*p1 && *blen1) {
219         dolog ("warning: !p1 && blen1=%d\n", *blen1);
220         *blen1 = 0;
221     }
222 
223     if (!p2 && *blen2) {
224         dolog ("warning: !p2 && blen2=%d\n", *blen2);
225         *blen2 = 0;
226     }
227 
228     return 0;
229 }
230 
fmod_run_out(HWVoiceOut * hw)231 static int fmod_run_out (HWVoiceOut *hw)
232 {
233     FMODVoiceOut *fmd = (FMODVoiceOut *) hw;
234     int live, decr;
235     void *p1 = 0, *p2 = 0;
236     unsigned int blen1 = 0, blen2 = 0;
237     unsigned int len1 = 0, len2 = 0;
238     int nb_live;
239 
240     live = audio_pcm_hw_get_live_out2 (hw, &nb_live);
241     if (!live) {
242         return 0;
243     }
244 
245     if (!hw->pending_disable
246         && nb_live
247         && (conf.threshold && live <= conf.threshold)) {
248         ldebug ("live=%d nb_live=%d\n", live, nb_live);
249         return 0;
250     }
251 
252     decr = live;
253 
254     if (fmd->channel >= 0) {
255         int len = decr;
256         int old_pos = fmd->old_pos;
257         int ppos = FSOUND_GetCurrentPosition (fmd->channel);
258 
259         if (ppos == old_pos || !ppos) {
260             return 0;
261         }
262 
263         if ((old_pos < ppos) && ((old_pos + len) > ppos)) {
264             len = ppos - old_pos;
265         }
266         else {
267             if ((old_pos > ppos) && ((old_pos + len) > (ppos + hw->samples))) {
268                 len = hw->samples - old_pos + ppos;
269             }
270         }
271         decr = len;
272 
273         if (audio_bug (AUDIO_FUNC, decr < 0)) {
274             dolog ("decr=%d live=%d ppos=%d old_pos=%d len=%d\n",
275                    decr, live, ppos, old_pos, len);
276             return 0;
277         }
278     }
279 
280 
281     if (!decr) {
282         return 0;
283     }
284 
285     if (fmod_lock_sample (fmd->fmod_sample, &fmd->hw.info,
286                           fmd->old_pos, decr,
287                           &p1, &p2,
288                           &blen1, &blen2)) {
289         return 0;
290     }
291 
292     len1 = blen1 >> hw->info.shift;
293     len2 = blen2 >> hw->info.shift;
294     ldebug ("%p %p %d %d %d %d\n", p1, p2, len1, len2, blen1, blen2);
295     decr = len1 + len2;
296 
297     if (p1 && len1) {
298         fmod_write_sample (hw, p1, len1);
299     }
300 
301     if (p2 && len2) {
302         fmod_write_sample (hw, p2, len2);
303     }
304 
305     fmod_unlock_sample (fmd->fmod_sample, p1, p2, blen1, blen2);
306 
307     fmd->old_pos = (fmd->old_pos + decr) % hw->samples;
308     return decr;
309 }
310 
aud_to_fmodfmt(audfmt_e fmt,int stereo)311 static int aud_to_fmodfmt (audfmt_e fmt, int stereo)
312 {
313     int mode = FSOUND_LOOP_NORMAL;
314 
315     switch (fmt) {
316     case AUD_FMT_S8:
317         mode |= FSOUND_SIGNED | FSOUND_8BITS;
318         break;
319 
320     case AUD_FMT_U8:
321         mode |= FSOUND_UNSIGNED | FSOUND_8BITS;
322         break;
323 
324     case AUD_FMT_S16:
325         mode |= FSOUND_SIGNED | FSOUND_16BITS;
326         break;
327 
328     case AUD_FMT_U16:
329         mode |= FSOUND_UNSIGNED | FSOUND_16BITS;
330         break;
331 
332     default:
333         dolog ("Internal logic error: Bad audio format %d\n", fmt);
334 #ifdef DEBUG_FMOD
335         abort ();
336 #endif
337         mode |= FSOUND_8BITS;
338     }
339     mode |= stereo ? FSOUND_STEREO : FSOUND_MONO;
340     return mode;
341 }
342 
fmod_fini_out(HWVoiceOut * hw)343 static void fmod_fini_out (HWVoiceOut *hw)
344 {
345     FMODVoiceOut *fmd = (FMODVoiceOut *) hw;
346 
347     if (fmd->fmod_sample) {
348         FSOUND_Sample_Free (fmd->fmod_sample);
349         fmd->fmod_sample = 0;
350 
351         if (fmd->channel >= 0) {
352             FSOUND_StopSound (fmd->channel);
353         }
354     }
355 }
356 
fmod_init_out(HWVoiceOut * hw,audsettings_t * as)357 static int fmod_init_out (HWVoiceOut *hw, audsettings_t *as)
358 {
359     int bits16, mode, channel;
360     FMODVoiceOut *fmd = (FMODVoiceOut *) hw;
361     audsettings_t obt_as = *as;
362 
363     mode = aud_to_fmodfmt (as->fmt, as->nchannels == 2 ? 1 : 0);
364     fmd->fmod_sample = FSOUND_Sample_Alloc (
365         FSOUND_FREE,            /* index */
366         conf.nb_samples,        /* length */
367         mode,                   /* mode */
368         as->freq,               /* freq */
369         255,                    /* volume */
370         128,                    /* pan */
371         255                     /* priority */
372         );
373 
374     if (!fmd->fmod_sample) {
375         fmod_logerr2 ("DAC", "Failed to allocate FMOD sample\n");
376         return -1;
377     }
378 
379     channel = FSOUND_PlaySoundEx (FSOUND_FREE, fmd->fmod_sample, 0, 1);
380     if (channel < 0) {
381         fmod_logerr2 ("DAC", "Failed to start playing sound\n");
382         FSOUND_Sample_Free (fmd->fmod_sample);
383         return -1;
384     }
385     fmd->channel = channel;
386 
387     /* FMOD always operates on little endian frames? */
388     obt_as.endianness = 0;
389     audio_pcm_init_info (&hw->info, &obt_as);
390     bits16 = (mode & FSOUND_16BITS) != 0;
391     hw->samples = conf.nb_samples;
392     return 0;
393 }
394 
fmod_ctl_out(HWVoiceOut * hw,int cmd,...)395 static int fmod_ctl_out (HWVoiceOut *hw, int cmd, ...)
396 {
397     int status;
398     FMODVoiceOut *fmd = (FMODVoiceOut *) hw;
399 
400     switch (cmd) {
401     case VOICE_ENABLE:
402         fmod_clear_sample (fmd);
403         status = FSOUND_SetPaused (fmd->channel, 0);
404         if (!status) {
405             fmod_logerr ("Failed to resume channel %d\n", fmd->channel);
406         }
407         break;
408 
409     case VOICE_DISABLE:
410         status = FSOUND_SetPaused (fmd->channel, 1);
411         if (!status) {
412             fmod_logerr ("Failed to pause channel %d\n", fmd->channel);
413         }
414         break;
415     }
416     return 0;
417 }
418 
fmod_init_in(HWVoiceIn * hw,audsettings_t * as)419 static int fmod_init_in (HWVoiceIn *hw, audsettings_t *as)
420 {
421     int bits16, mode;
422     FMODVoiceIn *fmd = (FMODVoiceIn *) hw;
423     audsettings_t obt_as = *as;
424 
425     if (conf.broken_adc) {
426         return -1;
427     }
428 
429     mode = aud_to_fmodfmt (as->fmt, as->nchannels == 2 ? 1 : 0);
430     fmd->fmod_sample = FSOUND_Sample_Alloc (
431         FSOUND_FREE,            /* index */
432         conf.nb_samples,        /* length */
433         mode,                   /* mode */
434         as->freq,               /* freq */
435         255,                    /* volume */
436         128,                    /* pan */
437         255                     /* priority */
438         );
439 
440     if (!fmd->fmod_sample) {
441         fmod_logerr2 ("ADC", "Failed to allocate FMOD sample\n");
442         return -1;
443     }
444 
445     /* FMOD always operates on little endian frames? */
446     obt_as.endianness = 0;
447     audio_pcm_init_info (&hw->info, &obt_as);
448     bits16 = (mode & FSOUND_16BITS) != 0;
449     hw->samples = conf.nb_samples;
450     return 0;
451 }
452 
fmod_fini_in(HWVoiceIn * hw)453 static void fmod_fini_in (HWVoiceIn *hw)
454 {
455     FMODVoiceIn *fmd = (FMODVoiceIn *) hw;
456 
457     if (fmd->fmod_sample) {
458         FSOUND_Record_Stop ();
459         FSOUND_Sample_Free (fmd->fmod_sample);
460         fmd->fmod_sample = 0;
461     }
462 }
463 
fmod_run_in(HWVoiceIn * hw)464 static int fmod_run_in (HWVoiceIn *hw)
465 {
466     FMODVoiceIn *fmd = (FMODVoiceIn *) hw;
467     int hwshift = hw->info.shift;
468     int live, dead, new_pos, len;
469     unsigned int blen1 = 0, blen2 = 0;
470     unsigned int len1, len2;
471     unsigned int decr;
472     void *p1, *p2;
473 
474     live = audio_pcm_hw_get_live_in (hw);
475     dead = hw->samples - live;
476     if (!dead) {
477         return 0;
478     }
479 
480     new_pos = FSOUND_Record_GetPosition ();
481     if (new_pos < 0) {
482         fmod_logerr ("Could not get recording position\n");
483         return 0;
484     }
485 
486     len = audio_ring_dist (new_pos,  hw->wpos, hw->samples);
487     if (!len) {
488         return 0;
489     }
490     len = audio_MIN (len, dead);
491 
492     if (fmod_lock_sample (fmd->fmod_sample, &fmd->hw.info,
493                           hw->wpos, len,
494                           &p1, &p2,
495                           &blen1, &blen2)) {
496         return 0;
497     }
498 
499     len1 = blen1 >> hwshift;
500     len2 = blen2 >> hwshift;
501     decr = len1 + len2;
502 
503     if (p1 && blen1) {
504         hw->conv (hw->conv_buf + hw->wpos, p1, len1, &nominal_volume);
505     }
506     if (p2 && len2) {
507         hw->conv (hw->conv_buf, p2, len2, &nominal_volume);
508     }
509 
510     fmod_unlock_sample (fmd->fmod_sample, p1, p2, blen1, blen2);
511     hw->wpos = (hw->wpos + decr) % hw->samples;
512     return decr;
513 }
514 
515 static struct {
516     const char *name;
517     int type;
518 } drvtab[] = {
519     {"none", FSOUND_OUTPUT_NOSOUND},
520 #ifdef _WIN32
521     {"winmm", FSOUND_OUTPUT_WINMM},
522     {"dsound", FSOUND_OUTPUT_DSOUND},
523     {"a3d", FSOUND_OUTPUT_A3D},
524     {"asio", FSOUND_OUTPUT_ASIO},
525 #endif
526 #ifdef __linux__
527     {"oss", FSOUND_OUTPUT_OSS},
528     {"alsa", FSOUND_OUTPUT_ALSA},
529     {"esd", FSOUND_OUTPUT_ESD},
530 #endif
531 #ifdef __APPLE__
532     {"mac", FSOUND_OUTPUT_MAC},
533 #endif
534 #if 0
535     {"xbox", FSOUND_OUTPUT_XBOX},
536     {"ps2", FSOUND_OUTPUT_PS2},
537     {"gcube", FSOUND_OUTPUT_GC},
538 #endif
539     {"none-realtime", FSOUND_OUTPUT_NOSOUND_NONREALTIME}
540 };
541 
fmod_audio_init(void)542 static void *fmod_audio_init (void)
543 {
544     size_t i;
545     double ver;
546     int status;
547     int output_type = -1;
548     const char *drv = conf.drvname;
549 
550     ver = FSOUND_GetVersion ();
551     if (ver < FMOD_VERSION) {
552         dolog ("Wrong FMOD version %f, need at least %f\n", ver, FMOD_VERSION);
553         return NULL;
554     }
555 
556 #ifdef __linux__
557     if (ver < 3.75) {
558         dolog ("FMOD before 3.75 has bug preventing ADC from working\n"
559                "ADC will be disabled.\n");
560         conf.broken_adc = 1;
561     }
562 #endif
563 
564     if (drv) {
565         int found = 0;
566         for (i = 0; i < sizeof (drvtab) / sizeof (drvtab[0]); i++) {
567             if (!strcmp (drv, drvtab[i].name)) {
568                 output_type = drvtab[i].type;
569                 found = 1;
570                 break;
571             }
572         }
573         if (!found) {
574             dolog ("Unknown FMOD driver `%s'\n", drv);
575             dolog ("Valid drivers:\n");
576             for (i = 0; i < sizeof (drvtab) / sizeof (drvtab[0]); i++) {
577                 dolog ("  %s\n", drvtab[i].name);
578             }
579         }
580     }
581 
582     if (output_type != -1) {
583         status = FSOUND_SetOutput (output_type);
584         if (!status) {
585             fmod_logerr ("FSOUND_SetOutput(%d) failed\n", output_type);
586             return NULL;
587         }
588     }
589 
590     if (conf.bufsize) {
591         status = FSOUND_SetBufferSize (conf.bufsize);
592         if (!status) {
593             fmod_logerr ("FSOUND_SetBufferSize (%d) failed\n", conf.bufsize);
594         }
595     }
596 
597     status = FSOUND_Init (conf.freq, conf.nb_channels, 0);
598     if (!status) {
599         fmod_logerr ("FSOUND_Init failed\n");
600         return NULL;
601     }
602 
603     return &conf;
604 }
605 
fmod_read(SWVoiceIn * sw,void * buf,int size)606 static int fmod_read (SWVoiceIn *sw, void *buf, int size)
607 {
608     return audio_pcm_sw_read (sw, buf, size);
609 }
610 
fmod_ctl_in(HWVoiceIn * hw,int cmd,...)611 static int fmod_ctl_in (HWVoiceIn *hw, int cmd, ...)
612 {
613     int status;
614     FMODVoiceIn *fmd = (FMODVoiceIn *) hw;
615 
616     switch (cmd) {
617     case VOICE_ENABLE:
618         status = FSOUND_Record_StartSample (fmd->fmod_sample, 1);
619         if (!status) {
620             fmod_logerr ("Failed to start recording\n");
621         }
622         break;
623 
624     case VOICE_DISABLE:
625         status = FSOUND_Record_Stop ();
626         if (!status) {
627             fmod_logerr ("Failed to stop recording\n");
628         }
629         break;
630     }
631     return 0;
632 }
633 
fmod_audio_fini(void * opaque)634 static void fmod_audio_fini (void *opaque)
635 {
636     (void) opaque;
637     FSOUND_Close ();
638 }
639 
640 static struct audio_option fmod_options[] = {
641     {"DRV", AUD_OPT_STR, &conf.drvname,
642      "FMOD driver", NULL, 0},
643     {"FREQ", AUD_OPT_INT, &conf.freq,
644      "Default frequency", NULL, 0},
645     {"SAMPLES", AUD_OPT_INT, &conf.nb_samples,
646      "Buffer size in samples", NULL, 0},
647     {"CHANNELS", AUD_OPT_INT, &conf.nb_channels,
648      "Number of default channels (1 - mono, 2 - stereo)", NULL, 0},
649     {"BUFSIZE", AUD_OPT_INT, &conf.bufsize,
650      "(undocumented)", NULL, 0},
651 #if 0
652     {"THRESHOLD", AUD_OPT_INT, &conf.threshold,
653      "(undocumented)"},
654 #endif
655 
656     {NULL, 0, NULL, NULL, NULL, 0}
657 };
658 
659 static struct audio_pcm_ops fmod_pcm_ops = {
660     fmod_init_out,
661     fmod_fini_out,
662     fmod_run_out,
663     fmod_write,
664     fmod_ctl_out,
665 
666     fmod_init_in,
667     fmod_fini_in,
668     fmod_run_in,
669     fmod_read,
670     fmod_ctl_in
671 };
672 
673 struct audio_driver fmod_audio_driver = {
674     INIT_FIELD (name           = ) "fmod",
675     INIT_FIELD (descr          = ) "FMOD 3.xx http://www.fmod.org",
676     INIT_FIELD (options        = ) fmod_options,
677     INIT_FIELD (init           = ) fmod_audio_init,
678     INIT_FIELD (fini           = ) fmod_audio_fini,
679     INIT_FIELD (pcm_ops        = ) &fmod_pcm_ops,
680     INIT_FIELD (can_be_default = ) 1,
681     INIT_FIELD (max_voices_out = ) INT_MAX,
682     INIT_FIELD (max_voices_in  = ) INT_MAX,
683     INIT_FIELD (voice_size_out = ) sizeof (FMODVoiceOut),
684     INIT_FIELD (voice_size_in  = ) sizeof (FMODVoiceIn)
685 };
686