audio/paaudio.c

   1 /* public domain */
   2 #include "qemu-common.h"
   3 #include "audio.h"
   4
   5 #include <pulse/simple.h>
   6 #include <pulse/error.h>
   7
   8 #define AUDIO_CAP "pulseaudio"
   9 #include "audio_int.h"
  10 #include "audio_pt_int.h"
  11
  12 typedef struct {
  13     HWVoiceOut hw;
  14     int done;
  15     int live;
  16     int decr;
  17     int rpos;
  18     pa_simple *s;
  19     void *pcm_buf;
  20     struct audio_pt pt;
  21 } PAVoiceOut;
  22
  23 typedef struct {
  24     HWVoiceIn hw;
  25     int done;
  26     int dead;
  27     int incr;
  28     int wpos;
  29     pa_simple *s;
  30     void *pcm_buf;
  31     struct audio_pt pt;
  32 } PAVoiceIn;
  33
  34 static struct {
  35     int samples;
  36     char *server;
  37     char *sink;
  38     char *source;
  39 } conf = {
  40     .samples = 4096,
  41 };
  42
  43 static void GCC_FMT_ATTR (2, 3) qpa_logerr (int err, const char *fmt, ...)
  44 {
  45     va_list ap;
  46
  47     va_start (ap, fmt);
  48     AUD_vlog (AUDIO_CAP, fmt, ap);
  49     va_end (ap);
  50
  51     AUD_log (AUDIO_CAP, "Reason: %s\n", pa_strerror (err));
  52 }
  53
  54 static void *qpa_thread_out (void *arg)
  55 {
  56     PAVoiceOut *pa = arg;
  57     HWVoiceOut *hw = &pa->hw;
  58
  59     if (audio_pt_lock (&pa->pt, AUDIO_FUNC)) {
  60         return NULL;
  61     }
  62
  63     for (;;) {
  64         int decr, to_mix, rpos;
  65
  66         for (;;) {
  67             if (pa->done) {
  68                 goto exit;
  69             }
  70
  71             if (pa->live > 0) {
  72                 break;
  73             }
  74
  75             if (audio_pt_wait (&pa->pt, AUDIO_FUNC)) {
  76                 goto exit;
  77             }
  78         }
  79
  80         decr = to_mix = audio_MIN (pa->live, conf.samples >> 2);
  81         rpos = pa->rpos;
  82
  83         if (audio_pt_unlock (&pa->pt, AUDIO_FUNC)) {
  84             return NULL;
  85         }
  86
  87         while (to_mix) {
  88             int error;
  89             int chunk = audio_MIN (to_mix, hw->samples - rpos);
  90             struct st_sample *src = hw->mix_buf + rpos;
  91
  92             hw->clip (pa->pcm_buf, src, chunk);
  93
  94             if (pa_simple_write (pa->s, pa->pcm_buf,
  95                                  chunk << hw->info.shift, &error) < 0) {
  96                 qpa_logerr (error, "pa_simple_write failed\n");
  97                 return NULL;
  98             }
  99
 100             rpos = (rpos + chunk) % hw->samples;
 101             to_mix -= chunk;
 102         }
 103
 104         if (audio_pt_lock (&pa->pt, AUDIO_FUNC)) {
 105             return NULL;
 106         }
 107
 108         pa->rpos = rpos;
 109         pa->live -= decr;
 110         pa->decr += decr;
 111     }
 112
 113  exit:
 114     audio_pt_unlock (&pa->pt, AUDIO_FUNC);
 115     return NULL;
 116 }
 117
 118 static int qpa_run_out (HWVoiceOut *hw, int live)
 119 {
 120     int decr;
 121     PAVoiceOut *pa = (PAVoiceOut *) hw;
 122
 123     if (audio_pt_lock (&pa->pt, AUDIO_FUNC)) {
 124         return 0;
 125     }
 126
 127     decr = audio_MIN (live, pa->decr);
 128     pa->decr -= decr;
 129     pa->live = live - decr;
 130     hw->rpos = pa->rpos;
 131     if (pa->live > 0) {
 132         audio_pt_unlock_and_signal (&pa->pt, AUDIO_FUNC);
 133     }
 134     else {
 135         audio_pt_unlock (&pa->pt, AUDIO_FUNC);
 136     }
 137     return decr;
 138 }
 139
 140 static int qpa_write (SWVoiceOut *sw, void *buf, int len)
 141 {
 142     return audio_pcm_sw_write (sw, buf, len);
 143 }
 144
 145 /* capture */
 146 static void *qpa_thread_in (void *arg)
 147 {
 148     PAVoiceIn *pa = arg;
 149     HWVoiceIn *hw = &pa->hw;
 150
 151     if (audio_pt_lock (&pa->pt, AUDIO_FUNC)) {
 152         return NULL;
 153     }
 154
 155     for (;;) {
 156         int incr, to_grab, wpos;
 157
 158         for (;;) {
 159             if (pa->done) {
 160                 goto exit;
 161             }
 162
 163             if (pa->dead > 0) {
 164                 break;
 165             }
 166
 167             if (audio_pt_wait (&pa->pt, AUDIO_FUNC)) {
 168                 goto exit;
 169             }
 170         }
 171
 172         incr = to_grab = audio_MIN (pa->dead, conf.samples >> 2);
 173         wpos = pa->wpos;
 174
 175         if (audio_pt_unlock (&pa->pt, AUDIO_FUNC)) {
 176             return NULL;
 177         }
 178
 179         while (to_grab) {
 180             int error;
 181             int chunk = audio_MIN (to_grab, hw->samples - wpos);
 182             void *buf = advance (pa->pcm_buf, wpos);
 183
 184             if (pa_simple_read (pa->s, buf,
 185                                 chunk << hw->info.shift, &error) < 0) {
 186                 qpa_logerr (error, "pa_simple_read failed\n");
 187                 return NULL;
 188             }
 189
 190             hw->conv (hw->conv_buf + wpos, buf, chunk);
 191             wpos = (wpos + chunk) % hw->samples;
 192             to_grab -= chunk;
 193         }
 194
 195         if (audio_pt_lock (&pa->pt, AUDIO_FUNC)) {
 196             return NULL;
 197         }
 198
 199         pa->wpos = wpos;
 200         pa->dead -= incr;
 201         pa->incr += incr;
 202     }
 203
 204  exit:
 205     audio_pt_unlock (&pa->pt, AUDIO_FUNC);
 206     return NULL;
 207 }
 208
 209 static int qpa_run_in (HWVoiceIn *hw)
 210 {
 211     int live, incr, dead;
 212     PAVoiceIn *pa = (PAVoiceIn *) hw;
 213
 214     if (audio_pt_lock (&pa->pt, AUDIO_FUNC)) {
 215         return 0;
 216     }
 217
 218     live = audio_pcm_hw_get_live_in (hw);
 219     dead = hw->samples - live;
 220     incr = audio_MIN (dead, pa->incr);
 221     pa->incr -= incr;
 222     pa->dead = dead - incr;
 223     hw->wpos = pa->wpos;
 224     if (pa->dead > 0) {
 225         audio_pt_unlock_and_signal (&pa->pt, AUDIO_FUNC);
 226     }
 227     else {
 228         audio_pt_unlock (&pa->pt, AUDIO_FUNC);
 229     }
 230     return incr;
 231 }
 232
 233 static int qpa_read (SWVoiceIn *sw, void *buf, int len)
 234 {
 235     return audio_pcm_sw_read (sw, buf, len);
 236 }
 237
 238 static pa_sample_format_t audfmt_to_pa (audfmt_e afmt, int endianness)
 239 {
 240     int format;
 241
 242     switch (afmt) {
 243     case AUD_FMT_S8:
 244     case AUD_FMT_U8:
 245         format = PA_SAMPLE_U8;
 246         break;
 247     case AUD_FMT_S16:
 248     case AUD_FMT_U16:
 249         format = endianness ? PA_SAMPLE_S16BE : PA_SAMPLE_S16LE;
 250         break;
 251     case AUD_FMT_S32:
 252     case AUD_FMT_U32:
 253         format = endianness ? PA_SAMPLE_S32BE : PA_SAMPLE_S32LE;
 254         break;
 255     default:
 256         dolog ("Internal logic error: Bad audio format %d\n", afmt);
 257         format = PA_SAMPLE_U8;
 258         break;
 259     }
 260     return format;
 261 }
 262
 263 static audfmt_e pa_to_audfmt (pa_sample_format_t fmt, int *endianness)
 264 {
 265     switch (fmt) {
 266     case PA_SAMPLE_U8:
 267         return AUD_FMT_U8;
 268     case PA_SAMPLE_S16BE:
 269         *endianness = 1;
 270         return AUD_FMT_S16;
 271     case PA_SAMPLE_S16LE:
 272         *endianness = 0;
 273         return AUD_FMT_S16;
 274     case PA_SAMPLE_S32BE:
 275         *endianness = 1;
 276         return AUD_FMT_S32;
 277     case PA_SAMPLE_S32LE:
 278         *endianness = 0;
 279         return AUD_FMT_S32;
 280     default:
 281         dolog ("Internal logic error: Bad pa_sample_format %d\n", fmt);
 282         return AUD_FMT_U8;
 283     }
 284 }
 285
 286 static int qpa_init_out (HWVoiceOut *hw, struct audsettings *as)
 287 {
 288     int error;
 289     static pa_sample_spec ss;
 290     static pa_buffer_attr ba;
 291     struct audsettings obt_as = *as;
 292     PAVoiceOut *pa = (PAVoiceOut *) hw;
 293
 294     ss.format = audfmt_to_pa (as->fmt, as->endianness);
 295     ss.channels = as->nchannels;
 296     ss.rate = as->freq;
 297
 298     /*
 299      * qemu audio tick runs at 250 Hz (by default), so processing
 300      * data chunks worth 4 ms of sound should be a good fit.
 301      */
 302     ba.tlength = pa_usec_to_bytes (4 * 1000, &ss);
 303     ba.minreq = pa_usec_to_bytes (2 * 1000, &ss);
 304     ba.maxlength = -1;
 305     ba.prebuf = -1;
 306
 307     obt_as.fmt = pa_to_audfmt (ss.format, &obt_as.endianness);
 308
 309     pa->s = pa_simple_new (
 310         conf.server,
 311         "qemu",
 312         PA_STREAM_PLAYBACK,
 313         conf.sink,
 314         "pcm.playback",
 315         &ss,
 316         NULL,                   /* channel map */
 317         &ba,                    /* buffering attributes */
 318         &error
 319         );
 320     if (!pa->s) {
 321         qpa_logerr (error, "pa_simple_new for playback failed\n");
 322         goto fail1;
 323     }
 324
 325     audio_pcm_init_info (&hw->info, &obt_as);
 326     hw->samples = conf.samples;
 327     pa->pcm_buf = audio_calloc (AUDIO_FUNC, hw->samples, 1 << hw->info.shift);
 328     pa->rpos = hw->rpos;
 329     if (!pa->pcm_buf) {
 330         dolog ("Could not allocate buffer (%d bytes)\n",
 331                hw->samples << hw->info.shift);
 332         goto fail2;
 333     }
 334
 335     if (audio_pt_init (&pa->pt, qpa_thread_out, hw, AUDIO_CAP, AUDIO_FUNC)) {
 336         goto fail3;
 337     }
 338
 339     return 0;
 340
 341  fail3:
 342     g_free (pa->pcm_buf);
 343     pa->pcm_buf = NULL;
 344  fail2:
 345     pa_simple_free (pa->s);
 346     pa->s = NULL;
 347  fail1:
 348     return -1;
 349 }
 350
 351 static int qpa_init_in (HWVoiceIn *hw, struct audsettings *as)
 352 {
 353     int error;
 354     static pa_sample_spec ss;
 355     struct audsettings obt_as = *as;
 356     PAVoiceIn *pa = (PAVoiceIn *) hw;
 357
 358     ss.format = audfmt_to_pa (as->fmt, as->endianness);
 359     ss.channels = as->nchannels;
 360     ss.rate = as->freq;
 361
 362     obt_as.fmt = pa_to_audfmt (ss.format, &obt_as.endianness);
 363
 364     pa->s = pa_simple_new (
 365         conf.server,
 366         "qemu",
 367         PA_STREAM_RECORD,
 368         conf.source,
 369         "pcm.capture",
 370         &ss,
 371         NULL,                   /* channel map */
 372         NULL,                   /* buffering attributes */
 373         &error
 374         );
 375     if (!pa->s) {
 376         qpa_logerr (error, "pa_simple_new for capture failed\n");
 377         goto fail1;
 378     }
 379
 380     audio_pcm_init_info (&hw->info, &obt_as);
 381     hw->samples = conf.samples;
 382     pa->pcm_buf = audio_calloc (AUDIO_FUNC, hw->samples, 1 << hw->info.shift);
 383     pa->wpos = hw->wpos;
 384     if (!pa->pcm_buf) {
 385         dolog ("Could not allocate buffer (%d bytes)\n",
 386                hw->samples << hw->info.shift);
 387         goto fail2;
 388     }
 389
 390     if (audio_pt_init (&pa->pt, qpa_thread_in, hw, AUDIO_CAP, AUDIO_FUNC)) {
 391         goto fail3;
 392     }
 393
 394     return 0;
 395
 396  fail3:
 397     g_free (pa->pcm_buf);
 398     pa->pcm_buf = NULL;
 399  fail2:
 400     pa_simple_free (pa->s);
 401     pa->s = NULL;
 402  fail1:
 403     return -1;
 404 }
 405
 406 static void qpa_fini_out (HWVoiceOut *hw)
 407 {
 408     void *ret;
 409     PAVoiceOut *pa = (PAVoiceOut *) hw;
 410
 411     audio_pt_lock (&pa->pt, AUDIO_FUNC);
 412     pa->done = 1;
 413     audio_pt_unlock_and_signal (&pa->pt, AUDIO_FUNC);
 414     audio_pt_join (&pa->pt, &ret, AUDIO_FUNC);
 415
 416     if (pa->s) {
 417         pa_simple_free (pa->s);
 418         pa->s = NULL;
 419     }
 420
 421     audio_pt_fini (&pa->pt, AUDIO_FUNC);
 422     g_free (pa->pcm_buf);
 423     pa->pcm_buf = NULL;
 424 }
 425
 426 static void qpa_fini_in (HWVoiceIn *hw)
 427 {
 428     void *ret;
 429     PAVoiceIn *pa = (PAVoiceIn *) hw;
 430
 431     audio_pt_lock (&pa->pt, AUDIO_FUNC);
 432     pa->done = 1;
 433     audio_pt_unlock_and_signal (&pa->pt, AUDIO_FUNC);
 434     audio_pt_join (&pa->pt, &ret, AUDIO_FUNC);
 435
 436     if (pa->s) {
 437         pa_simple_free (pa->s);
 438         pa->s = NULL;
 439     }
 440
 441     audio_pt_fini (&pa->pt, AUDIO_FUNC);
 442     g_free (pa->pcm_buf);
 443     pa->pcm_buf = NULL;
 444 }
 445
 446 static int qpa_ctl_out (HWVoiceOut *hw, int cmd, ...)
 447 {
 448     (void) hw;
 449     (void) cmd;
 450     return 0;
 451 }
 452
 453 static int qpa_ctl_in (HWVoiceIn *hw, int cmd, ...)
 454 {
 455     (void) hw;
 456     (void) cmd;
 457     return 0;
 458 }
 459
 460 /* common */
 461 static void *qpa_audio_init (void)
 462 {
 463     return &conf;
 464 }
 465
 466 static void qpa_audio_fini (void *opaque)
 467 {
 468     (void) opaque;
 469 }
 470
 471 struct audio_option qpa_options[] = {
 472     {
 473         .name  = "SAMPLES",
 474         .tag   = AUD_OPT_INT,
 475         .valp  = &conf.samples,
 476         .descr = "buffer size in samples"
 477     },
 478     {
 479         .name  = "SERVER",
 480         .tag   = AUD_OPT_STR,
 481         .valp  = &conf.server,
 482         .descr = "server address"
 483     },
 484     {
 485         .name  = "SINK",
 486         .tag   = AUD_OPT_STR,
 487         .valp  = &conf.sink,
 488         .descr = "sink device name"
 489     },
 490     {
 491         .name  = "SOURCE",
 492         .tag   = AUD_OPT_STR,
 493         .valp  = &conf.source,
 494         .descr = "source device name"
 495     },
 496     { /* End of list */ }
 497 };
 498
 499 static struct audio_pcm_ops qpa_pcm_ops = {
 500     .init_out = qpa_init_out,
 501     .fini_out = qpa_fini_out,
 502     .run_out  = qpa_run_out,
 503     .write    = qpa_write,
 504     .ctl_out  = qpa_ctl_out,
 505
 506     .init_in  = qpa_init_in,
 507     .fini_in  = qpa_fini_in,
 508     .run_in   = qpa_run_in,
 509     .read     = qpa_read,
 510     .ctl_in   = qpa_ctl_in
 511 };
 512
 513 struct audio_driver pa_audio_driver = {
 514     .name           = "pa",
 515     .descr          = "http://www.pulseaudio.org/",
 516     .options        = qpa_options,
 517     .init           = qpa_audio_init,
 518     .fini           = qpa_audio_fini,
 519     .pcm_ops        = &qpa_pcm_ops,
 520     .can_be_default = 1,
 521     .max_voices_out = INT_MAX,
 522     .max_voices_in  = INT_MAX,
 523     .voice_size_out = sizeof (PAVoiceOut),
 524     .voice_size_in  = sizeof (PAVoiceIn)
 525 };