]> git.proxmox.com Git - mirror_qemu.git/blob - audio/audio.c
audio: move function audio_pcm_hw_clip_out()
[mirror_qemu.git] / audio / audio.c
1 /*
2 * QEMU Audio subsystem
3 *
4 * Copyright (c) 2003-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
25 #include "qemu/osdep.h"
26 #include "audio.h"
27 #include "migration/vmstate.h"
28 #include "monitor/monitor.h"
29 #include "qemu/timer.h"
30 #include "qapi/error.h"
31 #include "qapi/qobject-input-visitor.h"
32 #include "qapi/qapi-visit-audio.h"
33 #include "qemu/cutils.h"
34 #include "qemu/module.h"
35 #include "qemu-common.h"
36 #include "sysemu/replay.h"
37 #include "sysemu/runstate.h"
38 #include "ui/qemu-spice.h"
39 #include "trace.h"
40
41 #define AUDIO_CAP "audio"
42 #include "audio_int.h"
43
44 /* #define DEBUG_LIVE */
45 /* #define DEBUG_OUT */
46 /* #define DEBUG_CAPTURE */
47 /* #define DEBUG_POLL */
48
49 #define SW_NAME(sw) (sw)->name ? (sw)->name : "unknown"
50
51
52 /* Order of CONFIG_AUDIO_DRIVERS is import.
53 The 1st one is the one used by default, that is the reason
54 that we generate the list.
55 */
56 const char *audio_prio_list[] = {
57 "spice",
58 CONFIG_AUDIO_DRIVERS
59 "none",
60 "wav",
61 NULL
62 };
63
64 static QLIST_HEAD(, audio_driver) audio_drivers;
65 static AudiodevListHead audiodevs = QSIMPLEQ_HEAD_INITIALIZER(audiodevs);
66
67 void audio_driver_register(audio_driver *drv)
68 {
69 QLIST_INSERT_HEAD(&audio_drivers, drv, next);
70 }
71
72 audio_driver *audio_driver_lookup(const char *name)
73 {
74 struct audio_driver *d;
75
76 QLIST_FOREACH(d, &audio_drivers, next) {
77 if (strcmp(name, d->name) == 0) {
78 return d;
79 }
80 }
81
82 audio_module_load_one(name);
83 QLIST_FOREACH(d, &audio_drivers, next) {
84 if (strcmp(name, d->name) == 0) {
85 return d;
86 }
87 }
88
89 return NULL;
90 }
91
92 static QTAILQ_HEAD(AudioStateHead, AudioState) audio_states =
93 QTAILQ_HEAD_INITIALIZER(audio_states);
94
95 const struct mixeng_volume nominal_volume = {
96 .mute = 0,
97 #ifdef FLOAT_MIXENG
98 .r = 1.0,
99 .l = 1.0,
100 #else
101 .r = 1ULL << 32,
102 .l = 1ULL << 32,
103 #endif
104 };
105
106 static bool legacy_config = true;
107
108 int audio_bug (const char *funcname, int cond)
109 {
110 if (cond) {
111 static int shown;
112
113 AUD_log (NULL, "A bug was just triggered in %s\n", funcname);
114 if (!shown) {
115 shown = 1;
116 AUD_log (NULL, "Save all your work and restart without audio\n");
117 AUD_log (NULL, "I am sorry\n");
118 }
119 AUD_log (NULL, "Context:\n");
120 abort();
121 }
122
123 return cond;
124 }
125
126 static inline int audio_bits_to_index (int bits)
127 {
128 switch (bits) {
129 case 8:
130 return 0;
131
132 case 16:
133 return 1;
134
135 case 32:
136 return 2;
137
138 default:
139 audio_bug ("bits_to_index", 1);
140 AUD_log (NULL, "invalid bits %d\n", bits);
141 return 0;
142 }
143 }
144
145 void *audio_calloc (const char *funcname, int nmemb, size_t size)
146 {
147 int cond;
148 size_t len;
149
150 len = nmemb * size;
151 cond = !nmemb || !size;
152 cond |= nmemb < 0;
153 cond |= len < size;
154
155 if (audio_bug ("audio_calloc", cond)) {
156 AUD_log (NULL, "%s passed invalid arguments to audio_calloc\n",
157 funcname);
158 AUD_log (NULL, "nmemb=%d size=%zu (len=%zu)\n", nmemb, size, len);
159 return NULL;
160 }
161
162 return g_malloc0 (len);
163 }
164
165 void AUD_vlog (const char *cap, const char *fmt, va_list ap)
166 {
167 if (cap) {
168 fprintf(stderr, "%s: ", cap);
169 }
170
171 vfprintf(stderr, fmt, ap);
172 }
173
174 void AUD_log (const char *cap, const char *fmt, ...)
175 {
176 va_list ap;
177
178 va_start (ap, fmt);
179 AUD_vlog (cap, fmt, ap);
180 va_end (ap);
181 }
182
183 static void audio_print_settings (struct audsettings *as)
184 {
185 dolog ("frequency=%d nchannels=%d fmt=", as->freq, as->nchannels);
186
187 switch (as->fmt) {
188 case AUDIO_FORMAT_S8:
189 AUD_log (NULL, "S8");
190 break;
191 case AUDIO_FORMAT_U8:
192 AUD_log (NULL, "U8");
193 break;
194 case AUDIO_FORMAT_S16:
195 AUD_log (NULL, "S16");
196 break;
197 case AUDIO_FORMAT_U16:
198 AUD_log (NULL, "U16");
199 break;
200 case AUDIO_FORMAT_S32:
201 AUD_log (NULL, "S32");
202 break;
203 case AUDIO_FORMAT_U32:
204 AUD_log (NULL, "U32");
205 break;
206 case AUDIO_FORMAT_F32:
207 AUD_log (NULL, "F32");
208 break;
209 default:
210 AUD_log (NULL, "invalid(%d)", as->fmt);
211 break;
212 }
213
214 AUD_log (NULL, " endianness=");
215 switch (as->endianness) {
216 case 0:
217 AUD_log (NULL, "little");
218 break;
219 case 1:
220 AUD_log (NULL, "big");
221 break;
222 default:
223 AUD_log (NULL, "invalid");
224 break;
225 }
226 AUD_log (NULL, "\n");
227 }
228
229 static int audio_validate_settings (struct audsettings *as)
230 {
231 int invalid;
232
233 invalid = as->nchannels < 1;
234 invalid |= as->endianness != 0 && as->endianness != 1;
235
236 switch (as->fmt) {
237 case AUDIO_FORMAT_S8:
238 case AUDIO_FORMAT_U8:
239 case AUDIO_FORMAT_S16:
240 case AUDIO_FORMAT_U16:
241 case AUDIO_FORMAT_S32:
242 case AUDIO_FORMAT_U32:
243 case AUDIO_FORMAT_F32:
244 break;
245 default:
246 invalid = 1;
247 break;
248 }
249
250 invalid |= as->freq <= 0;
251 return invalid ? -1 : 0;
252 }
253
254 static int audio_pcm_info_eq (struct audio_pcm_info *info, struct audsettings *as)
255 {
256 int bits = 8;
257 bool is_signed = false, is_float = false;
258
259 switch (as->fmt) {
260 case AUDIO_FORMAT_S8:
261 is_signed = true;
262 /* fall through */
263 case AUDIO_FORMAT_U8:
264 break;
265
266 case AUDIO_FORMAT_S16:
267 is_signed = true;
268 /* fall through */
269 case AUDIO_FORMAT_U16:
270 bits = 16;
271 break;
272
273 case AUDIO_FORMAT_F32:
274 is_float = true;
275 /* fall through */
276 case AUDIO_FORMAT_S32:
277 is_signed = true;
278 /* fall through */
279 case AUDIO_FORMAT_U32:
280 bits = 32;
281 break;
282
283 default:
284 abort();
285 }
286 return info->freq == as->freq
287 && info->nchannels == as->nchannels
288 && info->is_signed == is_signed
289 && info->is_float == is_float
290 && info->bits == bits
291 && info->swap_endianness == (as->endianness != AUDIO_HOST_ENDIANNESS);
292 }
293
294 void audio_pcm_init_info (struct audio_pcm_info *info, struct audsettings *as)
295 {
296 int bits = 8, mul;
297 bool is_signed = false, is_float = false;
298
299 switch (as->fmt) {
300 case AUDIO_FORMAT_S8:
301 is_signed = true;
302 /* fall through */
303 case AUDIO_FORMAT_U8:
304 mul = 1;
305 break;
306
307 case AUDIO_FORMAT_S16:
308 is_signed = true;
309 /* fall through */
310 case AUDIO_FORMAT_U16:
311 bits = 16;
312 mul = 2;
313 break;
314
315 case AUDIO_FORMAT_F32:
316 is_float = true;
317 /* fall through */
318 case AUDIO_FORMAT_S32:
319 is_signed = true;
320 /* fall through */
321 case AUDIO_FORMAT_U32:
322 bits = 32;
323 mul = 4;
324 break;
325
326 default:
327 abort();
328 }
329
330 info->freq = as->freq;
331 info->bits = bits;
332 info->is_signed = is_signed;
333 info->is_float = is_float;
334 info->nchannels = as->nchannels;
335 info->bytes_per_frame = as->nchannels * mul;
336 info->bytes_per_second = info->freq * info->bytes_per_frame;
337 info->swap_endianness = (as->endianness != AUDIO_HOST_ENDIANNESS);
338 }
339
340 void audio_pcm_info_clear_buf (struct audio_pcm_info *info, void *buf, int len)
341 {
342 if (!len) {
343 return;
344 }
345
346 if (info->is_signed || info->is_float) {
347 memset(buf, 0x00, len * info->bytes_per_frame);
348 } else {
349 switch (info->bits) {
350 case 8:
351 memset(buf, 0x80, len * info->bytes_per_frame);
352 break;
353
354 case 16:
355 {
356 int i;
357 uint16_t *p = buf;
358 short s = INT16_MAX;
359
360 if (info->swap_endianness) {
361 s = bswap16 (s);
362 }
363
364 for (i = 0; i < len * info->nchannels; i++) {
365 p[i] = s;
366 }
367 }
368 break;
369
370 case 32:
371 {
372 int i;
373 uint32_t *p = buf;
374 int32_t s = INT32_MAX;
375
376 if (info->swap_endianness) {
377 s = bswap32 (s);
378 }
379
380 for (i = 0; i < len * info->nchannels; i++) {
381 p[i] = s;
382 }
383 }
384 break;
385
386 default:
387 AUD_log (NULL, "audio_pcm_info_clear_buf: invalid bits %d\n",
388 info->bits);
389 break;
390 }
391 }
392 }
393
394 /*
395 * Capture
396 */
397 static void noop_conv (struct st_sample *dst, const void *src, int samples)
398 {
399 (void) src;
400 (void) dst;
401 (void) samples;
402 }
403
404 static CaptureVoiceOut *audio_pcm_capture_find_specific(AudioState *s,
405 struct audsettings *as)
406 {
407 CaptureVoiceOut *cap;
408
409 for (cap = s->cap_head.lh_first; cap; cap = cap->entries.le_next) {
410 if (audio_pcm_info_eq (&cap->hw.info, as)) {
411 return cap;
412 }
413 }
414 return NULL;
415 }
416
417 static void audio_notify_capture (CaptureVoiceOut *cap, audcnotification_e cmd)
418 {
419 struct capture_callback *cb;
420
421 #ifdef DEBUG_CAPTURE
422 dolog ("notification %d sent\n", cmd);
423 #endif
424 for (cb = cap->cb_head.lh_first; cb; cb = cb->entries.le_next) {
425 cb->ops.notify (cb->opaque, cmd);
426 }
427 }
428
429 static void audio_capture_maybe_changed (CaptureVoiceOut *cap, int enabled)
430 {
431 if (cap->hw.enabled != enabled) {
432 audcnotification_e cmd;
433 cap->hw.enabled = enabled;
434 cmd = enabled ? AUD_CNOTIFY_ENABLE : AUD_CNOTIFY_DISABLE;
435 audio_notify_capture (cap, cmd);
436 }
437 }
438
439 static void audio_recalc_and_notify_capture (CaptureVoiceOut *cap)
440 {
441 HWVoiceOut *hw = &cap->hw;
442 SWVoiceOut *sw;
443 int enabled = 0;
444
445 for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
446 if (sw->active) {
447 enabled = 1;
448 break;
449 }
450 }
451 audio_capture_maybe_changed (cap, enabled);
452 }
453
454 static void audio_detach_capture (HWVoiceOut *hw)
455 {
456 SWVoiceCap *sc = hw->cap_head.lh_first;
457
458 while (sc) {
459 SWVoiceCap *sc1 = sc->entries.le_next;
460 SWVoiceOut *sw = &sc->sw;
461 CaptureVoiceOut *cap = sc->cap;
462 int was_active = sw->active;
463
464 if (sw->rate) {
465 st_rate_stop (sw->rate);
466 sw->rate = NULL;
467 }
468
469 QLIST_REMOVE (sw, entries);
470 QLIST_REMOVE (sc, entries);
471 g_free (sc);
472 if (was_active) {
473 /* We have removed soft voice from the capture:
474 this might have changed the overall status of the capture
475 since this might have been the only active voice */
476 audio_recalc_and_notify_capture (cap);
477 }
478 sc = sc1;
479 }
480 }
481
482 static int audio_attach_capture (HWVoiceOut *hw)
483 {
484 AudioState *s = hw->s;
485 CaptureVoiceOut *cap;
486
487 audio_detach_capture (hw);
488 for (cap = s->cap_head.lh_first; cap; cap = cap->entries.le_next) {
489 SWVoiceCap *sc;
490 SWVoiceOut *sw;
491 HWVoiceOut *hw_cap = &cap->hw;
492
493 sc = g_malloc0(sizeof(*sc));
494
495 sc->cap = cap;
496 sw = &sc->sw;
497 sw->hw = hw_cap;
498 sw->info = hw->info;
499 sw->empty = 1;
500 sw->active = hw->enabled;
501 sw->conv = noop_conv;
502 sw->ratio = ((int64_t) hw_cap->info.freq << 32) / sw->info.freq;
503 sw->vol = nominal_volume;
504 sw->rate = st_rate_start (sw->info.freq, hw_cap->info.freq);
505 if (!sw->rate) {
506 dolog ("Could not start rate conversion for `%s'\n", SW_NAME (sw));
507 g_free (sw);
508 return -1;
509 }
510 QLIST_INSERT_HEAD (&hw_cap->sw_head, sw, entries);
511 QLIST_INSERT_HEAD (&hw->cap_head, sc, entries);
512 #ifdef DEBUG_CAPTURE
513 sw->name = g_strdup_printf ("for %p %d,%d,%d",
514 hw, sw->info.freq, sw->info.bits,
515 sw->info.nchannels);
516 dolog ("Added %s active = %d\n", sw->name, sw->active);
517 #endif
518 if (sw->active) {
519 audio_capture_maybe_changed (cap, 1);
520 }
521 }
522 return 0;
523 }
524
525 /*
526 * Hard voice (capture)
527 */
528 static size_t audio_pcm_hw_find_min_in (HWVoiceIn *hw)
529 {
530 SWVoiceIn *sw;
531 size_t m = hw->total_samples_captured;
532
533 for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
534 if (sw->active) {
535 m = MIN (m, sw->total_hw_samples_acquired);
536 }
537 }
538 return m;
539 }
540
541 static size_t audio_pcm_hw_get_live_in(HWVoiceIn *hw)
542 {
543 size_t live = hw->total_samples_captured - audio_pcm_hw_find_min_in (hw);
544 if (audio_bug(__func__, live > hw->conv_buf->size)) {
545 dolog("live=%zu hw->conv_buf->size=%zu\n", live, hw->conv_buf->size);
546 return 0;
547 }
548 return live;
549 }
550
551 /*
552 * Soft voice (capture)
553 */
554 static size_t audio_pcm_sw_get_rpos_in(SWVoiceIn *sw)
555 {
556 HWVoiceIn *hw = sw->hw;
557 ssize_t live = hw->total_samples_captured - sw->total_hw_samples_acquired;
558
559 if (audio_bug(__func__, live < 0 || live > hw->conv_buf->size)) {
560 dolog("live=%zu hw->conv_buf->size=%zu\n", live, hw->conv_buf->size);
561 return 0;
562 }
563
564 return audio_ring_posb(hw->conv_buf->pos, live, hw->conv_buf->size);
565 }
566
567 static size_t audio_pcm_sw_read(SWVoiceIn *sw, void *buf, size_t size)
568 {
569 HWVoiceIn *hw = sw->hw;
570 size_t samples, live, ret = 0, swlim, isamp, osamp, rpos, total = 0;
571 struct st_sample *src, *dst = sw->buf;
572
573 rpos = audio_pcm_sw_get_rpos_in(sw) % hw->conv_buf->size;
574
575 live = hw->total_samples_captured - sw->total_hw_samples_acquired;
576 if (audio_bug(__func__, live > hw->conv_buf->size)) {
577 dolog("live_in=%zu hw->conv_buf->size=%zu\n", live, hw->conv_buf->size);
578 return 0;
579 }
580
581 samples = size / sw->info.bytes_per_frame;
582 if (!live) {
583 return 0;
584 }
585
586 swlim = (live * sw->ratio) >> 32;
587 swlim = MIN (swlim, samples);
588
589 while (swlim) {
590 src = hw->conv_buf->samples + rpos;
591 if (hw->conv_buf->pos > rpos) {
592 isamp = hw->conv_buf->pos - rpos;
593 } else {
594 isamp = hw->conv_buf->size - rpos;
595 }
596
597 if (!isamp) {
598 break;
599 }
600 osamp = swlim;
601
602 st_rate_flow (sw->rate, src, dst, &isamp, &osamp);
603 swlim -= osamp;
604 rpos = (rpos + isamp) % hw->conv_buf->size;
605 dst += osamp;
606 ret += osamp;
607 total += isamp;
608 }
609
610 if (hw->pcm_ops && !hw->pcm_ops->volume_in) {
611 mixeng_volume (sw->buf, ret, &sw->vol);
612 }
613
614 sw->clip (buf, sw->buf, ret);
615 sw->total_hw_samples_acquired += total;
616 return ret * sw->info.bytes_per_frame;
617 }
618
619 /*
620 * Hard voice (playback)
621 */
622 static size_t audio_pcm_hw_find_min_out (HWVoiceOut *hw, int *nb_livep)
623 {
624 SWVoiceOut *sw;
625 size_t m = SIZE_MAX;
626 int nb_live = 0;
627
628 for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
629 if (sw->active || !sw->empty) {
630 m = MIN (m, sw->total_hw_samples_mixed);
631 nb_live += 1;
632 }
633 }
634
635 *nb_livep = nb_live;
636 return m;
637 }
638
639 static size_t audio_pcm_hw_get_live_out (HWVoiceOut *hw, int *nb_live)
640 {
641 size_t smin;
642 int nb_live1;
643
644 smin = audio_pcm_hw_find_min_out (hw, &nb_live1);
645 if (nb_live) {
646 *nb_live = nb_live1;
647 }
648
649 if (nb_live1) {
650 size_t live = smin;
651
652 if (audio_bug(__func__, live > hw->mix_buf->size)) {
653 dolog("live=%zu hw->mix_buf->size=%zu\n", live, hw->mix_buf->size);
654 return 0;
655 }
656 return live;
657 }
658 return 0;
659 }
660
661 static void audio_pcm_hw_clip_out(HWVoiceOut *hw, void *pcm_buf, size_t len)
662 {
663 size_t clipped = 0;
664 size_t pos = hw->mix_buf->pos;
665
666 while (len) {
667 st_sample *src = hw->mix_buf->samples + pos;
668 uint8_t *dst = advance(pcm_buf, clipped * hw->info.bytes_per_frame);
669 size_t samples_till_end_of_buf = hw->mix_buf->size - pos;
670 size_t samples_to_clip = MIN(len, samples_till_end_of_buf);
671
672 hw->clip(dst, src, samples_to_clip);
673
674 pos = (pos + samples_to_clip) % hw->mix_buf->size;
675 len -= samples_to_clip;
676 clipped += samples_to_clip;
677 }
678 }
679
680 /*
681 * Soft voice (playback)
682 */
683 static size_t audio_pcm_sw_write(SWVoiceOut *sw, void *buf, size_t size)
684 {
685 size_t hwsamples, samples, isamp, osamp, wpos, live, dead, left, swlim, blck;
686 size_t ret = 0, pos = 0, total = 0;
687
688 if (!sw) {
689 return size;
690 }
691
692 hwsamples = sw->hw->mix_buf->size;
693
694 live = sw->total_hw_samples_mixed;
695 if (audio_bug(__func__, live > hwsamples)) {
696 dolog("live=%zu hw->mix_buf->size=%zu\n", live, hwsamples);
697 return 0;
698 }
699
700 if (live == hwsamples) {
701 #ifdef DEBUG_OUT
702 dolog ("%s is full %zu\n", sw->name, live);
703 #endif
704 return 0;
705 }
706
707 wpos = (sw->hw->mix_buf->pos + live) % hwsamples;
708 samples = size / sw->info.bytes_per_frame;
709
710 dead = hwsamples - live;
711 swlim = ((int64_t) dead << 32) / sw->ratio;
712 swlim = MIN (swlim, samples);
713 if (swlim) {
714 sw->conv (sw->buf, buf, swlim);
715
716 if (sw->hw->pcm_ops && !sw->hw->pcm_ops->volume_out) {
717 mixeng_volume (sw->buf, swlim, &sw->vol);
718 }
719 }
720
721 while (swlim) {
722 dead = hwsamples - live;
723 left = hwsamples - wpos;
724 blck = MIN (dead, left);
725 if (!blck) {
726 break;
727 }
728 isamp = swlim;
729 osamp = blck;
730 st_rate_flow_mix (
731 sw->rate,
732 sw->buf + pos,
733 sw->hw->mix_buf->samples + wpos,
734 &isamp,
735 &osamp
736 );
737 ret += isamp;
738 swlim -= isamp;
739 pos += isamp;
740 live += osamp;
741 wpos = (wpos + osamp) % hwsamples;
742 total += osamp;
743 }
744
745 sw->total_hw_samples_mixed += total;
746 sw->empty = sw->total_hw_samples_mixed == 0;
747
748 #ifdef DEBUG_OUT
749 dolog (
750 "%s: write size %zu ret %zu total sw %zu\n",
751 SW_NAME (sw),
752 size / sw->info.bytes_per_frame,
753 ret,
754 sw->total_hw_samples_mixed
755 );
756 #endif
757
758 return ret * sw->info.bytes_per_frame;
759 }
760
761 #ifdef DEBUG_AUDIO
762 static void audio_pcm_print_info (const char *cap, struct audio_pcm_info *info)
763 {
764 dolog("%s: bits %d, sign %d, float %d, freq %d, nchan %d\n",
765 cap, info->bits, info->is_signed, info->is_float, info->freq,
766 info->nchannels);
767 }
768 #endif
769
770 #define DAC
771 #include "audio_template.h"
772 #undef DAC
773 #include "audio_template.h"
774
775 /*
776 * Timer
777 */
778 static int audio_is_timer_needed(AudioState *s)
779 {
780 HWVoiceIn *hwi = NULL;
781 HWVoiceOut *hwo = NULL;
782
783 while ((hwo = audio_pcm_hw_find_any_enabled_out(s, hwo))) {
784 if (!hwo->poll_mode) {
785 return 1;
786 }
787 }
788 while ((hwi = audio_pcm_hw_find_any_enabled_in(s, hwi))) {
789 if (!hwi->poll_mode) {
790 return 1;
791 }
792 }
793 return 0;
794 }
795
796 static void audio_reset_timer (AudioState *s)
797 {
798 if (audio_is_timer_needed(s)) {
799 timer_mod_anticipate_ns(s->ts,
800 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->period_ticks);
801 if (!s->timer_running) {
802 s->timer_running = true;
803 s->timer_last = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
804 trace_audio_timer_start(s->period_ticks / SCALE_MS);
805 }
806 } else {
807 timer_del(s->ts);
808 if (s->timer_running) {
809 s->timer_running = false;
810 trace_audio_timer_stop();
811 }
812 }
813 }
814
815 static void audio_timer (void *opaque)
816 {
817 int64_t now, diff;
818 AudioState *s = opaque;
819
820 now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
821 diff = now - s->timer_last;
822 if (diff > s->period_ticks * 3 / 2) {
823 trace_audio_timer_delayed(diff / SCALE_MS);
824 }
825 s->timer_last = now;
826
827 audio_run(s, "timer");
828 audio_reset_timer(s);
829 }
830
831 /*
832 * Public API
833 */
834 size_t AUD_write(SWVoiceOut *sw, void *buf, size_t size)
835 {
836 HWVoiceOut *hw;
837
838 if (!sw) {
839 /* XXX: Consider options */
840 return size;
841 }
842 hw = sw->hw;
843
844 if (!hw->enabled) {
845 dolog ("Writing to disabled voice %s\n", SW_NAME (sw));
846 return 0;
847 }
848
849 if (audio_get_pdo_out(hw->s->dev)->mixing_engine) {
850 return audio_pcm_sw_write(sw, buf, size);
851 } else {
852 return hw->pcm_ops->write(hw, buf, size);
853 }
854 }
855
856 size_t AUD_read(SWVoiceIn *sw, void *buf, size_t size)
857 {
858 HWVoiceIn *hw;
859
860 if (!sw) {
861 /* XXX: Consider options */
862 return size;
863 }
864 hw = sw->hw;
865
866 if (!hw->enabled) {
867 dolog ("Reading from disabled voice %s\n", SW_NAME (sw));
868 return 0;
869 }
870
871 if (audio_get_pdo_in(hw->s->dev)->mixing_engine) {
872 return audio_pcm_sw_read(sw, buf, size);
873 } else {
874 return hw->pcm_ops->read(hw, buf, size);
875 }
876 }
877
878 int AUD_get_buffer_size_out(SWVoiceOut *sw)
879 {
880 return sw->hw->samples * sw->hw->info.bytes_per_frame;
881 }
882
883 void AUD_set_active_out (SWVoiceOut *sw, int on)
884 {
885 HWVoiceOut *hw;
886
887 if (!sw) {
888 return;
889 }
890
891 hw = sw->hw;
892 if (sw->active != on) {
893 AudioState *s = sw->s;
894 SWVoiceOut *temp_sw;
895 SWVoiceCap *sc;
896
897 if (on) {
898 hw->pending_disable = 0;
899 if (!hw->enabled) {
900 hw->enabled = 1;
901 if (s->vm_running) {
902 if (hw->pcm_ops->enable_out) {
903 hw->pcm_ops->enable_out(hw, true);
904 }
905 audio_reset_timer (s);
906 }
907 }
908 } else {
909 if (hw->enabled) {
910 int nb_active = 0;
911
912 for (temp_sw = hw->sw_head.lh_first; temp_sw;
913 temp_sw = temp_sw->entries.le_next) {
914 nb_active += temp_sw->active != 0;
915 }
916
917 hw->pending_disable = nb_active == 1;
918 }
919 }
920
921 for (sc = hw->cap_head.lh_first; sc; sc = sc->entries.le_next) {
922 sc->sw.active = hw->enabled;
923 if (hw->enabled) {
924 audio_capture_maybe_changed (sc->cap, 1);
925 }
926 }
927 sw->active = on;
928 }
929 }
930
931 void AUD_set_active_in (SWVoiceIn *sw, int on)
932 {
933 HWVoiceIn *hw;
934
935 if (!sw) {
936 return;
937 }
938
939 hw = sw->hw;
940 if (sw->active != on) {
941 AudioState *s = sw->s;
942 SWVoiceIn *temp_sw;
943
944 if (on) {
945 if (!hw->enabled) {
946 hw->enabled = 1;
947 if (s->vm_running) {
948 if (hw->pcm_ops->enable_in) {
949 hw->pcm_ops->enable_in(hw, true);
950 }
951 audio_reset_timer (s);
952 }
953 }
954 sw->total_hw_samples_acquired = hw->total_samples_captured;
955 } else {
956 if (hw->enabled) {
957 int nb_active = 0;
958
959 for (temp_sw = hw->sw_head.lh_first; temp_sw;
960 temp_sw = temp_sw->entries.le_next) {
961 nb_active += temp_sw->active != 0;
962 }
963
964 if (nb_active == 1) {
965 hw->enabled = 0;
966 if (hw->pcm_ops->enable_in) {
967 hw->pcm_ops->enable_in(hw, false);
968 }
969 }
970 }
971 }
972 sw->active = on;
973 }
974 }
975
976 static size_t audio_get_avail (SWVoiceIn *sw)
977 {
978 size_t live;
979
980 if (!sw) {
981 return 0;
982 }
983
984 live = sw->hw->total_samples_captured - sw->total_hw_samples_acquired;
985 if (audio_bug(__func__, live > sw->hw->conv_buf->size)) {
986 dolog("live=%zu sw->hw->conv_buf->size=%zu\n", live,
987 sw->hw->conv_buf->size);
988 return 0;
989 }
990
991 ldebug (
992 "%s: get_avail live %zu ret %" PRId64 "\n",
993 SW_NAME (sw),
994 live, (((int64_t) live << 32) / sw->ratio) * sw->info.bytes_per_frame
995 );
996
997 return (((int64_t) live << 32) / sw->ratio) * sw->info.bytes_per_frame;
998 }
999
1000 static size_t audio_get_free(SWVoiceOut *sw)
1001 {
1002 size_t live, dead;
1003
1004 if (!sw) {
1005 return 0;
1006 }
1007
1008 live = sw->total_hw_samples_mixed;
1009
1010 if (audio_bug(__func__, live > sw->hw->mix_buf->size)) {
1011 dolog("live=%zu sw->hw->mix_buf->size=%zu\n", live,
1012 sw->hw->mix_buf->size);
1013 return 0;
1014 }
1015
1016 dead = sw->hw->mix_buf->size - live;
1017
1018 #ifdef DEBUG_OUT
1019 dolog ("%s: get_free live %zu dead %zu ret %" PRId64 "\n",
1020 SW_NAME (sw),
1021 live, dead, (((int64_t) dead << 32) / sw->ratio) *
1022 sw->info.bytes_per_frame);
1023 #endif
1024
1025 return (((int64_t) dead << 32) / sw->ratio) * sw->info.bytes_per_frame;
1026 }
1027
1028 static void audio_capture_mix_and_clear(HWVoiceOut *hw, size_t rpos,
1029 size_t samples)
1030 {
1031 size_t n;
1032
1033 if (hw->enabled) {
1034 SWVoiceCap *sc;
1035
1036 for (sc = hw->cap_head.lh_first; sc; sc = sc->entries.le_next) {
1037 SWVoiceOut *sw = &sc->sw;
1038 int rpos2 = rpos;
1039
1040 n = samples;
1041 while (n) {
1042 size_t till_end_of_hw = hw->mix_buf->size - rpos2;
1043 size_t to_write = MIN(till_end_of_hw, n);
1044 size_t bytes = to_write * hw->info.bytes_per_frame;
1045 size_t written;
1046
1047 sw->buf = hw->mix_buf->samples + rpos2;
1048 written = audio_pcm_sw_write (sw, NULL, bytes);
1049 if (written - bytes) {
1050 dolog("Could not mix %zu bytes into a capture "
1051 "buffer, mixed %zu\n",
1052 bytes, written);
1053 break;
1054 }
1055 n -= to_write;
1056 rpos2 = (rpos2 + to_write) % hw->mix_buf->size;
1057 }
1058 }
1059 }
1060
1061 n = MIN(samples, hw->mix_buf->size - rpos);
1062 mixeng_clear(hw->mix_buf->samples + rpos, n);
1063 mixeng_clear(hw->mix_buf->samples, samples - n);
1064 }
1065
1066 static size_t audio_pcm_hw_run_out(HWVoiceOut *hw, size_t live)
1067 {
1068 size_t clipped = 0;
1069
1070 while (live) {
1071 size_t size = live * hw->info.bytes_per_frame;
1072 size_t decr, proc;
1073 void *buf = hw->pcm_ops->get_buffer_out(hw, &size);
1074
1075 if (size == 0) {
1076 break;
1077 }
1078
1079 decr = MIN(size / hw->info.bytes_per_frame, live);
1080 if (buf) {
1081 audio_pcm_hw_clip_out(hw, buf, decr);
1082 }
1083 proc = hw->pcm_ops->put_buffer_out(hw, buf,
1084 decr * hw->info.bytes_per_frame) /
1085 hw->info.bytes_per_frame;
1086
1087 live -= proc;
1088 clipped += proc;
1089 hw->mix_buf->pos = (hw->mix_buf->pos + proc) % hw->mix_buf->size;
1090
1091 if (proc == 0 || proc < decr) {
1092 break;
1093 }
1094 }
1095
1096 if (hw->pcm_ops->run_buffer_out) {
1097 hw->pcm_ops->run_buffer_out(hw);
1098 }
1099
1100 return clipped;
1101 }
1102
1103 static void audio_run_out (AudioState *s)
1104 {
1105 HWVoiceOut *hw = NULL;
1106 SWVoiceOut *sw;
1107
1108 if (!audio_get_pdo_out(s->dev)->mixing_engine) {
1109 while ((hw = audio_pcm_hw_find_any_enabled_out(s, hw))) {
1110 /* there is exactly 1 sw for each hw with no mixeng */
1111 sw = hw->sw_head.lh_first;
1112
1113 if (hw->pending_disable) {
1114 hw->enabled = 0;
1115 hw->pending_disable = 0;
1116 if (hw->pcm_ops->enable_out) {
1117 hw->pcm_ops->enable_out(hw, false);
1118 }
1119 }
1120
1121 if (sw->active) {
1122 sw->callback.fn(sw->callback.opaque, INT_MAX);
1123 }
1124 }
1125 return;
1126 }
1127
1128 while ((hw = audio_pcm_hw_find_any_enabled_out(s, hw))) {
1129 size_t played, live, prev_rpos, free;
1130 int nb_live;
1131
1132 live = audio_pcm_hw_get_live_out (hw, &nb_live);
1133 if (!nb_live) {
1134 live = 0;
1135 }
1136
1137 if (audio_bug(__func__, live > hw->mix_buf->size)) {
1138 dolog("live=%zu hw->mix_buf->size=%zu\n", live, hw->mix_buf->size);
1139 continue;
1140 }
1141
1142 if (hw->pending_disable && !nb_live) {
1143 SWVoiceCap *sc;
1144 #ifdef DEBUG_OUT
1145 dolog ("Disabling voice\n");
1146 #endif
1147 hw->enabled = 0;
1148 hw->pending_disable = 0;
1149 if (hw->pcm_ops->enable_out) {
1150 hw->pcm_ops->enable_out(hw, false);
1151 }
1152 for (sc = hw->cap_head.lh_first; sc; sc = sc->entries.le_next) {
1153 sc->sw.active = 0;
1154 audio_recalc_and_notify_capture (sc->cap);
1155 }
1156 continue;
1157 }
1158
1159 if (!live) {
1160 for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
1161 if (sw->active) {
1162 free = audio_get_free (sw);
1163 if (free > 0) {
1164 sw->callback.fn (sw->callback.opaque, free);
1165 }
1166 }
1167 }
1168 if (hw->pcm_ops->run_buffer_out) {
1169 hw->pcm_ops->run_buffer_out(hw);
1170 }
1171 continue;
1172 }
1173
1174 prev_rpos = hw->mix_buf->pos;
1175 played = audio_pcm_hw_run_out(hw, live);
1176 replay_audio_out(&played);
1177 if (audio_bug(__func__, hw->mix_buf->pos >= hw->mix_buf->size)) {
1178 dolog("hw->mix_buf->pos=%zu hw->mix_buf->size=%zu played=%zu\n",
1179 hw->mix_buf->pos, hw->mix_buf->size, played);
1180 hw->mix_buf->pos = 0;
1181 }
1182
1183 #ifdef DEBUG_OUT
1184 dolog("played=%zu\n", played);
1185 #endif
1186
1187 if (played) {
1188 hw->ts_helper += played;
1189 audio_capture_mix_and_clear (hw, prev_rpos, played);
1190 }
1191
1192 for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
1193 if (!sw->active && sw->empty) {
1194 continue;
1195 }
1196
1197 if (audio_bug(__func__, played > sw->total_hw_samples_mixed)) {
1198 dolog("played=%zu sw->total_hw_samples_mixed=%zu\n",
1199 played, sw->total_hw_samples_mixed);
1200 played = sw->total_hw_samples_mixed;
1201 }
1202
1203 sw->total_hw_samples_mixed -= played;
1204
1205 if (!sw->total_hw_samples_mixed) {
1206 sw->empty = 1;
1207 }
1208
1209 if (sw->active) {
1210 free = audio_get_free (sw);
1211 if (free > 0) {
1212 sw->callback.fn (sw->callback.opaque, free);
1213 }
1214 }
1215 }
1216 }
1217 }
1218
1219 static size_t audio_pcm_hw_run_in(HWVoiceIn *hw, size_t samples)
1220 {
1221 size_t conv = 0;
1222 STSampleBuffer *conv_buf = hw->conv_buf;
1223
1224 if (hw->pcm_ops->run_buffer_in) {
1225 hw->pcm_ops->run_buffer_in(hw);
1226 }
1227
1228 while (samples) {
1229 size_t proc;
1230 size_t size = samples * hw->info.bytes_per_frame;
1231 void *buf = hw->pcm_ops->get_buffer_in(hw, &size);
1232
1233 assert(size % hw->info.bytes_per_frame == 0);
1234 if (size == 0) {
1235 break;
1236 }
1237
1238 proc = MIN(size / hw->info.bytes_per_frame,
1239 conv_buf->size - conv_buf->pos);
1240
1241 hw->conv(conv_buf->samples + conv_buf->pos, buf, proc);
1242 conv_buf->pos = (conv_buf->pos + proc) % conv_buf->size;
1243
1244 samples -= proc;
1245 conv += proc;
1246 hw->pcm_ops->put_buffer_in(hw, buf, proc * hw->info.bytes_per_frame);
1247 }
1248
1249 return conv;
1250 }
1251
1252 static void audio_run_in (AudioState *s)
1253 {
1254 HWVoiceIn *hw = NULL;
1255
1256 if (!audio_get_pdo_in(s->dev)->mixing_engine) {
1257 while ((hw = audio_pcm_hw_find_any_enabled_in(s, hw))) {
1258 /* there is exactly 1 sw for each hw with no mixeng */
1259 SWVoiceIn *sw = hw->sw_head.lh_first;
1260 if (sw->active) {
1261 sw->callback.fn(sw->callback.opaque, INT_MAX);
1262 }
1263 }
1264 return;
1265 }
1266
1267 while ((hw = audio_pcm_hw_find_any_enabled_in(s, hw))) {
1268 SWVoiceIn *sw;
1269 size_t captured = 0, min;
1270
1271 if (replay_mode != REPLAY_MODE_PLAY) {
1272 captured = audio_pcm_hw_run_in(
1273 hw, hw->conv_buf->size - audio_pcm_hw_get_live_in(hw));
1274 }
1275 replay_audio_in(&captured, hw->conv_buf->samples, &hw->conv_buf->pos,
1276 hw->conv_buf->size);
1277
1278 min = audio_pcm_hw_find_min_in (hw);
1279 hw->total_samples_captured += captured - min;
1280 hw->ts_helper += captured;
1281
1282 for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
1283 sw->total_hw_samples_acquired -= min;
1284
1285 if (sw->active) {
1286 size_t avail;
1287
1288 avail = audio_get_avail (sw);
1289 if (avail > 0) {
1290 sw->callback.fn (sw->callback.opaque, avail);
1291 }
1292 }
1293 }
1294 }
1295 }
1296
1297 static void audio_run_capture (AudioState *s)
1298 {
1299 CaptureVoiceOut *cap;
1300
1301 for (cap = s->cap_head.lh_first; cap; cap = cap->entries.le_next) {
1302 size_t live, rpos, captured;
1303 HWVoiceOut *hw = &cap->hw;
1304 SWVoiceOut *sw;
1305
1306 captured = live = audio_pcm_hw_get_live_out (hw, NULL);
1307 rpos = hw->mix_buf->pos;
1308 while (live) {
1309 size_t left = hw->mix_buf->size - rpos;
1310 size_t to_capture = MIN(live, left);
1311 struct st_sample *src;
1312 struct capture_callback *cb;
1313
1314 src = hw->mix_buf->samples + rpos;
1315 hw->clip (cap->buf, src, to_capture);
1316 mixeng_clear (src, to_capture);
1317
1318 for (cb = cap->cb_head.lh_first; cb; cb = cb->entries.le_next) {
1319 cb->ops.capture (cb->opaque, cap->buf,
1320 to_capture * hw->info.bytes_per_frame);
1321 }
1322 rpos = (rpos + to_capture) % hw->mix_buf->size;
1323 live -= to_capture;
1324 }
1325 hw->mix_buf->pos = rpos;
1326
1327 for (sw = hw->sw_head.lh_first; sw; sw = sw->entries.le_next) {
1328 if (!sw->active && sw->empty) {
1329 continue;
1330 }
1331
1332 if (audio_bug(__func__, captured > sw->total_hw_samples_mixed)) {
1333 dolog("captured=%zu sw->total_hw_samples_mixed=%zu\n",
1334 captured, sw->total_hw_samples_mixed);
1335 captured = sw->total_hw_samples_mixed;
1336 }
1337
1338 sw->total_hw_samples_mixed -= captured;
1339 sw->empty = sw->total_hw_samples_mixed == 0;
1340 }
1341 }
1342 }
1343
1344 void audio_run(AudioState *s, const char *msg)
1345 {
1346 audio_run_out(s);
1347 audio_run_in(s);
1348 audio_run_capture(s);
1349
1350 #ifdef DEBUG_POLL
1351 {
1352 static double prevtime;
1353 double currtime;
1354 struct timeval tv;
1355
1356 if (gettimeofday (&tv, NULL)) {
1357 perror ("audio_run: gettimeofday");
1358 return;
1359 }
1360
1361 currtime = tv.tv_sec + tv.tv_usec * 1e-6;
1362 dolog ("Elapsed since last %s: %f\n", msg, currtime - prevtime);
1363 prevtime = currtime;
1364 }
1365 #endif
1366 }
1367
1368 void audio_generic_run_buffer_in(HWVoiceIn *hw)
1369 {
1370 if (unlikely(!hw->buf_emul)) {
1371 hw->size_emul = hw->samples * hw->info.bytes_per_frame;
1372 hw->buf_emul = g_malloc(hw->size_emul);
1373 hw->pos_emul = hw->pending_emul = 0;
1374 }
1375
1376 while (hw->pending_emul < hw->size_emul) {
1377 size_t read_len = MIN(hw->size_emul - hw->pos_emul,
1378 hw->size_emul - hw->pending_emul);
1379 size_t read = hw->pcm_ops->read(hw, hw->buf_emul + hw->pos_emul,
1380 read_len);
1381 hw->pending_emul += read;
1382 hw->pos_emul = (hw->pos_emul + read) % hw->size_emul;
1383 if (read < read_len) {
1384 break;
1385 }
1386 }
1387 }
1388
1389 void *audio_generic_get_buffer_in(HWVoiceIn *hw, size_t *size)
1390 {
1391 size_t start;
1392
1393 start = audio_ring_posb(hw->pos_emul, hw->pending_emul, hw->size_emul);
1394 assert(start < hw->size_emul);
1395
1396 *size = MIN(*size, hw->pending_emul);
1397 *size = MIN(*size, hw->size_emul - start);
1398 return hw->buf_emul + start;
1399 }
1400
1401 void audio_generic_put_buffer_in(HWVoiceIn *hw, void *buf, size_t size)
1402 {
1403 assert(size <= hw->pending_emul);
1404 hw->pending_emul -= size;
1405 }
1406
1407 void audio_generic_run_buffer_out(HWVoiceOut *hw)
1408 {
1409 while (hw->pending_emul) {
1410 size_t write_len, written, start;
1411
1412 start = audio_ring_posb(hw->pos_emul, hw->pending_emul, hw->size_emul);
1413 assert(start < hw->size_emul);
1414
1415 write_len = MIN(hw->pending_emul, hw->size_emul - start);
1416
1417 written = hw->pcm_ops->write(hw, hw->buf_emul + start, write_len);
1418 hw->pending_emul -= written;
1419
1420 if (written < write_len) {
1421 break;
1422 }
1423 }
1424 }
1425
1426 void *audio_generic_get_buffer_out(HWVoiceOut *hw, size_t *size)
1427 {
1428 if (unlikely(!hw->buf_emul)) {
1429 hw->size_emul = hw->samples * hw->info.bytes_per_frame;
1430 hw->buf_emul = g_malloc(hw->size_emul);
1431 hw->pos_emul = hw->pending_emul = 0;
1432 }
1433
1434 *size = MIN(hw->size_emul - hw->pending_emul,
1435 hw->size_emul - hw->pos_emul);
1436 return hw->buf_emul + hw->pos_emul;
1437 }
1438
1439 size_t audio_generic_put_buffer_out(HWVoiceOut *hw, void *buf, size_t size)
1440 {
1441 assert(buf == hw->buf_emul + hw->pos_emul &&
1442 size + hw->pending_emul <= hw->size_emul);
1443
1444 hw->pending_emul += size;
1445 hw->pos_emul = (hw->pos_emul + size) % hw->size_emul;
1446
1447 return size;
1448 }
1449
1450 size_t audio_generic_write(HWVoiceOut *hw, void *buf, size_t size)
1451 {
1452 size_t total = 0;
1453
1454 while (total < size) {
1455 size_t dst_size = size - total;
1456 size_t copy_size, proc;
1457 void *dst = hw->pcm_ops->get_buffer_out(hw, &dst_size);
1458
1459 if (dst_size == 0) {
1460 break;
1461 }
1462
1463 copy_size = MIN(size - total, dst_size);
1464 if (dst) {
1465 memcpy(dst, (char *)buf + total, copy_size);
1466 }
1467 proc = hw->pcm_ops->put_buffer_out(hw, dst, copy_size);
1468 total += proc;
1469
1470 if (proc == 0 || proc < copy_size) {
1471 break;
1472 }
1473 }
1474
1475 if (hw->pcm_ops->run_buffer_out) {
1476 hw->pcm_ops->run_buffer_out(hw);
1477 }
1478
1479 return total;
1480 }
1481
1482 size_t audio_generic_read(HWVoiceIn *hw, void *buf, size_t size)
1483 {
1484 size_t total = 0;
1485
1486 if (hw->pcm_ops->run_buffer_in) {
1487 hw->pcm_ops->run_buffer_in(hw);
1488 }
1489
1490 while (total < size) {
1491 size_t src_size = size - total;
1492 void *src = hw->pcm_ops->get_buffer_in(hw, &src_size);
1493
1494 if (src_size == 0) {
1495 break;
1496 }
1497
1498 memcpy((char *)buf + total, src, src_size);
1499 hw->pcm_ops->put_buffer_in(hw, src, src_size);
1500 total += src_size;
1501 }
1502
1503 return total;
1504 }
1505
1506 static int audio_driver_init(AudioState *s, struct audio_driver *drv,
1507 bool msg, Audiodev *dev)
1508 {
1509 s->drv_opaque = drv->init(dev);
1510
1511 if (s->drv_opaque) {
1512 if (!drv->pcm_ops->get_buffer_in) {
1513 drv->pcm_ops->get_buffer_in = audio_generic_get_buffer_in;
1514 drv->pcm_ops->put_buffer_in = audio_generic_put_buffer_in;
1515 }
1516 if (!drv->pcm_ops->get_buffer_out) {
1517 drv->pcm_ops->get_buffer_out = audio_generic_get_buffer_out;
1518 drv->pcm_ops->put_buffer_out = audio_generic_put_buffer_out;
1519 }
1520
1521 audio_init_nb_voices_out(s, drv);
1522 audio_init_nb_voices_in(s, drv);
1523 s->drv = drv;
1524 return 0;
1525 } else {
1526 if (msg) {
1527 dolog("Could not init `%s' audio driver\n", drv->name);
1528 }
1529 return -1;
1530 }
1531 }
1532
1533 static void audio_vm_change_state_handler (void *opaque, bool running,
1534 RunState state)
1535 {
1536 AudioState *s = opaque;
1537 HWVoiceOut *hwo = NULL;
1538 HWVoiceIn *hwi = NULL;
1539
1540 s->vm_running = running;
1541 while ((hwo = audio_pcm_hw_find_any_enabled_out(s, hwo))) {
1542 if (hwo->pcm_ops->enable_out) {
1543 hwo->pcm_ops->enable_out(hwo, running);
1544 }
1545 }
1546
1547 while ((hwi = audio_pcm_hw_find_any_enabled_in(s, hwi))) {
1548 if (hwi->pcm_ops->enable_in) {
1549 hwi->pcm_ops->enable_in(hwi, running);
1550 }
1551 }
1552 audio_reset_timer (s);
1553 }
1554
1555 static void free_audio_state(AudioState *s)
1556 {
1557 HWVoiceOut *hwo, *hwon;
1558 HWVoiceIn *hwi, *hwin;
1559
1560 QLIST_FOREACH_SAFE(hwo, &s->hw_head_out, entries, hwon) {
1561 SWVoiceCap *sc;
1562
1563 if (hwo->enabled && hwo->pcm_ops->enable_out) {
1564 hwo->pcm_ops->enable_out(hwo, false);
1565 }
1566 hwo->pcm_ops->fini_out (hwo);
1567
1568 for (sc = hwo->cap_head.lh_first; sc; sc = sc->entries.le_next) {
1569 CaptureVoiceOut *cap = sc->cap;
1570 struct capture_callback *cb;
1571
1572 for (cb = cap->cb_head.lh_first; cb; cb = cb->entries.le_next) {
1573 cb->ops.destroy (cb->opaque);
1574 }
1575 }
1576 QLIST_REMOVE(hwo, entries);
1577 }
1578
1579 QLIST_FOREACH_SAFE(hwi, &s->hw_head_in, entries, hwin) {
1580 if (hwi->enabled && hwi->pcm_ops->enable_in) {
1581 hwi->pcm_ops->enable_in(hwi, false);
1582 }
1583 hwi->pcm_ops->fini_in (hwi);
1584 QLIST_REMOVE(hwi, entries);
1585 }
1586
1587 if (s->drv) {
1588 s->drv->fini (s->drv_opaque);
1589 s->drv = NULL;
1590 }
1591
1592 if (s->dev) {
1593 qapi_free_Audiodev(s->dev);
1594 s->dev = NULL;
1595 }
1596
1597 if (s->ts) {
1598 timer_free(s->ts);
1599 s->ts = NULL;
1600 }
1601
1602 g_free(s);
1603 }
1604
1605 void audio_cleanup(void)
1606 {
1607 while (!QTAILQ_EMPTY(&audio_states)) {
1608 AudioState *s = QTAILQ_FIRST(&audio_states);
1609 QTAILQ_REMOVE(&audio_states, s, list);
1610 free_audio_state(s);
1611 }
1612 }
1613
1614 static bool vmstate_audio_needed(void *opaque)
1615 {
1616 /*
1617 * Never needed, this vmstate only exists in case
1618 * an old qemu sends it to us.
1619 */
1620 return false;
1621 }
1622
1623 static const VMStateDescription vmstate_audio = {
1624 .name = "audio",
1625 .version_id = 1,
1626 .minimum_version_id = 1,
1627 .needed = vmstate_audio_needed,
1628 .fields = (VMStateField[]) {
1629 VMSTATE_END_OF_LIST()
1630 }
1631 };
1632
1633 static void audio_validate_opts(Audiodev *dev, Error **errp);
1634
1635 static AudiodevListEntry *audiodev_find(
1636 AudiodevListHead *head, const char *drvname)
1637 {
1638 AudiodevListEntry *e;
1639 QSIMPLEQ_FOREACH(e, head, next) {
1640 if (strcmp(AudiodevDriver_str(e->dev->driver), drvname) == 0) {
1641 return e;
1642 }
1643 }
1644
1645 return NULL;
1646 }
1647
1648 /*
1649 * if we have dev, this function was called because of an -audiodev argument =>
1650 * initialize a new state with it
1651 * if dev == NULL => legacy implicit initialization, return the already created
1652 * state or create a new one
1653 */
1654 static AudioState *audio_init(Audiodev *dev, const char *name)
1655 {
1656 static bool atexit_registered;
1657 size_t i;
1658 int done = 0;
1659 const char *drvname = NULL;
1660 VMChangeStateEntry *e;
1661 AudioState *s;
1662 struct audio_driver *driver;
1663 /* silence gcc warning about uninitialized variable */
1664 AudiodevListHead head = QSIMPLEQ_HEAD_INITIALIZER(head);
1665
1666 if (using_spice) {
1667 /*
1668 * When using spice allow the spice audio driver being picked
1669 * as default.
1670 *
1671 * Temporary hack. Using audio devices without explicit
1672 * audiodev= property is already deprecated. Same goes for
1673 * the -soundhw switch. Once this support gets finally
1674 * removed we can also drop the concept of a default audio
1675 * backend and this can go away.
1676 */
1677 driver = audio_driver_lookup("spice");
1678 if (driver) {
1679 driver->can_be_default = 1;
1680 }
1681 }
1682
1683 if (dev) {
1684 /* -audiodev option */
1685 legacy_config = false;
1686 drvname = AudiodevDriver_str(dev->driver);
1687 } else if (!QTAILQ_EMPTY(&audio_states)) {
1688 if (!legacy_config) {
1689 dolog("Device %s: audiodev default parameter is deprecated, please "
1690 "specify audiodev=%s\n", name,
1691 QTAILQ_FIRST(&audio_states)->dev->id);
1692 }
1693 return QTAILQ_FIRST(&audio_states);
1694 } else {
1695 /* legacy implicit initialization */
1696 head = audio_handle_legacy_opts();
1697 /*
1698 * In case of legacy initialization, all Audiodevs in the list will have
1699 * the same configuration (except the driver), so it doesn't matter which
1700 * one we chose. We need an Audiodev to set up AudioState before we can
1701 * init a driver. Also note that dev at this point is still in the
1702 * list.
1703 */
1704 dev = QSIMPLEQ_FIRST(&head)->dev;
1705 audio_validate_opts(dev, &error_abort);
1706 }
1707
1708 s = g_malloc0(sizeof(AudioState));
1709 s->dev = dev;
1710
1711 QLIST_INIT (&s->hw_head_out);
1712 QLIST_INIT (&s->hw_head_in);
1713 QLIST_INIT (&s->cap_head);
1714 if (!atexit_registered) {
1715 atexit(audio_cleanup);
1716 atexit_registered = true;
1717 }
1718 QTAILQ_INSERT_TAIL(&audio_states, s, list);
1719
1720 s->ts = timer_new_ns(QEMU_CLOCK_VIRTUAL, audio_timer, s);
1721
1722 s->nb_hw_voices_out = audio_get_pdo_out(dev)->voices;
1723 s->nb_hw_voices_in = audio_get_pdo_in(dev)->voices;
1724
1725 if (s->nb_hw_voices_out <= 0) {
1726 dolog ("Bogus number of playback voices %d, setting to 1\n",
1727 s->nb_hw_voices_out);
1728 s->nb_hw_voices_out = 1;
1729 }
1730
1731 if (s->nb_hw_voices_in <= 0) {
1732 dolog ("Bogus number of capture voices %d, setting to 0\n",
1733 s->nb_hw_voices_in);
1734 s->nb_hw_voices_in = 0;
1735 }
1736
1737 if (drvname) {
1738 driver = audio_driver_lookup(drvname);
1739 if (driver) {
1740 done = !audio_driver_init(s, driver, true, dev);
1741 } else {
1742 dolog ("Unknown audio driver `%s'\n", drvname);
1743 }
1744 } else {
1745 for (i = 0; audio_prio_list[i]; i++) {
1746 AudiodevListEntry *e = audiodev_find(&head, audio_prio_list[i]);
1747 driver = audio_driver_lookup(audio_prio_list[i]);
1748
1749 if (e && driver) {
1750 s->dev = dev = e->dev;
1751 audio_validate_opts(dev, &error_abort);
1752 done = !audio_driver_init(s, driver, false, dev);
1753 if (done) {
1754 e->dev = NULL;
1755 break;
1756 }
1757 }
1758 }
1759 }
1760 audio_free_audiodev_list(&head);
1761
1762 if (!done) {
1763 driver = audio_driver_lookup("none");
1764 done = !audio_driver_init(s, driver, false, dev);
1765 assert(done);
1766 dolog("warning: Using timer based audio emulation\n");
1767 }
1768
1769 if (dev->timer_period <= 0) {
1770 s->period_ticks = 1;
1771 } else {
1772 s->period_ticks = dev->timer_period * (int64_t)SCALE_US;
1773 }
1774
1775 e = qemu_add_vm_change_state_handler (audio_vm_change_state_handler, s);
1776 if (!e) {
1777 dolog ("warning: Could not register change state handler\n"
1778 "(Audio can continue looping even after stopping the VM)\n");
1779 }
1780
1781 QLIST_INIT (&s->card_head);
1782 vmstate_register (NULL, 0, &vmstate_audio, s);
1783 return s;
1784 }
1785
1786 void audio_free_audiodev_list(AudiodevListHead *head)
1787 {
1788 AudiodevListEntry *e;
1789 while ((e = QSIMPLEQ_FIRST(head))) {
1790 QSIMPLEQ_REMOVE_HEAD(head, next);
1791 qapi_free_Audiodev(e->dev);
1792 g_free(e);
1793 }
1794 }
1795
1796 void AUD_register_card (const char *name, QEMUSoundCard *card)
1797 {
1798 if (!card->state) {
1799 card->state = audio_init(NULL, name);
1800 }
1801
1802 card->name = g_strdup (name);
1803 memset (&card->entries, 0, sizeof (card->entries));
1804 QLIST_INSERT_HEAD(&card->state->card_head, card, entries);
1805 }
1806
1807 void AUD_remove_card (QEMUSoundCard *card)
1808 {
1809 QLIST_REMOVE (card, entries);
1810 g_free (card->name);
1811 }
1812
1813
1814 CaptureVoiceOut *AUD_add_capture(
1815 AudioState *s,
1816 struct audsettings *as,
1817 struct audio_capture_ops *ops,
1818 void *cb_opaque
1819 )
1820 {
1821 CaptureVoiceOut *cap;
1822 struct capture_callback *cb;
1823
1824 if (!s) {
1825 if (!legacy_config) {
1826 dolog("Capturing without setting an audiodev is deprecated\n");
1827 }
1828 s = audio_init(NULL, NULL);
1829 }
1830
1831 if (!audio_get_pdo_out(s->dev)->mixing_engine) {
1832 dolog("Can't capture with mixeng disabled\n");
1833 return NULL;
1834 }
1835
1836 if (audio_validate_settings (as)) {
1837 dolog ("Invalid settings were passed when trying to add capture\n");
1838 audio_print_settings (as);
1839 return NULL;
1840 }
1841
1842 cb = g_malloc0(sizeof(*cb));
1843 cb->ops = *ops;
1844 cb->opaque = cb_opaque;
1845
1846 cap = audio_pcm_capture_find_specific(s, as);
1847 if (cap) {
1848 QLIST_INSERT_HEAD (&cap->cb_head, cb, entries);
1849 return cap;
1850 } else {
1851 HWVoiceOut *hw;
1852 CaptureVoiceOut *cap;
1853
1854 cap = g_malloc0(sizeof(*cap));
1855
1856 hw = &cap->hw;
1857 hw->s = s;
1858 QLIST_INIT (&hw->sw_head);
1859 QLIST_INIT (&cap->cb_head);
1860
1861 /* XXX find a more elegant way */
1862 hw->samples = 4096 * 4;
1863 audio_pcm_hw_alloc_resources_out(hw);
1864
1865 audio_pcm_init_info (&hw->info, as);
1866
1867 cap->buf = g_malloc0_n(hw->mix_buf->size, hw->info.bytes_per_frame);
1868
1869 if (hw->info.is_float) {
1870 hw->clip = mixeng_clip_float[hw->info.nchannels == 2];
1871 } else {
1872 hw->clip = mixeng_clip
1873 [hw->info.nchannels == 2]
1874 [hw->info.is_signed]
1875 [hw->info.swap_endianness]
1876 [audio_bits_to_index(hw->info.bits)];
1877 }
1878
1879 QLIST_INSERT_HEAD (&s->cap_head, cap, entries);
1880 QLIST_INSERT_HEAD (&cap->cb_head, cb, entries);
1881
1882 QLIST_FOREACH(hw, &s->hw_head_out, entries) {
1883 audio_attach_capture (hw);
1884 }
1885 return cap;
1886 }
1887 }
1888
1889 void AUD_del_capture (CaptureVoiceOut *cap, void *cb_opaque)
1890 {
1891 struct capture_callback *cb;
1892
1893 for (cb = cap->cb_head.lh_first; cb; cb = cb->entries.le_next) {
1894 if (cb->opaque == cb_opaque) {
1895 cb->ops.destroy (cb_opaque);
1896 QLIST_REMOVE (cb, entries);
1897 g_free (cb);
1898
1899 if (!cap->cb_head.lh_first) {
1900 SWVoiceOut *sw = cap->hw.sw_head.lh_first, *sw1;
1901
1902 while (sw) {
1903 SWVoiceCap *sc = (SWVoiceCap *) sw;
1904 #ifdef DEBUG_CAPTURE
1905 dolog ("freeing %s\n", sw->name);
1906 #endif
1907
1908 sw1 = sw->entries.le_next;
1909 if (sw->rate) {
1910 st_rate_stop (sw->rate);
1911 sw->rate = NULL;
1912 }
1913 QLIST_REMOVE (sw, entries);
1914 QLIST_REMOVE (sc, entries);
1915 g_free (sc);
1916 sw = sw1;
1917 }
1918 QLIST_REMOVE (cap, entries);
1919 g_free (cap->hw.mix_buf);
1920 g_free (cap->buf);
1921 g_free (cap);
1922 }
1923 return;
1924 }
1925 }
1926 }
1927
1928 void AUD_set_volume_out (SWVoiceOut *sw, int mute, uint8_t lvol, uint8_t rvol)
1929 {
1930 Volume vol = { .mute = mute, .channels = 2, .vol = { lvol, rvol } };
1931 audio_set_volume_out(sw, &vol);
1932 }
1933
1934 void audio_set_volume_out(SWVoiceOut *sw, Volume *vol)
1935 {
1936 if (sw) {
1937 HWVoiceOut *hw = sw->hw;
1938
1939 sw->vol.mute = vol->mute;
1940 sw->vol.l = nominal_volume.l * vol->vol[0] / 255;
1941 sw->vol.r = nominal_volume.l * vol->vol[vol->channels > 1 ? 1 : 0] /
1942 255;
1943
1944 if (hw->pcm_ops->volume_out) {
1945 hw->pcm_ops->volume_out(hw, vol);
1946 }
1947 }
1948 }
1949
1950 void AUD_set_volume_in (SWVoiceIn *sw, int mute, uint8_t lvol, uint8_t rvol)
1951 {
1952 Volume vol = { .mute = mute, .channels = 2, .vol = { lvol, rvol } };
1953 audio_set_volume_in(sw, &vol);
1954 }
1955
1956 void audio_set_volume_in(SWVoiceIn *sw, Volume *vol)
1957 {
1958 if (sw) {
1959 HWVoiceIn *hw = sw->hw;
1960
1961 sw->vol.mute = vol->mute;
1962 sw->vol.l = nominal_volume.l * vol->vol[0] / 255;
1963 sw->vol.r = nominal_volume.r * vol->vol[vol->channels > 1 ? 1 : 0] /
1964 255;
1965
1966 if (hw->pcm_ops->volume_in) {
1967 hw->pcm_ops->volume_in(hw, vol);
1968 }
1969 }
1970 }
1971
1972 void audio_create_pdos(Audiodev *dev)
1973 {
1974 switch (dev->driver) {
1975 #define CASE(DRIVER, driver, pdo_name) \
1976 case AUDIODEV_DRIVER_##DRIVER: \
1977 if (!dev->u.driver.has_in) { \
1978 dev->u.driver.in = g_malloc0( \
1979 sizeof(Audiodev##pdo_name##PerDirectionOptions)); \
1980 dev->u.driver.has_in = true; \
1981 } \
1982 if (!dev->u.driver.has_out) { \
1983 dev->u.driver.out = g_malloc0( \
1984 sizeof(Audiodev##pdo_name##PerDirectionOptions)); \
1985 dev->u.driver.has_out = true; \
1986 } \
1987 break
1988
1989 CASE(NONE, none, );
1990 CASE(ALSA, alsa, Alsa);
1991 CASE(COREAUDIO, coreaudio, Coreaudio);
1992 CASE(DBUS, dbus, );
1993 CASE(DSOUND, dsound, );
1994 CASE(JACK, jack, Jack);
1995 CASE(OSS, oss, Oss);
1996 CASE(PA, pa, Pa);
1997 CASE(SDL, sdl, Sdl);
1998 CASE(SPICE, spice, );
1999 CASE(WAV, wav, );
2000
2001 case AUDIODEV_DRIVER__MAX:
2002 abort();
2003 };
2004 }
2005
2006 static void audio_validate_per_direction_opts(
2007 AudiodevPerDirectionOptions *pdo, Error **errp)
2008 {
2009 if (!pdo->has_mixing_engine) {
2010 pdo->has_mixing_engine = true;
2011 pdo->mixing_engine = true;
2012 }
2013 if (!pdo->has_fixed_settings) {
2014 pdo->has_fixed_settings = true;
2015 pdo->fixed_settings = pdo->mixing_engine;
2016 }
2017 if (!pdo->fixed_settings &&
2018 (pdo->has_frequency || pdo->has_channels || pdo->has_format)) {
2019 error_setg(errp,
2020 "You can't use frequency, channels or format with fixed-settings=off");
2021 return;
2022 }
2023 if (!pdo->mixing_engine && pdo->fixed_settings) {
2024 error_setg(errp, "You can't use fixed-settings without mixeng");
2025 return;
2026 }
2027
2028 if (!pdo->has_frequency) {
2029 pdo->has_frequency = true;
2030 pdo->frequency = 44100;
2031 }
2032 if (!pdo->has_channels) {
2033 pdo->has_channels = true;
2034 pdo->channels = 2;
2035 }
2036 if (!pdo->has_voices) {
2037 pdo->has_voices = true;
2038 pdo->voices = pdo->mixing_engine ? 1 : INT_MAX;
2039 }
2040 if (!pdo->has_format) {
2041 pdo->has_format = true;
2042 pdo->format = AUDIO_FORMAT_S16;
2043 }
2044 }
2045
2046 static void audio_validate_opts(Audiodev *dev, Error **errp)
2047 {
2048 Error *err = NULL;
2049
2050 audio_create_pdos(dev);
2051
2052 audio_validate_per_direction_opts(audio_get_pdo_in(dev), &err);
2053 if (err) {
2054 error_propagate(errp, err);
2055 return;
2056 }
2057
2058 audio_validate_per_direction_opts(audio_get_pdo_out(dev), &err);
2059 if (err) {
2060 error_propagate(errp, err);
2061 return;
2062 }
2063
2064 if (!dev->has_timer_period) {
2065 dev->has_timer_period = true;
2066 dev->timer_period = 10000; /* 100Hz -> 10ms */
2067 }
2068 }
2069
2070 void audio_parse_option(const char *opt)
2071 {
2072 AudiodevListEntry *e;
2073 Audiodev *dev = NULL;
2074
2075 Visitor *v = qobject_input_visitor_new_str(opt, "driver", &error_fatal);
2076 visit_type_Audiodev(v, NULL, &dev, &error_fatal);
2077 visit_free(v);
2078
2079 audio_validate_opts(dev, &error_fatal);
2080
2081 e = g_malloc0(sizeof(AudiodevListEntry));
2082 e->dev = dev;
2083 QSIMPLEQ_INSERT_TAIL(&audiodevs, e, next);
2084 }
2085
2086 void audio_init_audiodevs(void)
2087 {
2088 AudiodevListEntry *e;
2089
2090 QSIMPLEQ_FOREACH(e, &audiodevs, next) {
2091 audio_init(e->dev, NULL);
2092 }
2093 }
2094
2095 audsettings audiodev_to_audsettings(AudiodevPerDirectionOptions *pdo)
2096 {
2097 return (audsettings) {
2098 .freq = pdo->frequency,
2099 .nchannels = pdo->channels,
2100 .fmt = pdo->format,
2101 .endianness = AUDIO_HOST_ENDIANNESS,
2102 };
2103 }
2104
2105 int audioformat_bytes_per_sample(AudioFormat fmt)
2106 {
2107 switch (fmt) {
2108 case AUDIO_FORMAT_U8:
2109 case AUDIO_FORMAT_S8:
2110 return 1;
2111
2112 case AUDIO_FORMAT_U16:
2113 case AUDIO_FORMAT_S16:
2114 return 2;
2115
2116 case AUDIO_FORMAT_U32:
2117 case AUDIO_FORMAT_S32:
2118 case AUDIO_FORMAT_F32:
2119 return 4;
2120
2121 case AUDIO_FORMAT__MAX:
2122 ;
2123 }
2124 abort();
2125 }
2126
2127
2128 /* frames = freq * usec / 1e6 */
2129 int audio_buffer_frames(AudiodevPerDirectionOptions *pdo,
2130 audsettings *as, int def_usecs)
2131 {
2132 uint64_t usecs = pdo->has_buffer_length ? pdo->buffer_length : def_usecs;
2133 return (as->freq * usecs + 500000) / 1000000;
2134 }
2135
2136 /* samples = channels * frames = channels * freq * usec / 1e6 */
2137 int audio_buffer_samples(AudiodevPerDirectionOptions *pdo,
2138 audsettings *as, int def_usecs)
2139 {
2140 return as->nchannels * audio_buffer_frames(pdo, as, def_usecs);
2141 }
2142
2143 /*
2144 * bytes = bytes_per_sample * samples =
2145 * bytes_per_sample * channels * freq * usec / 1e6
2146 */
2147 int audio_buffer_bytes(AudiodevPerDirectionOptions *pdo,
2148 audsettings *as, int def_usecs)
2149 {
2150 return audio_buffer_samples(pdo, as, def_usecs) *
2151 audioformat_bytes_per_sample(as->fmt);
2152 }
2153
2154 AudioState *audio_state_by_name(const char *name)
2155 {
2156 AudioState *s;
2157 QTAILQ_FOREACH(s, &audio_states, list) {
2158 assert(s->dev);
2159 if (strcmp(name, s->dev->id) == 0) {
2160 return s;
2161 }
2162 }
2163 return NULL;
2164 }
2165
2166 const char *audio_get_id(QEMUSoundCard *card)
2167 {
2168 if (card->state) {
2169 assert(card->state->dev);
2170 return card->state->dev->id;
2171 } else {
2172 return "";
2173 }
2174 }
2175
2176 const char *audio_application_name(void)
2177 {
2178 const char *vm_name;
2179
2180 vm_name = qemu_get_vm_name();
2181 return vm_name ? vm_name : "qemu";
2182 }
2183
2184 void audio_rate_start(RateCtl *rate)
2185 {
2186 memset(rate, 0, sizeof(RateCtl));
2187 rate->start_ticks = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
2188 }
2189
2190 size_t audio_rate_get_bytes(struct audio_pcm_info *info, RateCtl *rate,
2191 size_t bytes_avail)
2192 {
2193 int64_t now;
2194 int64_t ticks;
2195 int64_t bytes;
2196 int64_t samples;
2197 size_t ret;
2198
2199 now = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
2200 ticks = now - rate->start_ticks;
2201 bytes = muldiv64(ticks, info->bytes_per_second, NANOSECONDS_PER_SECOND);
2202 samples = (bytes - rate->bytes_sent) / info->bytes_per_frame;
2203 if (samples < 0 || samples > 65536) {
2204 AUD_log(NULL, "Resetting rate control (%" PRId64 " samples)\n", samples);
2205 audio_rate_start(rate);
2206 samples = 0;
2207 }
2208
2209 ret = MIN(samples * info->bytes_per_frame, bytes_avail);
2210 rate->bytes_sent += ret;
2211 return ret;
2212 }