GRLIB UART: Add RX channel
[qemu.git] / 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 };