audio.c 47.8 KB
Newer Older
bellard's avatar
bellard committed
1 2
/*
 * QEMU Audio subsystem
3 4 5
 *
 * Copyright (c) 2003-2005 Vassili Karpov (malc)
 *
bellard's avatar
bellard committed
6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25
 * Permission is hereby granted, free of charge, to any person obtaining a copy
 * of this software and associated documentation files (the "Software"), to deal
 * in the Software without restriction, including without limitation the rights
 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
 * copies of the Software, and to permit persons to whom the Software is
 * furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
 * THE SOFTWARE.
 */
#include "vl.h"

26 27
#define AUDIO_CAP "audio"
#include "audio_int.h"
bellard's avatar
bellard committed
28

29 30 31
/* #define DEBUG_PLIVE */
/* #define DEBUG_LIVE */
/* #define DEBUG_OUT */
32
/* #define DEBUG_CAPTURE */
bellard's avatar
bellard committed
33

bellard's avatar
bellard committed
34 35
#define SW_NAME(sw) (sw)->name ? (sw)->name : "unknown"

36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57
static struct audio_driver *drvtab[] = {
#ifdef CONFIG_OSS
    &oss_audio_driver,
#endif
#ifdef CONFIG_ALSA
    &alsa_audio_driver,
#endif
#ifdef CONFIG_COREAUDIO
    &coreaudio_audio_driver,
#endif
#ifdef CONFIG_DSOUND
    &dsound_audio_driver,
#endif
#ifdef CONFIG_FMOD
    &fmod_audio_driver,
#endif
#ifdef CONFIG_SDL
    &sdl_audio_driver,
#endif
    &no_audio_driver,
    &wav_audio_driver
};
bellard's avatar
bellard committed
58

bellard's avatar
bellard committed
59 60 61 62 63 64 65 66 67 68 69 70 71 72 73
struct fixed_settings {
    int enabled;
    int nb_voices;
    int greedy;
    audsettings_t settings;
};

static struct {
    struct fixed_settings fixed_out;
    struct fixed_settings fixed_in;
    union {
        int hz;
        int64_t ticks;
    } period;
    int plive;
bellard's avatar
bellard committed
74
    int log_to_monitor;
bellard's avatar
bellard committed
75 76 77 78 79 80 81 82
} conf = {
    {                           /* DAC fixed settings */
        1,                      /* enabled */
        1,                      /* nb_voices */
        1,                      /* greedy */
        {
            44100,              /* freq */
            2,                  /* nchannels */
83 84
            AUD_FMT_S16,        /* fmt */
            AUDIO_HOST_ENDIANNESS
bellard's avatar
bellard committed
85 86 87 88 89 90 91 92 93 94
        }
    },

    {                           /* ADC fixed settings */
        1,                      /* enabled */
        1,                      /* nb_voices */
        1,                      /* greedy */
        {
            44100,              /* freq */
            2,                  /* nchannels */
95 96
            AUD_FMT_S16,        /* fmt */
            AUDIO_HOST_ENDIANNESS
bellard's avatar
bellard committed
97 98 99
        }
    },

100
    { 0 },                      /* period */
bellard's avatar
bellard committed
101
    0,                          /* plive */
bellard's avatar
bellard committed
102
    0                           /* log_to_monitor */
103 104
};

bellard's avatar
bellard committed
105 106
static AudioState glob_audio_state;

107 108 109 110 111 112 113 114 115
volume_t nominal_volume = {
    0,
#ifdef FLOAT_MIXENG
    1.0,
    1.0
#else
    UINT_MAX,
    UINT_MAX
#endif
bellard's avatar
bellard committed
116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134
};

/* http://www.df.lth.se/~john_e/gems/gem002d.html */
/* http://www.multi-platforms.com/Tips/PopCount.htm */
uint32_t popcount (uint32_t u)
{
    u = ((u&0x55555555) + ((u>>1)&0x55555555));
    u = ((u&0x33333333) + ((u>>2)&0x33333333));
    u = ((u&0x0f0f0f0f) + ((u>>4)&0x0f0f0f0f));
    u = ((u&0x00ff00ff) + ((u>>8)&0x00ff00ff));
    u = ( u&0x0000ffff) + (u>>16);
    return u;
}

inline uint32_t lsbindex (uint32_t u)
{
    return popcount ((u&-u)-1);
}

135 136 137 138
#ifdef AUDIO_IS_FLAWLESS_AND_NO_CHECKS_ARE_REQURIED
#error No its not
#else
int audio_bug (const char *funcname, int cond)
bellard's avatar
bellard committed
139
{
140 141 142
    if (cond) {
        static int shown;

143
        AUD_log (NULL, "A bug was just triggered in %s\n", funcname);
144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164
        if (!shown) {
            shown = 1;
            AUD_log (NULL, "Save all your work and restart without audio\n");
            AUD_log (NULL, "Please send bug report to malc@pulsesoft.com\n");
            AUD_log (NULL, "I am sorry\n");
        }
        AUD_log (NULL, "Context:\n");

#if defined AUDIO_BREAKPOINT_ON_BUG
#  if defined HOST_I386
#    if defined __GNUC__
        __asm__ ("int3");
#    elif defined _MSC_VER
        _asm _emit 0xcc;
#    else
        abort ();
#    endif
#  else
        abort ();
#  endif
#endif
bellard's avatar
bellard committed
165 166
    }

167
    return cond;
bellard's avatar
bellard committed
168
}
169
#endif
bellard's avatar
bellard committed
170

171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189
static inline int audio_bits_to_index (int bits)
{
    switch (bits) {
    case 8:
        return 0;

    case 16:
        return 1;

    case 32:
        return 2;

    default:
        audio_bug ("bits_to_index", 1);
        AUD_log (NULL, "invalid bits %d\n", bits);
        return 0;
    }
}

bellard's avatar
bellard committed
190 191 192 193 194 195 196 197 198 199 200 201 202
void *audio_calloc (const char *funcname, int nmemb, size_t size)
{
    int cond;
    size_t len;

    len = nmemb * size;
    cond = !nmemb || !size;
    cond |= nmemb < 0;
    cond |= len < size;

    if (audio_bug ("audio_calloc", cond)) {
        AUD_log (NULL, "%s passed invalid arguments to audio_calloc\n",
                 funcname);
bellard's avatar
bellard committed
203
        AUD_log (NULL, "nmemb=%d size=%zu (len=%zu)\n", nmemb, size, len);
bellard's avatar
bellard committed
204 205 206 207 208 209
        return NULL;
    }

    return qemu_mallocz (len);
}

210
static char *audio_alloc_prefix (const char *s)
bellard's avatar
bellard committed
211
{
212 213 214
    const char qemu_prefix[] = "QEMU_";
    size_t len;
    char *r;
bellard's avatar
bellard committed
215

216 217 218
    if (!s) {
        return NULL;
    }
bellard's avatar
bellard committed
219

220 221
    len = strlen (s);
    r = qemu_malloc (len + sizeof (qemu_prefix));
bellard's avatar
bellard committed
222

223 224 225
    if (r) {
        size_t i;
        char *u = r + sizeof (qemu_prefix) - 1;
bellard's avatar
bellard committed
226

227 228 229 230 231 232
        strcpy (r, qemu_prefix);
        strcat (r, s);

        for (i = 0; i < len; ++i) {
            u[i] = toupper (u[i]);
        }
bellard's avatar
bellard committed
233
    }
234
    return r;
bellard's avatar
bellard committed
235 236
}

237
const char *audio_audfmt_to_string (audfmt_e fmt)
bellard's avatar
bellard committed
238
{
239 240 241
    switch (fmt) {
    case AUD_FMT_U8:
        return "U8";
bellard's avatar
bellard committed
242

243 244
    case AUD_FMT_U16:
        return "U16";
bellard's avatar
bellard committed
245 246

    case AUD_FMT_S8:
247
        return "S8";
bellard's avatar
bellard committed
248 249

    case AUD_FMT_S16:
250
        return "S16";
251 252 253 254 255 256

    case AUD_FMT_U32:
        return "U32";

    case AUD_FMT_S32:
        return "S32";
bellard's avatar
bellard committed
257 258
    }

259 260
    dolog ("Bogus audfmt %d returning S16\n", fmt);
    return "S16";
bellard's avatar
bellard committed
261 262
}

263
audfmt_e audio_string_to_audfmt (const char *s, audfmt_e defval, int *defaultp)
bellard's avatar
bellard committed
264
{
265 266 267 268 269 270 271 272
    if (!strcasecmp (s, "u8")) {
        *defaultp = 0;
        return AUD_FMT_U8;
    }
    else if (!strcasecmp (s, "u16")) {
        *defaultp = 0;
        return AUD_FMT_U16;
    }
273 274 275 276
    else if (!strcasecmp (s, "u32")) {
        *defaultp = 0;
        return AUD_FMT_U32;
    }
277 278 279 280 281 282 283 284
    else if (!strcasecmp (s, "s8")) {
        *defaultp = 0;
        return AUD_FMT_S8;
    }
    else if (!strcasecmp (s, "s16")) {
        *defaultp = 0;
        return AUD_FMT_S16;
    }
285 286 287 288
    else if (!strcasecmp (s, "s32")) {
        *defaultp = 0;
        return AUD_FMT_S32;
    }
289 290 291 292 293 294
    else {
        dolog ("Bogus audio format `%s' using %s\n",
               s, audio_audfmt_to_string (defval));
        *defaultp = 1;
        return defval;
    }
bellard's avatar
bellard committed
295 296
}

297 298 299
static audfmt_e audio_get_conf_fmt (const char *envname,
                                    audfmt_e defval,
                                    int *defaultp)
bellard's avatar
bellard committed
300
{
301 302 303 304
    const char *var = getenv (envname);
    if (!var) {
        *defaultp = 1;
        return defval;
bellard's avatar
bellard committed
305
    }
306
    return audio_string_to_audfmt (var, defval, defaultp);
bellard's avatar
bellard committed
307 308
}

309
static int audio_get_conf_int (const char *key, int defval, int *defaultp)
bellard's avatar
bellard committed
310
{
311 312
    int val;
    char *strval;
bellard's avatar
bellard committed
313

314 315 316 317 318 319 320 321 322 323
    strval = getenv (key);
    if (strval) {
        *defaultp = 0;
        val = atoi (strval);
        return val;
    }
    else {
        *defaultp = 1;
        return defval;
    }
bellard's avatar
bellard committed
324 325
}

326 327 328
static const char *audio_get_conf_str (const char *key,
                                       const char *defval,
                                       int *defaultp)
bellard's avatar
bellard committed
329
{
330 331 332 333 334 335 336 337
    const char *val = getenv (key);
    if (!val) {
        *defaultp = 1;
        return defval;
    }
    else {
        *defaultp = 0;
        return val;
bellard's avatar
bellard committed
338 339 340
    }
}

bellard's avatar
bellard committed
341
void AUD_vlog (const char *cap, const char *fmt, va_list ap)
bellard's avatar
bellard committed
342
{
bellard's avatar
bellard committed
343 344 345 346 347 348 349 350 351 352 353 354 355
    if (conf.log_to_monitor) {
        if (cap) {
            term_printf ("%s: ", cap);
        }

        term_vprintf (fmt, ap);
    }
    else {
        if (cap) {
            fprintf (stderr, "%s: ", cap);
        }

        vfprintf (stderr, fmt, ap);
bellard's avatar
bellard committed
356 357 358
    }
}

bellard's avatar
bellard committed
359
void AUD_log (const char *cap, const char *fmt, ...)
bellard's avatar
bellard committed
360
{
bellard's avatar
bellard committed
361 362 363 364 365
    va_list ap;

    va_start (ap, fmt);
    AUD_vlog (cap, fmt, ap);
    va_end (ap);
bellard's avatar
bellard committed
366 367
}

368 369
static void audio_print_options (const char *prefix,
                                 struct audio_option *opt)
bellard's avatar
bellard committed
370
{
371 372 373 374 375 376 377 378 379
    char *uprefix;

    if (!prefix) {
        dolog ("No prefix specified\n");
        return;
    }

    if (!opt) {
        dolog ("No options\n");
bellard's avatar
bellard committed
380
        return;
381
    }
bellard's avatar
bellard committed
382

383
    uprefix = audio_alloc_prefix (prefix);
bellard's avatar
bellard committed
384

385 386 387
    for (; opt->name; opt++) {
        const char *state = "default";
        printf ("  %s_%s: ", uprefix, opt->name);
bellard's avatar
bellard committed
388

389 390 391
        if (opt->overridenp && *opt->overridenp) {
            state = "current";
        }
bellard's avatar
bellard committed
392

393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424
        switch (opt->tag) {
        case AUD_OPT_BOOL:
            {
                int *intp = opt->valp;
                printf ("boolean, %s = %d\n", state, *intp ? 1 : 0);
            }
            break;

        case AUD_OPT_INT:
            {
                int *intp = opt->valp;
                printf ("integer, %s = %d\n", state, *intp);
            }
            break;

        case AUD_OPT_FMT:
            {
                audfmt_e *fmtp = opt->valp;
                printf (
                    "format, %s = %s, (one of: U8 S8 U16 S16)\n",
                    state,
                    audio_audfmt_to_string (*fmtp)
                    );
            }
            break;

        case AUD_OPT_STR:
            {
                const char **strp = opt->valp;
                printf ("string, %s = %s\n",
                        state,
                        *strp ? *strp : "(not set)");
bellard's avatar
bellard committed
425
            }
426 427 428 429 430 431 432
            break;

        default:
            printf ("???\n");
            dolog ("Bad value tag for option %s_%s %d\n",
                   uprefix, opt->name, opt->tag);
            break;
bellard's avatar
bellard committed
433
        }
434
        printf ("    %s\n", opt->descr);
bellard's avatar
bellard committed
435
    }
436 437

    qemu_free (uprefix);
bellard's avatar
bellard committed
438 439
}

440 441
static void audio_process_options (const char *prefix,
                                   struct audio_option *opt)
bellard's avatar
bellard committed
442
{
443 444 445
    char *optname;
    const char qemu_prefix[] = "QEMU_";
    size_t preflen;
bellard's avatar
bellard committed
446

447 448 449 450
    if (audio_bug (AUDIO_FUNC, !prefix)) {
        dolog ("prefix = NULL\n");
        return;
    }
bellard's avatar
bellard committed
451

452 453 454
    if (audio_bug (AUDIO_FUNC, !opt)) {
        dolog ("opt = NULL\n");
        return;
bellard's avatar
bellard committed
455 456
    }

457
    preflen = strlen (prefix);
bellard's avatar
bellard committed
458

459 460 461 462 463 464 465 466 467 468 469
    for (; opt->name; opt++) {
        size_t len, i;
        int def;

        if (!opt->valp) {
            dolog ("Option value pointer for `%s' is not set\n",
                   opt->name);
            continue;
        }

        len = strlen (opt->name);
bellard's avatar
bellard committed
470 471 472
        /* len of opt->name + len of prefix + size of qemu_prefix
         * (includes trailing zero) + zero + underscore (on behalf of
         * sizeof) */
473 474
        optname = qemu_malloc (len + preflen + sizeof (qemu_prefix) + 1);
        if (!optname) {
bellard's avatar
bellard committed
475
            dolog ("Could not allocate memory for option name `%s'\n",
476 477 478 479 480
                   opt->name);
            continue;
        }

        strcpy (optname, qemu_prefix);
bellard's avatar
bellard committed
481 482

        /* copy while upper-casing, including trailing zero */
483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508 509 510 511 512 513 514 515
        for (i = 0; i <= preflen; ++i) {
            optname[i + sizeof (qemu_prefix) - 1] = toupper (prefix[i]);
        }
        strcat (optname, "_");
        strcat (optname, opt->name);

        def = 1;
        switch (opt->tag) {
        case AUD_OPT_BOOL:
        case AUD_OPT_INT:
            {
                int *intp = opt->valp;
                *intp = audio_get_conf_int (optname, *intp, &def);
            }
            break;

        case AUD_OPT_FMT:
            {
                audfmt_e *fmtp = opt->valp;
                *fmtp = audio_get_conf_fmt (optname, *fmtp, &def);
            }
            break;

        case AUD_OPT_STR:
            {
                const char **strp = opt->valp;
                *strp = audio_get_conf_str (optname, *strp, &def);
            }
            break;

        default:
            dolog ("Bad value tag for option `%s' - %d\n",
                   optname, opt->tag);
bellard's avatar
bellard committed
516 517 518
            break;
        }

519 520 521 522 523 524
        if (!opt->overridenp) {
            opt->overridenp = &opt->overriden;
        }
        *opt->overridenp = !def;
        qemu_free (optname);
    }
bellard's avatar
bellard committed
525 526
}

bellard's avatar
bellard committed
527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547
static void audio_print_settings (audsettings_t *as)
{
    dolog ("frequency=%d nchannels=%d fmt=", as->freq, as->nchannels);

    switch (as->fmt) {
    case AUD_FMT_S8:
        AUD_log (NULL, "S8");
        break;
    case AUD_FMT_U8:
        AUD_log (NULL, "U8");
        break;
    case AUD_FMT_S16:
        AUD_log (NULL, "S16");
        break;
    case AUD_FMT_U16:
        AUD_log (NULL, "U16");
        break;
    default:
        AUD_log (NULL, "invalid(%d)", as->fmt);
        break;
    }
bellard's avatar
bellard committed
548 549

    AUD_log (NULL, " endianness=");
550 551 552 553 554 555 556 557 558 559 560
    switch (as->endianness) {
    case 0:
        AUD_log (NULL, "little");
        break;
    case 1:
        AUD_log (NULL, "big");
        break;
    default:
        AUD_log (NULL, "invalid");
        break;
    }
bellard's avatar
bellard committed
561 562 563
    AUD_log (NULL, "\n");
}

bellard's avatar
bellard committed
564
static int audio_validate_settings (audsettings_t *as)
bellard's avatar
bellard committed
565 566 567 568
{
    int invalid;

    invalid = as->nchannels != 1 && as->nchannels != 2;
569
    invalid |= as->endianness != 0 && as->endianness != 1;
bellard's avatar
bellard committed
570 571 572 573 574 575

    switch (as->fmt) {
    case AUD_FMT_S8:
    case AUD_FMT_U8:
    case AUD_FMT_S16:
    case AUD_FMT_U16:
576 577
    case AUD_FMT_S32:
    case AUD_FMT_U32:
bellard's avatar
bellard committed
578 579 580 581 582 583 584
        break;
    default:
        invalid = 1;
        break;
    }

    invalid |= as->freq <= 0;
585
    return invalid ? -1 : 0;
bellard's avatar
bellard committed
586 587 588
}

static int audio_pcm_info_eq (struct audio_pcm_info *info, audsettings_t *as)
bellard's avatar
bellard committed
589
{
590
    int bits = 8, sign = 0;
bellard's avatar
bellard committed
591

bellard's avatar
bellard committed
592
    switch (as->fmt) {
593 594 595 596 597 598 599 600 601 602
    case AUD_FMT_S8:
        sign = 1;
    case AUD_FMT_U8:
        break;

    case AUD_FMT_S16:
        sign = 1;
    case AUD_FMT_U16:
        bits = 16;
        break;
603 604 605 606 607 608

    case AUD_FMT_S32:
        sign = 1;
    case AUD_FMT_U32:
        bits = 32;
        break;
bellard's avatar
bellard committed
609
    }
bellard's avatar
bellard committed
610 611
    return info->freq == as->freq
        && info->nchannels == as->nchannels
612
        && info->sign == sign
613 614
        && info->bits == bits
        && info->swap_endianness == (as->endianness != AUDIO_HOST_ENDIANNESS);
615
}
bellard's avatar
bellard committed
616

617
void audio_pcm_init_info (struct audio_pcm_info *info, audsettings_t *as)
618
{
619
    int bits = 8, sign = 0, shift = 0;
620

bellard's avatar
bellard committed
621
    switch (as->fmt) {
bellard's avatar
bellard committed
622 623 624 625 626 627 628 629 630
    case AUD_FMT_S8:
        sign = 1;
    case AUD_FMT_U8:
        break;

    case AUD_FMT_S16:
        sign = 1;
    case AUD_FMT_U16:
        bits = 16;
631 632 633 634 635 636 637 638
        shift = 1;
        break;

    case AUD_FMT_S32:
        sign = 1;
    case AUD_FMT_U32:
        bits = 32;
        shift = 2;
bellard's avatar
bellard committed
639 640 641
        break;
    }

bellard's avatar
bellard committed
642
    info->freq = as->freq;
643 644
    info->bits = bits;
    info->sign = sign;
bellard's avatar
bellard committed
645
    info->nchannels = as->nchannels;
646
    info->shift = (as->nchannels == 2) + shift;
647 648
    info->align = (1 << info->shift) - 1;
    info->bytes_per_second = info->freq << info->shift;
649
    info->swap_endianness = (as->endianness != AUDIO_HOST_ENDIANNESS);
bellard's avatar
bellard committed
650 651
}

652
void audio_pcm_info_clear_buf (struct audio_pcm_info *info, void *buf, int len)
bellard's avatar
bellard committed
653
{
654 655 656 657 658
    if (!len) {
        return;
    }

    if (info->sign) {
659
        memset (buf, 0x00, len << info->shift);
bellard's avatar
bellard committed
660 661
    }
    else {
662 663
        switch (info->bits) {
        case 8:
664
            memset (buf, 0x80, len << info->shift);
665
            break;
666

667 668 669 670 671 672 673 674 675 676 677 678 679 680
        case 16:
            {
                int i;
                uint16_t *p = buf;
                int shift = info->nchannels - 1;
                short s = INT16_MAX;

                if (info->swap_endianness) {
                    s = bswap16 (s);
                }

                for (i = 0; i < len << shift; i++) {
                    p[i] = s;
                }
681
            }
682 683 684 685 686 687 688 689 690 691 692 693
            break;

        case 32:
            {
                int i;
                uint32_t *p = buf;
                int shift = info->nchannels - 1;
                int32_t s = INT32_MAX;

                if (info->swap_endianness) {
                    s = bswap32 (s);
                }
694

695 696 697
                for (i = 0; i < len << shift; i++) {
                    p[i] = s;
                }
698
            }
699 700 701 702 703 704
            break;

        default:
            AUD_log (NULL, "audio_pcm_info_clear_buf: invalid bits %d\n",
                     info->bits);
            break;
705
        }
bellard's avatar
bellard committed
706 707 708
    }
}

709 710 711 712 713 714 715 716 717 718 719 720 721 722
/*
 * Capture
 */
static void noop_conv (st_sample_t *dst, const void *src,
                       int samples, volume_t *vol)
{
    (void) src;
    (void) dst;
    (void) samples;
    (void) vol;
}

static CaptureVoiceOut *audio_pcm_capture_find_specific (
    AudioState *s,
723
    audsettings_t *as
724 725 726 727 728
    )
{
    CaptureVoiceOut *cap;

    for (cap = s->cap_head.lh_first; cap; cap = cap->entries.le_next) {
729
        if (audio_pcm_info_eq (&cap->hw.info, as)) {
730 731 732 733 734 735
            return cap;
        }
    }
    return NULL;
}

bellard's avatar
bellard committed
736
static void audio_notify_capture (CaptureVoiceOut *cap, audcnotification_e cmd)
737
{
bellard's avatar
bellard committed
738 739 740 741 742 743 744 745 746
    struct capture_callback *cb;

#ifdef DEBUG_CAPTURE
    dolog ("notification %d sent\n", cmd);
#endif
    for (cb = cap->cb_head.lh_first; cb; cb = cb->entries.le_next) {
        cb->ops.notify (cb->opaque, cmd);
    }
}
747

bellard's avatar
bellard committed
748 749 750 751
static void audio_capture_maybe_changed (CaptureVoiceOut *cap, int enabled)
{
    if (cap->hw.enabled != enabled) {
        audcnotification_e cmd;
752
        cap->hw.enabled = enabled;
bellard's avatar
bellard committed
753 754
        cmd = enabled ? AUD_CNOTIFY_ENABLE : AUD_CNOTIFY_DISABLE;
        audio_notify_capture (cap, cmd);
755 756 757 758 759 760 761 762 763
    }
}

static void audio_recalc_and_notify_capture (CaptureVoiceOut *cap)
{
    HWVoiceOut *hw = &cap->hw;
    SWVoiceOut *sw;
    int enabled = 0;

bellard's avatar
bellard committed
764
    for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
765 766 767 768 769
        if (sw->active) {
            enabled = 1;
            break;
        }
    }
bellard's avatar
bellard committed
770
    audio_capture_maybe_changed (cap, enabled);
771 772 773 774
}

static void audio_detach_capture (HWVoiceOut *hw)
{
bellard's avatar
bellard committed
775 776 777 778 779 780 781
    SWVoiceCap *sc = hw->cap_head.lh_first;

    while (sc) {
        SWVoiceCap *sc1 = sc->entries.le_next;
        SWVoiceOut *sw = &sc->sw;
        CaptureVoiceOut *cap = sc->cap;
        int was_active = sw->active;
782 783 784 785 786 787 788

        if (sw->rate) {
            st_rate_stop (sw->rate);
            sw->rate = NULL;
        }

        LIST_REMOVE (sw, entries);
bellard's avatar
bellard committed
789 790 791 792 793 794 795 796 797
        LIST_REMOVE (sc, entries);
        qemu_free (sc);
        if (was_active) {
            /* We have removed soft voice from the capture:
               this might have changed the overall status of the capture
               since this might have been the only active voice */
            audio_recalc_and_notify_capture (cap);
        }
        sc = sc1;
798 799 800 801 802 803 804 805 806
    }
}

static int audio_attach_capture (AudioState *s, HWVoiceOut *hw)
{
    CaptureVoiceOut *cap;

    audio_detach_capture (hw);
    for (cap = s->cap_head.lh_first; cap; cap = cap->entries.le_next) {
bellard's avatar
bellard committed
807
        SWVoiceCap *sc;
808
        SWVoiceOut *sw;
bellard's avatar
bellard committed
809
        HWVoiceOut *hw_cap = &cap->hw;
810

bellard's avatar
bellard committed
811 812
        sc = audio_calloc (AUDIO_FUNC, 1, sizeof (*sc));
        if (!sc) {
813
            dolog ("Could not allocate soft capture voice (%zu bytes)\n",
bellard's avatar
bellard committed
814
                   sizeof (*sc));
815 816 817
            return -1;
        }

bellard's avatar
bellard committed
818 819
        sc->cap = cap;
        sw = &sc->sw;
820
        sw->hw = hw_cap;
bellard's avatar
bellard committed
821
        sw->info = hw->info;
822 823 824 825 826 827 828 829 830 831 832
        sw->empty = 1;
        sw->active = hw->enabled;
        sw->conv = noop_conv;
        sw->ratio = ((int64_t) hw_cap->info.freq << 32) / sw->info.freq;
        sw->rate = st_rate_start (sw->info.freq, hw_cap->info.freq);
        if (!sw->rate) {
            dolog ("Could not start rate conversion for `%s'\n", SW_NAME (sw));
            qemu_free (sw);
            return -1;
        }
        LIST_INSERT_HEAD (&hw_cap->sw_head, sw, entries);
bellard's avatar
bellard committed
833 834 835 836 837 838
        LIST_INSERT_HEAD (&hw->cap_head, sc, entries);
#ifdef DEBUG_CAPTURE
        asprintf (&sw->name, "for %p %d,%d,%d",
                  hw, sw->info.freq, sw->info.bits, sw->info.nchannels);
        dolog ("Added %s active = %d\n", sw->name, sw->active);
#endif
839
        if (sw->active) {
bellard's avatar
bellard committed
840
            audio_capture_maybe_changed (cap, 1);
841 842 843 844 845
        }
    }
    return 0;
}

846 847 848
/*
 * Hard voice (capture)
 */
bellard's avatar
bellard committed
849
static int audio_pcm_hw_find_min_in (HWVoiceIn *hw)
bellard's avatar
bellard committed
850
{
851 852 853 854 855 856 857
    SWVoiceIn *sw;
    int m = hw->total_samples_captured;

    for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
        if (sw->active) {
            m = audio_MIN (m, sw->total_hw_samples_acquired);
        }
bellard's avatar
bellard committed
858
    }
859
    return m;
bellard's avatar
bellard committed
860 861
}

862
int audio_pcm_hw_get_live_in (HWVoiceIn *hw)
bellard's avatar
bellard committed
863
{
864 865 866 867
    int live = hw->total_samples_captured - audio_pcm_hw_find_min_in (hw);
    if (audio_bug (AUDIO_FUNC, live < 0 || live > hw->samples)) {
        dolog ("live=%d hw->samples=%d\n", live, hw->samples);
        return 0;
bellard's avatar
bellard committed
868
    }
869
    return live;
bellard's avatar
bellard committed
870 871
}

872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888
/*
 * Soft voice (capture)
 */
static int audio_pcm_sw_get_rpos_in (SWVoiceIn *sw)
{
    HWVoiceIn *hw = sw->hw;
    int live = hw->total_samples_captured - sw->total_hw_samples_acquired;
    int rpos;

    if (audio_bug (AUDIO_FUNC, live < 0 || live > hw->samples)) {
        dolog ("live=%d hw->samples=%d\n", live, hw->samples);
        return 0;
    }

    rpos = hw->wpos - live;
    if (rpos >= 0) {
        return rpos;
bellard's avatar
bellard committed
889 890
    }
    else {
891
        return hw->samples + rpos;
bellard's avatar
bellard committed
892 893 894
    }
}

895
int audio_pcm_sw_read (SWVoiceIn *sw, void *buf, int size)
bellard's avatar
bellard committed
896
{
897 898
    HWVoiceIn *hw = sw->hw;
    int samples, live, ret = 0, swlim, isamp, osamp, rpos, total = 0;
bellard's avatar
bellard committed
899
    st_sample_t *src, *dst = sw->buf;
900 901 902 903 904 905 906 907 908 909 910 911 912

    rpos = audio_pcm_sw_get_rpos_in (sw) % hw->samples;

    live = hw->total_samples_captured - sw->total_hw_samples_acquired;
    if (audio_bug (AUDIO_FUNC, live < 0 || live > hw->samples)) {
        dolog ("live_in=%d hw->samples=%d\n", live, hw->samples);
        return 0;
    }

    samples = size >> sw->info.shift;
    if (!live) {
        return 0;
    }
bellard's avatar
bellard committed
913

914 915
    swlim = (live * sw->ratio) >> 32;
    swlim = audio_MIN (swlim, samples);
bellard's avatar
bellard committed
916

917 918 919 920 921 922 923
    while (swlim) {
        src = hw->conv_buf + rpos;
        isamp = hw->wpos - rpos;
        /* XXX: <= ? */
        if (isamp <= 0) {
            isamp = hw->samples - rpos;
        }
bellard's avatar
bellard committed
924

925 926 927 928
        if (!isamp) {
            break;
        }
        osamp = swlim;
bellard's avatar
bellard committed
929

930 931
        if (audio_bug (AUDIO_FUNC, osamp < 0)) {
            dolog ("osamp=%d\n", osamp);
bellard's avatar
bellard committed
932
            return 0;
933
        }
bellard's avatar
bellard committed
934

935 936 937 938 939 940 941
        st_rate_flow (sw->rate, src, dst, &isamp, &osamp);
        swlim -= osamp;
        rpos = (rpos + isamp) % hw->samples;
        dst += osamp;
        ret += osamp;
        total += isamp;
    }
bellard's avatar
bellard committed
942

bellard's avatar
bellard committed
943
    sw->clip (buf, sw->buf, ret);
944 945
    sw->total_hw_samples_acquired += total;
    return ret << sw->info.shift;
bellard's avatar
bellard committed
946 947
}

948 949 950
/*
 * Hard voice (playback)
 */
bellard's avatar
bellard committed
951
static int audio_pcm_hw_find_min_out (HWVoiceOut *hw, int *nb_livep)
952
{
bellard's avatar
bellard committed
953 954 955
    SWVoiceOut *sw;
    int m = INT_MAX;
    int nb_live = 0;
bellard's avatar
bellard committed
956

bellard's avatar
bellard committed
957 958 959 960 961
    for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
        if (sw->active || !sw->empty) {
            m = audio_MIN (m, sw->total_hw_samples_mixed);
            nb_live += 1;
        }
bellard's avatar
bellard committed
962
    }
bellard's avatar
bellard committed
963 964 965

    *nb_livep = nb_live;
    return m;
966
}
bellard's avatar
bellard committed
967

968 969 970
int audio_pcm_hw_get_live_out2 (HWVoiceOut *hw, int *nb_live)
{
    int smin;
bellard's avatar
bellard committed
971

972 973 974 975
    smin = audio_pcm_hw_find_min_out (hw, nb_live);

    if (!*nb_live) {
        return 0;
bellard's avatar
bellard committed
976 977
    }
    else {
978 979 980 981 982
        int live = smin;

        if (audio_bug (AUDIO_FUNC, live < 0 || live > hw->samples)) {
            dolog ("live=%d hw->samples=%d\n", live, hw->samples);
            return 0;
bellard's avatar
bellard committed
983
        }
984
        return live;
bellard's avatar
bellard committed
985
    }
986 987 988 989 990 991
}

int audio_pcm_hw_get_live_out (HWVoiceOut *hw)
{
    int nb_live;
    int live;
bellard's avatar
bellard committed
992

993 994 995 996
    live = audio_pcm_hw_get_live_out2 (hw, &nb_live);
    if (audio_bug (AUDIO_FUNC, live < 0 || live > hw->samples)) {
        dolog ("live=%d hw->samples=%d\n", live, hw->samples);
        return 0;
bellard's avatar
bellard committed
997
    }
998
    return live;
bellard's avatar
bellard committed
999 1000
}

1001 1002 1003 1004
/*
 * Soft voice (playback)
 */
int audio_pcm_sw_write (SWVoiceOut *sw, void *buf, int size)
bellard's avatar
bellard committed
1005
{
1006 1007
    int hwsamples, samples, isamp, osamp, wpos, live, dead, left, swlim, blck;
    int ret = 0, pos = 0, total = 0;
bellard's avatar
bellard committed
1008

1009 1010 1011
    if (!sw) {
        return size;
    }
bellard's avatar
bellard committed
1012

1013
    hwsamples = sw->hw->samples;
bellard's avatar
bellard committed
1014

1015 1016 1017 1018 1019
    live = sw->total_hw_samples_mixed;
    if (audio_bug (AUDIO_FUNC, live < 0 || live > hwsamples)){
        dolog ("live=%d hw->samples=%d\n", live, hwsamples);
        return 0;
    }
bellard's avatar
bellard committed
1020

1021
    if (live == hwsamples) {
bellard's avatar
bellard committed
1022 1023 1024
#ifdef DEBUG_OUT
        dolog ("%s is full %d\n", sw->name, live);
#endif
1025 1026
        return 0;
    }
bellard's avatar
bellard committed
1027

1028 1029
    wpos = (sw->hw->rpos + live) % hwsamples;
    samples = size >> sw->info.shift;
bellard's avatar
bellard committed
1030

1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066
    dead = hwsamples - live;
    swlim = ((int64_t) dead << 32) / sw->ratio;
    swlim = audio_MIN (swlim, samples);
    if (swlim) {
        sw->conv (sw->buf, buf, swlim, &sw->vol);
    }

    while (swlim) {
        dead = hwsamples - live;
        left = hwsamples - wpos;
        blck = audio_MIN (dead, left);
        if (!blck) {
            break;
        }
        isamp = swlim;
        osamp = blck;
        st_rate_flow_mix (
            sw->rate,
            sw->buf + pos,
            sw->hw->mix_buf + wpos,
            &isamp,
            &osamp
            );
        ret += isamp;
        swlim -= isamp;
        pos += isamp;
        live += osamp;
        wpos = (wpos + osamp) % hwsamples;
        total += osamp;
    }

    sw->total_hw_samples_mixed += total;
    sw->empty = sw->total_hw_samples_mixed == 0;

#ifdef DEBUG_OUT
    dolog (
bellard's avatar
bellard committed
1067 1068
        "%s: write size %d ret %d total sw %d\n",
        SW_NAME (sw),
1069 1070
        size >> sw->info.shift,
        ret,
bellard's avatar
bellard committed
1071
        sw->total_hw_samples_mixed
1072 1073 1074 1075
        );
#endif

    return ret << sw->info.shift;
bellard's avatar
bellard committed
1076 1077
}

1078 1079
#ifdef DEBUG_AUDIO
static void audio_pcm_print_info (const char *cap, struct audio_pcm_info *info)
bellard's avatar
bellard committed
1080
{
1081 1082
    dolog ("%s: bits %d, sign %d, freq %d, nchan %d\n",
           cap, info->bits, info->sign, info->freq, info->nchannels);
bellard's avatar
bellard committed
1083
}
1084
#endif
bellard's avatar
bellard committed
1085

1086 1087 1088 1089 1090 1091
#define DAC
#include "audio_template.h"
#undef DAC
#include "audio_template.h"

int AUD_write (SWVoiceOut *sw, void *buf, int size)
bellard's avatar
bellard committed
1092
{
1093
    int bytes;
bellard's avatar
bellard committed
1094

1095 1096 1097 1098
    if (!sw) {
        /* XXX: Consider options */
        return size;
    }
bellard's avatar
bellard committed
1099

1100
    if (!sw->hw->enabled) {
bellard's avatar
bellard committed
1101
        dolog ("Writing to disabled voice %s\n", SW_NAME (sw));
bellard's avatar
bellard committed
1102 1103 1104
        return 0;
    }

1105 1106 1107 1108 1109 1110 1111
    bytes = sw->hw->pcm_ops->write (sw, buf, size);
    return bytes;
}

int AUD_read (SWVoiceIn *sw, void *buf, int size)
{
    int bytes;
bellard's avatar
bellard committed
1112

1113 1114 1115
    if (!sw) {
        /* XXX: Consider options */
        return size;
bellard's avatar
bellard committed
1116
    }
1117 1118

    if (!sw->hw->enabled) {
bellard's avatar
bellard committed
1119
        dolog ("Reading from disabled voice %s\n", SW_NAME (sw));
1120
        return 0;
bellard's avatar
bellard committed
1121
    }
1122 1123 1124

    bytes = sw->hw->pcm_ops->read (sw, buf, size);
    return bytes;
bellard's avatar
bellard committed
1125 1126
}

1127
int AUD_get_buffer_size_out (SWVoiceOut *sw)
bellard's avatar
bellard committed
1128
{
bellard's avatar
bellard committed
1129
    return sw->hw->samples << sw->hw->info.shift;
1130 1131 1132 1133 1134
}

void AUD_set_active_out (SWVoiceOut *sw, int on)
{
    HWVoiceOut *hw;
bellard's avatar
bellard committed
1135

1136
    if (!sw) {
bellard's avatar
bellard committed
1137
        return;
1138
    }
bellard's avatar
bellard committed
1139 1140

    hw = sw->hw;
1141 1142
    if (sw->active != on) {
        SWVoiceOut *temp_sw;
bellard's avatar
bellard committed
1143
        SWVoiceCap *sc;
1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162

        if (on) {
            hw->pending_disable = 0;
            if (!hw->enabled) {
                hw->enabled = 1;
                hw->pcm_ops->ctl_out (hw, VOICE_ENABLE);
            }
        }
        else {
            if (hw->enabled) {
                int nb_active = 0;

                for (temp_sw = hw->sw_head.lh_first; temp_sw;
                     temp_sw = temp_sw->entries.le_next) {
                    nb_active += temp_sw->active != 0;
                }

                hw->pending_disable = nb_active == 1;
            }
bellard's avatar
bellard committed
1163
        }
bellard's avatar
bellard committed
1164 1165 1166

        for (sc = hw->cap_head.lh_first; sc; sc = sc->entries.le_next) {
            sc->sw.active = hw->enabled;
1167
            if (hw->enabled) {
bellard's avatar
bellard committed
1168
                audio_capture_maybe_changed (sc->cap, 1);
1169 1170
            }
        }
1171 1172 1173 1174 1175 1176 1177 1178 1179 1180
        sw->active = on;
    }
}

void AUD_set_active_in (SWVoiceIn *sw, int on)
{
    HWVoiceIn *hw;

    if (!sw) {
        return;
bellard's avatar
bellard committed
1181 1182
    }

1183
    hw = sw->hw;
bellard's avatar
bellard committed
1184
    if (sw->active != on) {
1185 1186
        SWVoiceIn *temp_sw;

bellard's avatar
bellard committed
1187 1188 1189
        if (on) {
            if (!hw->enabled) {
                hw->enabled = 1;
1190
                hw->pcm_ops->ctl_in (hw, VOICE_ENABLE);
bellard's avatar
bellard committed
1191
            }
1192
            sw->total_hw_samples_acquired = hw->total_samples_captured;
bellard's avatar
bellard committed
1193 1194
        }
        else {
1195
            if (hw->enabled) {
bellard's avatar
bellard committed
1196
                int nb_active = 0;
1197 1198 1199 1200

                for (temp_sw = hw->sw_head.lh_first; temp_sw;
                     temp_sw = temp_sw->entries.le_next) {
                    nb_active += temp_sw->active != 0;
bellard's avatar
bellard committed
1201 1202 1203
                }

                if (nb_active == 1) {
1204 1205
                    hw->enabled = 0;
                    hw->pcm_ops->ctl_in (hw, VOICE_DISABLE);
bellard's avatar
bellard committed
1206 1207 1208 1209 1210 1211 1212
                }
            }
        }
        sw->active = on;
    }
}

1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227
static int audio_get_avail (SWVoiceIn *sw)
{
    int live;

    if (!sw) {
        return 0;
    }

    live = sw->hw->total_samples_captured - sw->total_hw_samples_acquired;
    if (audio_bug (AUDIO_FUNC, live < 0 || live > sw->hw->samples)) {
        dolog ("live=%d sw->hw->samples=%d\n", live, sw->hw->samples);
        return 0;
    }

    ldebug (
bellard's avatar
bellard committed
1228
        "%s: get_avail live %d ret %" PRId64 "\n",
bellard's avatar
bellard committed
1229
        SW_NAME (sw),
1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247
        live, (((int64_t) live << 32) / sw->ratio) << sw->info.shift
        );

    return (((int64_t) live << 32) / sw->ratio) << sw->info.shift;
}

static int audio_get_free (SWVoiceOut *sw)
{
    int live, dead;

    if (!sw) {
        return 0;
    }

    live = sw->total_hw_samples_mixed;

    if (audio_bug (AUDIO_FUNC, live < 0 || live > sw->hw->samples)) {
        dolog ("live=%d sw->hw->samples=%d\n", live, sw->hw->samples);
bellard's avatar
bellard committed
1248
        return 0;
1249 1250 1251 1252 1253
    }

    dead = sw->hw->samples - live;

#ifdef DEBUG_OUT
bellard's avatar
bellard committed
1254
    dolog ("%s: get_free live %d dead %d ret %" PRId64 "\n",
bellard's avatar
bellard committed
1255
           SW_NAME (sw),
1256
           live, dead, (((int64_t) dead << 32) / sw->ratio) << sw->info.shift);
bellard's avatar
bellard committed
1257
#endif
1258 1259 1260 1261

    return (((int64_t) dead << 32) / sw->ratio) << sw->info.shift;
}

1262 1263 1264 1265 1266
static void audio_capture_mix_and_clear (HWVoiceOut *hw, int rpos, int samples)
{
    int n;

    if (hw->enabled) {
bellard's avatar
bellard committed
1267
        SWVoiceCap *sc;
1268

bellard's avatar
bellard committed
1269 1270
        for (sc = hw->cap_head.lh_first; sc; sc = sc->entries.le_next) {
            SWVoiceOut *sw = &sc->sw;
1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282
            int rpos2 = rpos;

            n = samples;
            while (n) {
                int till_end_of_hw = hw->samples - rpos2;
                int to_write = audio_MIN (till_end_of_hw, n);
                int bytes = to_write << hw->info.shift;
                int written;

                sw->buf = hw->mix_buf + rpos2;
                written = audio_pcm_sw_write (sw, NULL, bytes);
                if (written - bytes) {
bellard's avatar
bellard committed
1283 1284 1285
                    dolog ("Could not mix %d bytes into a capture "
                           "buffer, mixed %d\n",
                           bytes, written);
1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298
                    break;
                }
                n -= to_write;
                rpos2 = (rpos2 + to_write) % hw->samples;
            }
        }
    }

    n = audio_MIN (samples, hw->samples - rpos);
    mixeng_clear (hw->mix_buf + rpos, n);
    mixeng_clear (hw->mix_buf, samples - n);
}

bellard's avatar
bellard committed
1299
static void audio_run_out (AudioState *s)
1300 1301 1302 1303
{
    HWVoiceOut *hw = NULL;
    SWVoiceOut *sw;

bellard's avatar
bellard committed
1304
    while ((hw = audio_pcm_hw_find_any_enabled_out (s, hw))) {
1305
        int played;
1306
        int live, free, nb_live, cleanup_required, prev_rpos;
1307 1308 1309 1310 1311

        live = audio_pcm_hw_get_live_out2 (hw, &nb_live);
        if (!nb_live) {
            live = 0;
        }
bellard's avatar
bellard committed
1312

1313 1314
        if (audio_bug (AUDIO_FUNC, live < 0 || live > hw->samples)) {
            dolog ("live=%d hw->samples=%d\n", live, hw->samples);
bellard's avatar
bellard committed
1315
            continue;
1316 1317 1318
        }

        if (hw->pending_disable && !nb_live) {
bellard's avatar
bellard committed
1319
            SWVoiceCap *sc;
1320 1321
#ifdef DEBUG_OUT
            dolog ("Disabling voice\n");
bellard's avatar
bellard committed
1322
#endif
1323 1324 1325
            hw->enabled = 0;
            hw->pending_disable = 0;
            hw->pcm_ops->ctl_out (hw, VOICE_DISABLE);
bellard's avatar
bellard committed
1326 1327 1328
            for (sc = hw->cap_head.lh_first; sc; sc = sc->entries.le_next) {
                sc->sw.active = 0;
                audio_recalc_and_notify_capture (sc->cap);
1329
            }
1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344
            continue;
        }

        if (!live) {
            for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
                if (sw->active) {
                    free = audio_get_free (sw);
                    if (free > 0) {
                        sw->callback.fn (sw->callback.opaque, free);
                    }
                }
            }
            continue;
        }