]> code.delx.au - pulseaudio/blob - src/pulse/volume.c
Style fix: Add a space between the closing/opening bracket
[pulseaudio] / src / pulse / volume.c
1 /***
2 This file is part of PulseAudio.
3
4 Copyright 2004-2006 Lennart Poettering
5
6 PulseAudio is free software; you can redistribute it and/or modify
7 it under the terms of the GNU Lesser General Public License as published
8 by the Free Software Foundation; either version 2.1 of the License,
9 or (at your option) any later version.
10
11 PulseAudio is distributed in the hope that it will be useful, but
12 WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
14 General Public License for more details.
15
16 You should have received a copy of the GNU Lesser General Public License
17 along with PulseAudio; if not, write to the Free Software
18 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
19 USA.
20 ***/
21
22 #ifdef HAVE_CONFIG_H
23 #include <config.h>
24 #endif
25
26 #include <stdio.h>
27 #include <string.h>
28 #include <math.h>
29
30 #include <pulsecore/core-util.h>
31 #include <pulsecore/i18n.h>
32 #include <pulsecore/macro.h>
33 #include <pulsecore/sample-util.h>
34
35 #include "volume.h"
36
37 int pa_cvolume_equal(const pa_cvolume *a, const pa_cvolume *b) {
38 int i;
39 pa_assert(a);
40 pa_assert(b);
41
42 pa_return_val_if_fail(pa_cvolume_valid(a), 0);
43
44 if (PA_UNLIKELY(a == b))
45 return 1;
46
47 pa_return_val_if_fail(pa_cvolume_valid(b), 0);
48
49 if (a->channels != b->channels)
50 return 0;
51
52 for (i = 0; i < a->channels; i++)
53 if (a->values[i] != b->values[i])
54 return 0;
55
56 return 1;
57 }
58
59 pa_cvolume* pa_cvolume_init(pa_cvolume *a) {
60 unsigned c;
61
62 pa_assert(a);
63
64 a->channels = 0;
65
66 for (c = 0; c < PA_CHANNELS_MAX; c++)
67 a->values[c] = PA_VOLUME_INVALID;
68
69 return a;
70 }
71
72 pa_cvolume* pa_cvolume_set(pa_cvolume *a, unsigned channels, pa_volume_t v) {
73 int i;
74
75 pa_assert(a);
76 pa_assert(channels > 0);
77 pa_assert(channels <= PA_CHANNELS_MAX);
78
79 a->channels = (uint8_t) channels;
80
81 for (i = 0; i < a->channels; i++)
82 /* Clamp in case there is stale data that exceeds the current
83 * PA_VOLUME_MAX */
84 a->values[i] = PA_CLAMP_VOLUME(v);
85
86 return a;
87 }
88
89 pa_volume_t pa_cvolume_avg(const pa_cvolume *a) {
90 uint64_t sum = 0;
91 unsigned c;
92
93 pa_assert(a);
94 pa_return_val_if_fail(pa_cvolume_valid(a), PA_VOLUME_MUTED);
95
96 for (c = 0; c < a->channels; c++)
97 sum += a->values[c];
98
99 sum /= a->channels;
100
101 return (pa_volume_t) sum;
102 }
103
104 pa_volume_t pa_cvolume_avg_mask(const pa_cvolume *a, const pa_channel_map *cm, pa_channel_position_mask_t mask) {
105 uint64_t sum = 0;
106 unsigned c, n;
107
108 pa_assert(a);
109
110 if (!cm)
111 return pa_cvolume_avg(a);
112
113 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(a, cm), PA_VOLUME_MUTED);
114
115 for (c = n = 0; c < a->channels; c++) {
116
117 if (!(PA_CHANNEL_POSITION_MASK(cm->map[c]) & mask))
118 continue;
119
120 sum += a->values[c];
121 n ++;
122 }
123
124 if (n > 0)
125 sum /= n;
126
127 return (pa_volume_t) sum;
128 }
129
130 pa_volume_t pa_cvolume_max(const pa_cvolume *a) {
131 pa_volume_t m = PA_VOLUME_MUTED;
132 unsigned c;
133
134 pa_assert(a);
135 pa_return_val_if_fail(pa_cvolume_valid(a), PA_VOLUME_MUTED);
136
137 for (c = 0; c < a->channels; c++)
138 if (a->values[c] > m)
139 m = a->values[c];
140
141 return m;
142 }
143
144 pa_volume_t pa_cvolume_min(const pa_cvolume *a) {
145 pa_volume_t m = PA_VOLUME_MAX;
146 unsigned c;
147
148 pa_assert(a);
149 pa_return_val_if_fail(pa_cvolume_valid(a), PA_VOLUME_MUTED);
150
151 for (c = 0; c < a->channels; c++)
152 if (a->values[c] < m)
153 m = a->values[c];
154
155 return m;
156 }
157
158 pa_volume_t pa_cvolume_max_mask(const pa_cvolume *a, const pa_channel_map *cm, pa_channel_position_mask_t mask) {
159 pa_volume_t m = PA_VOLUME_MUTED;
160 unsigned c;
161
162 pa_assert(a);
163
164 if (!cm)
165 return pa_cvolume_max(a);
166
167 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(a, cm), PA_VOLUME_MUTED);
168
169 for (c = 0; c < a->channels; c++) {
170
171 if (!(PA_CHANNEL_POSITION_MASK(cm->map[c]) & mask))
172 continue;
173
174 if (a->values[c] > m)
175 m = a->values[c];
176 }
177
178 return m;
179 }
180
181 pa_volume_t pa_cvolume_min_mask(const pa_cvolume *a, const pa_channel_map *cm, pa_channel_position_mask_t mask) {
182 pa_volume_t m = PA_VOLUME_MAX;
183 unsigned c;
184
185 pa_assert(a);
186
187 if (!cm)
188 return pa_cvolume_min(a);
189
190 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(a, cm), PA_VOLUME_MUTED);
191
192 for (c = 0; c < a->channels; c++) {
193
194 if (!(PA_CHANNEL_POSITION_MASK(cm->map[c]) & mask))
195 continue;
196
197 if (a->values[c] < m)
198 m = a->values[c];
199 }
200
201 return m;
202 }
203
204 pa_volume_t pa_sw_volume_multiply(pa_volume_t a, pa_volume_t b) {
205
206 pa_return_val_if_fail(PA_VOLUME_IS_VALID(a), PA_VOLUME_INVALID);
207 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), PA_VOLUME_INVALID);
208
209 /* cbrt((a/PA_VOLUME_NORM)^3*(b/PA_VOLUME_NORM)^3)*PA_VOLUME_NORM = a*b/PA_VOLUME_NORM */
210
211 return (pa_volume_t) PA_CLAMP_VOLUME((((uint64_t) a * (uint64_t) b + (uint64_t) PA_VOLUME_NORM / 2ULL) / (uint64_t) PA_VOLUME_NORM));
212 }
213
214 pa_volume_t pa_sw_volume_divide(pa_volume_t a, pa_volume_t b) {
215
216 pa_return_val_if_fail(PA_VOLUME_IS_VALID(a), PA_VOLUME_INVALID);
217 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), PA_VOLUME_INVALID);
218
219 if (b <= PA_VOLUME_MUTED)
220 return 0;
221
222 return (pa_volume_t) (((uint64_t) a * (uint64_t) PA_VOLUME_NORM + (uint64_t) b / 2ULL) / (uint64_t) b);
223 }
224
225 /* Amplitude, not power */
226 static double linear_to_dB(double v) {
227 return 20.0 * log10(v);
228 }
229
230 static double dB_to_linear(double v) {
231 return pow(10.0, v / 20.0);
232 }
233
234 pa_volume_t pa_sw_volume_from_dB(double dB) {
235 if (isinf(dB) < 0 || dB <= PA_DECIBEL_MININFTY)
236 return PA_VOLUME_MUTED;
237
238 return pa_sw_volume_from_linear(dB_to_linear(dB));
239 }
240
241 double pa_sw_volume_to_dB(pa_volume_t v) {
242
243 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), PA_DECIBEL_MININFTY);
244
245 if (v <= PA_VOLUME_MUTED)
246 return PA_DECIBEL_MININFTY;
247
248 return linear_to_dB(pa_sw_volume_to_linear(v));
249 }
250
251 pa_volume_t pa_sw_volume_from_linear(double v) {
252
253 if (v <= 0.0)
254 return PA_VOLUME_MUTED;
255
256 /*
257 * We use a cubic mapping here, as suggested and discussed here:
258 *
259 * http://www.robotplanet.dk/audio/audio_gui_design/
260 * http://lists.linuxaudio.org/pipermail/linux-audio-dev/2009-May/thread.html#23151
261 *
262 * We make sure that the conversion to linear and back yields the
263 * same volume value! That's why we need the lround() below!
264 */
265
266 return (pa_volume_t) PA_CLAMP_VOLUME((uint64_t) lround(cbrt(v) * PA_VOLUME_NORM));
267 }
268
269 double pa_sw_volume_to_linear(pa_volume_t v) {
270 double f;
271
272 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), 0.0);
273
274 if (v <= PA_VOLUME_MUTED)
275 return 0.0;
276
277 if (v == PA_VOLUME_NORM)
278 return 1.0;
279
280 f = ((double) v / PA_VOLUME_NORM);
281
282 return f*f*f;
283 }
284
285 char *pa_cvolume_snprint(char *s, size_t l, const pa_cvolume *c) {
286 unsigned channel;
287 pa_bool_t first = TRUE;
288 char *e;
289
290 pa_assert(s);
291 pa_assert(l > 0);
292 pa_assert(c);
293
294 pa_init_i18n();
295
296 if (!pa_cvolume_valid(c)) {
297 pa_snprintf(s, l, _("(invalid)"));
298 return s;
299 }
300
301 *(e = s) = 0;
302
303 for (channel = 0; channel < c->channels && l > 1; channel++) {
304 l -= pa_snprintf(e, l, "%s%u: %3u%%",
305 first ? "" : " ",
306 channel,
307 (c->values[channel]*100+PA_VOLUME_NORM/2)/PA_VOLUME_NORM);
308
309 e = strchr(e, 0);
310 first = FALSE;
311 }
312
313 return s;
314 }
315
316 char *pa_volume_snprint(char *s, size_t l, pa_volume_t v) {
317 pa_assert(s);
318 pa_assert(l > 0);
319
320 pa_init_i18n();
321
322 if (!PA_VOLUME_IS_VALID(v)) {
323 pa_snprintf(s, l, _("(invalid)"));
324 return s;
325 }
326
327 pa_snprintf(s, l, "%3u%%", (v*100+PA_VOLUME_NORM/2)/PA_VOLUME_NORM);
328 return s;
329 }
330
331 char *pa_sw_cvolume_snprint_dB(char *s, size_t l, const pa_cvolume *c) {
332 unsigned channel;
333 pa_bool_t first = TRUE;
334 char *e;
335
336 pa_assert(s);
337 pa_assert(l > 0);
338 pa_assert(c);
339
340 pa_init_i18n();
341
342 if (!pa_cvolume_valid(c)) {
343 pa_snprintf(s, l, _("(invalid)"));
344 return s;
345 }
346
347 *(e = s) = 0;
348
349 for (channel = 0; channel < c->channels && l > 1; channel++) {
350 double f = pa_sw_volume_to_dB(c->values[channel]);
351
352 l -= pa_snprintf(e, l, "%s%u: %0.2f dB",
353 first ? "" : " ",
354 channel,
355 isinf(f) < 0 || f <= PA_DECIBEL_MININFTY ? -INFINITY : f);
356
357 e = strchr(e, 0);
358 first = FALSE;
359 }
360
361 return s;
362 }
363
364 char *pa_sw_volume_snprint_dB(char *s, size_t l, pa_volume_t v) {
365 double f;
366
367 pa_assert(s);
368 pa_assert(l > 0);
369
370 pa_init_i18n();
371
372 if (!PA_VOLUME_IS_VALID(v)) {
373 pa_snprintf(s, l, _("(invalid)"));
374 return s;
375 }
376
377 f = pa_sw_volume_to_dB(v);
378 pa_snprintf(s, l, "%0.2f dB", isinf(f) < 0 || f <= PA_DECIBEL_MININFTY ? -INFINITY : f);
379
380 return s;
381 }
382
383 int pa_cvolume_channels_equal_to(const pa_cvolume *a, pa_volume_t v) {
384 unsigned c;
385 pa_assert(a);
386
387 pa_return_val_if_fail(pa_cvolume_valid(a), 0);
388 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), 0);
389
390 for (c = 0; c < a->channels; c++)
391 if (a->values[c] != v)
392 return 0;
393
394 return 1;
395 }
396
397 pa_cvolume *pa_sw_cvolume_multiply(pa_cvolume *dest, const pa_cvolume *a, const pa_cvolume *b) {
398 unsigned i;
399
400 pa_assert(dest);
401 pa_assert(a);
402 pa_assert(b);
403
404 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
405 pa_return_val_if_fail(pa_cvolume_valid(b), NULL);
406
407 for (i = 0; i < a->channels && i < b->channels; i++)
408 dest->values[i] = pa_sw_volume_multiply(a->values[i], b->values[i]);
409
410 dest->channels = (uint8_t) i;
411
412 return dest;
413 }
414
415 pa_cvolume *pa_sw_cvolume_multiply_scalar(pa_cvolume *dest, const pa_cvolume *a, pa_volume_t b) {
416 unsigned i;
417
418 pa_assert(dest);
419 pa_assert(a);
420
421 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
422 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), NULL);
423
424 for (i = 0; i < a->channels; i++)
425 dest->values[i] = pa_sw_volume_multiply(a->values[i], b);
426
427 dest->channels = (uint8_t) i;
428
429 return dest;
430 }
431
432 pa_cvolume *pa_sw_cvolume_divide(pa_cvolume *dest, const pa_cvolume *a, const pa_cvolume *b) {
433 unsigned i;
434
435 pa_assert(dest);
436 pa_assert(a);
437 pa_assert(b);
438
439 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
440 pa_return_val_if_fail(pa_cvolume_valid(b), NULL);
441
442 for (i = 0; i < a->channels && i < b->channels; i++)
443 dest->values[i] = pa_sw_volume_divide(a->values[i], b->values[i]);
444
445 dest->channels = (uint8_t) i;
446
447 return dest;
448 }
449
450 pa_cvolume *pa_sw_cvolume_divide_scalar(pa_cvolume *dest, const pa_cvolume *a, pa_volume_t b) {
451 unsigned i;
452
453 pa_assert(dest);
454 pa_assert(a);
455
456 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
457 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), NULL);
458
459 for (i = 0; i < a->channels; i++)
460 dest->values[i] = pa_sw_volume_divide(a->values[i], b);
461
462 dest->channels = (uint8_t) i;
463
464 return dest;
465 }
466
467 int pa_cvolume_valid(const pa_cvolume *v) {
468 unsigned c;
469
470 pa_assert(v);
471
472 if (v->channels <= 0 || v->channels > PA_CHANNELS_MAX)
473 return 0;
474
475 for (c = 0; c < v->channels; c++)
476 if (!PA_VOLUME_IS_VALID(v->values[c]))
477 return 0;
478
479 return 1;
480 }
481
482 static pa_bool_t on_left(pa_channel_position_t p) {
483 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_LEFT);
484 }
485
486 static pa_bool_t on_right(pa_channel_position_t p) {
487 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_RIGHT);
488 }
489
490 static pa_bool_t on_center(pa_channel_position_t p) {
491 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_CENTER);
492 }
493
494 static pa_bool_t on_lfe(pa_channel_position_t p) {
495 return p == PA_CHANNEL_POSITION_LFE;
496 }
497
498 static pa_bool_t on_front(pa_channel_position_t p) {
499 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_FRONT);
500 }
501
502 static pa_bool_t on_rear(pa_channel_position_t p) {
503 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_REAR);
504 }
505
506 pa_cvolume *pa_cvolume_remap(pa_cvolume *v, const pa_channel_map *from, const pa_channel_map *to) {
507 int a, b;
508 pa_cvolume result;
509
510 pa_assert(v);
511 pa_assert(from);
512 pa_assert(to);
513
514 pa_return_val_if_fail(pa_channel_map_valid(to), NULL);
515 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, from), NULL);
516
517 if (pa_channel_map_equal(from, to))
518 return v;
519
520 result.channels = to->channels;
521
522 for (b = 0; b < to->channels; b++) {
523 pa_volume_t k = 0;
524 int n = 0;
525
526 for (a = 0; a < from->channels; a++)
527 if (from->map[a] == to->map[b]) {
528 k += v->values[a];
529 n ++;
530 }
531
532 if (n <= 0) {
533 for (a = 0; a < from->channels; a++)
534 if ((on_left(from->map[a]) && on_left(to->map[b])) ||
535 (on_right(from->map[a]) && on_right(to->map[b])) ||
536 (on_center(from->map[a]) && on_center(to->map[b])) ||
537 (on_lfe(from->map[a]) && on_lfe(to->map[b]))) {
538
539 k += v->values[a];
540 n ++;
541 }
542 }
543
544 if (n <= 0)
545 k = pa_cvolume_avg(v);
546 else
547 k /= n;
548
549 result.values[b] = k;
550 }
551
552 *v = result;
553 return v;
554 }
555
556 int pa_cvolume_compatible(const pa_cvolume *v, const pa_sample_spec *ss) {
557
558 pa_assert(v);
559 pa_assert(ss);
560
561 pa_return_val_if_fail(pa_cvolume_valid(v), 0);
562 pa_return_val_if_fail(pa_sample_spec_valid(ss), 0);
563
564 return v->channels == ss->channels;
565 }
566
567 int pa_cvolume_compatible_with_channel_map(const pa_cvolume *v, const pa_channel_map *cm) {
568 pa_assert(v);
569 pa_assert(cm);
570
571 pa_return_val_if_fail(pa_cvolume_valid(v), 0);
572 pa_return_val_if_fail(pa_channel_map_valid(cm), 0);
573
574 return v->channels == cm->channels;
575 }
576
577 static void get_avg_lr(const pa_channel_map *map, const pa_cvolume *v, pa_volume_t *l, pa_volume_t *r) {
578 int c;
579 pa_volume_t left = 0, right = 0;
580 unsigned n_left = 0, n_right = 0;
581
582 pa_assert(v);
583 pa_assert(map);
584 pa_assert(map->channels == v->channels);
585 pa_assert(l);
586 pa_assert(r);
587
588 for (c = 0; c < map->channels; c++) {
589 if (on_left(map->map[c])) {
590 left += v->values[c];
591 n_left++;
592 } else if (on_right(map->map[c])) {
593 right += v->values[c];
594 n_right++;
595 }
596 }
597
598 if (n_left <= 0)
599 *l = PA_VOLUME_NORM;
600 else
601 *l = left / n_left;
602
603 if (n_right <= 0)
604 *r = PA_VOLUME_NORM;
605 else
606 *r = right / n_right;
607 }
608
609 float pa_cvolume_get_balance(const pa_cvolume *v, const pa_channel_map *map) {
610 pa_volume_t left, right;
611
612 pa_assert(v);
613 pa_assert(map);
614
615 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), 0.0f);
616
617 if (!pa_channel_map_can_balance(map))
618 return 0.0f;
619
620 get_avg_lr(map, v, &left, &right);
621
622 if (left == right)
623 return 0.0f;
624
625 /* 1.0, 0.0 => -1.0
626 0.0, 1.0 => 1.0
627 0.0, 0.0 => 0.0
628 0.5, 0.5 => 0.0
629 1.0, 0.5 => -0.5
630 1.0, 0.25 => -0.75
631 0.75, 0.25 => -0.66
632 0.5, 0.25 => -0.5 */
633
634 if (left > right)
635 return -1.0f + ((float) right / (float) left);
636 else
637 return 1.0f - ((float) left / (float) right);
638 }
639
640 pa_cvolume* pa_cvolume_set_balance(pa_cvolume *v, const pa_channel_map *map, float new_balance) {
641 pa_volume_t left, nleft, right, nright, m;
642 unsigned c;
643
644 pa_assert(map);
645 pa_assert(v);
646
647 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), NULL);
648 pa_return_val_if_fail(new_balance >= -1.0f, NULL);
649 pa_return_val_if_fail(new_balance <= 1.0f, NULL);
650
651 if (!pa_channel_map_can_balance(map))
652 return v;
653
654 get_avg_lr(map, v, &left, &right);
655
656 m = PA_MAX(left, right);
657
658 if (new_balance <= 0) {
659 nright = (new_balance + 1.0f) * m;
660 nleft = m;
661 } else {
662 nleft = (1.0f - new_balance) * m;
663 nright = m;
664 }
665
666 for (c = 0; c < map->channels; c++) {
667 if (on_left(map->map[c])) {
668 if (left == 0)
669 v->values[c] = nleft;
670 else
671 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nleft) / (uint64_t) left);
672 } else if (on_right(map->map[c])) {
673 if (right == 0)
674 v->values[c] = nright;
675 else
676 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nright) / (uint64_t) right);
677 }
678 }
679
680 return v;
681 }
682
683 pa_cvolume* pa_cvolume_scale(pa_cvolume *v, pa_volume_t max) {
684 unsigned c;
685 pa_volume_t t = 0;
686
687 pa_assert(v);
688
689 pa_return_val_if_fail(pa_cvolume_valid(v), NULL);
690 pa_return_val_if_fail(PA_VOLUME_IS_VALID(max), NULL);
691
692 t = pa_cvolume_max(v);
693
694 if (t <= PA_VOLUME_MUTED)
695 return pa_cvolume_set(v, v->channels, max);
696
697 for (c = 0; c < v->channels; c++)
698 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) max) / (uint64_t) t);
699
700 return v;
701 }
702
703 pa_cvolume* pa_cvolume_scale_mask(pa_cvolume *v, pa_volume_t max, pa_channel_map *cm, pa_channel_position_mask_t mask) {
704 unsigned c;
705 pa_volume_t t = 0;
706
707 pa_assert(v);
708
709 pa_return_val_if_fail(PA_VOLUME_IS_VALID(max), NULL);
710
711 if (!cm)
712 return pa_cvolume_scale(v, max);
713
714 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, cm), NULL);
715
716 t = pa_cvolume_max_mask(v, cm, mask);
717
718 if (t <= PA_VOLUME_MUTED)
719 return pa_cvolume_set(v, v->channels, max);
720
721 for (c = 0; c < v->channels; c++)
722 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) max) / (uint64_t) t);
723
724 return v;
725 }
726
727 static void get_avg_fr(const pa_channel_map *map, const pa_cvolume *v, pa_volume_t *f, pa_volume_t *r) {
728 int c;
729 pa_volume_t front = 0, rear = 0;
730 unsigned n_front = 0, n_rear = 0;
731
732 pa_assert(v);
733 pa_assert(map);
734 pa_assert(map->channels == v->channels);
735 pa_assert(f);
736 pa_assert(r);
737
738 for (c = 0; c < map->channels; c++) {
739 if (on_front(map->map[c])) {
740 front += v->values[c];
741 n_front++;
742 } else if (on_rear(map->map[c])) {
743 rear += v->values[c];
744 n_rear++;
745 }
746 }
747
748 if (n_front <= 0)
749 *f = PA_VOLUME_NORM;
750 else
751 *f = front / n_front;
752
753 if (n_rear <= 0)
754 *r = PA_VOLUME_NORM;
755 else
756 *r = rear / n_rear;
757 }
758
759 float pa_cvolume_get_fade(const pa_cvolume *v, const pa_channel_map *map) {
760 pa_volume_t front, rear;
761
762 pa_assert(v);
763 pa_assert(map);
764
765 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), 0.0f);
766
767 if (!pa_channel_map_can_fade(map))
768 return 0.0f;
769
770 get_avg_fr(map, v, &front, &rear);
771
772 if (front == rear)
773 return 0.0f;
774
775 if (rear > front)
776 return -1.0f + ((float) front / (float) rear);
777 else
778 return 1.0f - ((float) rear / (float) front);
779 }
780
781 pa_cvolume* pa_cvolume_set_fade(pa_cvolume *v, const pa_channel_map *map, float new_fade) {
782 pa_volume_t front, nfront, rear, nrear, m;
783 unsigned c;
784
785 pa_assert(map);
786 pa_assert(v);
787
788 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), NULL);
789 pa_return_val_if_fail(new_fade >= -1.0f, NULL);
790 pa_return_val_if_fail(new_fade <= 1.0f, NULL);
791
792 if (!pa_channel_map_can_fade(map))
793 return v;
794
795 get_avg_fr(map, v, &front, &rear);
796
797 m = PA_MAX(front, rear);
798
799 if (new_fade <= 0) {
800 nfront = (new_fade + 1.0f) * m;
801 nrear = m;
802 } else {
803 nrear = (1.0f - new_fade) * m;
804 nfront = m;
805 }
806
807 for (c = 0; c < map->channels; c++) {
808 if (on_front(map->map[c])) {
809 if (front == 0)
810 v->values[c] = nfront;
811 else
812 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nfront) / (uint64_t) front);
813 } else if (on_rear(map->map[c])) {
814 if (rear == 0)
815 v->values[c] = nrear;
816 else
817 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nrear) / (uint64_t) rear);
818 }
819 }
820
821 return v;
822 }
823
824 pa_cvolume* pa_cvolume_set_position(
825 pa_cvolume *cv,
826 const pa_channel_map *map,
827 pa_channel_position_t t,
828 pa_volume_t v) {
829
830 unsigned c;
831 pa_bool_t good = FALSE;
832
833 pa_assert(cv);
834 pa_assert(map);
835
836 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(cv, map), NULL);
837 pa_return_val_if_fail(t < PA_CHANNEL_POSITION_MAX, NULL);
838 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), NULL);
839
840 for (c = 0; c < map->channels; c++)
841 if (map->map[c] == t) {
842 cv->values[c] = v;
843 good = TRUE;
844 }
845
846 return good ? cv : NULL;
847 }
848
849 pa_volume_t pa_cvolume_get_position(
850 pa_cvolume *cv,
851 const pa_channel_map *map,
852 pa_channel_position_t t) {
853
854 unsigned c;
855 pa_volume_t v = PA_VOLUME_MUTED;
856
857 pa_assert(cv);
858 pa_assert(map);
859
860 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(cv, map), PA_VOLUME_MUTED);
861 pa_return_val_if_fail(t < PA_CHANNEL_POSITION_MAX, PA_VOLUME_MUTED);
862
863 for (c = 0; c < map->channels; c++)
864 if (map->map[c] == t)
865 if (cv->values[c] > v)
866 v = cv->values[c];
867
868 return v;
869 }
870
871 pa_cvolume* pa_cvolume_merge(pa_cvolume *dest, const pa_cvolume *a, const pa_cvolume *b) {
872 unsigned i;
873
874 pa_assert(dest);
875 pa_assert(a);
876 pa_assert(b);
877
878 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
879 pa_return_val_if_fail(pa_cvolume_valid(b), NULL);
880
881 for (i = 0; i < a->channels && i < b->channels; i++)
882 dest->values[i] = PA_MAX(a->values[i], b->values[i]);
883
884 dest->channels = (uint8_t) i;
885
886 return dest;
887 }
888
889 pa_cvolume* pa_cvolume_inc_clamp(pa_cvolume *v, pa_volume_t inc, pa_volume_t limit) {
890 pa_volume_t m;
891
892 pa_assert(v);
893
894 pa_return_val_if_fail(pa_cvolume_valid(v), NULL);
895 pa_return_val_if_fail(PA_VOLUME_IS_VALID(inc), NULL);
896
897 m = pa_cvolume_max(v);
898
899 if (m >= limit - inc)
900 m = limit;
901 else
902 m += inc;
903
904 return pa_cvolume_scale(v, m);
905 }
906
907 pa_cvolume* pa_cvolume_inc(pa_cvolume *v, pa_volume_t inc) {
908 return pa_cvolume_inc_clamp(v, inc, PA_VOLUME_MAX);
909 }
910
911 pa_cvolume* pa_cvolume_dec(pa_cvolume *v, pa_volume_t dec) {
912 pa_volume_t m;
913
914 pa_assert(v);
915
916 pa_return_val_if_fail(pa_cvolume_valid(v), NULL);
917 pa_return_val_if_fail(PA_VOLUME_IS_VALID(dec), NULL);
918
919 m = pa_cvolume_max(v);
920
921 if (m <= PA_VOLUME_MUTED + dec)
922 m = PA_VOLUME_MUTED;
923 else
924 m -= dec;
925
926 return pa_cvolume_scale(v, m);
927 }