]> code.delx.au - pulseaudio/blob - src/pulse/volume.c
volume: Clamp volume to PA_VOLUME_MAX
[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
29 #include <pulse/i18n.h>
30
31 #include <pulsecore/core-util.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(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",
379 isinf(f) < 0 || f <= PA_DECIBEL_MININFTY ? -INFINITY : f);
380
381 return s;
382 }
383
384 int pa_cvolume_channels_equal_to(const pa_cvolume *a, pa_volume_t v) {
385 unsigned c;
386 pa_assert(a);
387
388 pa_return_val_if_fail(pa_cvolume_valid(a), 0);
389 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), 0);
390
391 for (c = 0; c < a->channels; c++)
392 if (a->values[c] != v)
393 return 0;
394
395 return 1;
396 }
397
398 pa_cvolume *pa_sw_cvolume_multiply(pa_cvolume *dest, const pa_cvolume *a, const pa_cvolume *b) {
399 unsigned i;
400
401 pa_assert(dest);
402 pa_assert(a);
403 pa_assert(b);
404
405 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
406 pa_return_val_if_fail(pa_cvolume_valid(b), NULL);
407
408 for (i = 0; i < a->channels && i < b->channels; i++)
409 dest->values[i] = pa_sw_volume_multiply(a->values[i], b->values[i]);
410
411 dest->channels = (uint8_t) i;
412
413 return dest;
414 }
415
416 pa_cvolume *pa_sw_cvolume_multiply_scalar(pa_cvolume *dest, const pa_cvolume *a, pa_volume_t b) {
417 unsigned i;
418
419 pa_assert(dest);
420 pa_assert(a);
421
422 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
423 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), NULL);
424
425 for (i = 0; i < a->channels; i++)
426 dest->values[i] = pa_sw_volume_multiply(a->values[i], b);
427
428 dest->channels = (uint8_t) i;
429
430 return dest;
431 }
432
433 pa_cvolume *pa_sw_cvolume_divide(pa_cvolume *dest, const pa_cvolume *a, const pa_cvolume *b) {
434 unsigned i;
435
436 pa_assert(dest);
437 pa_assert(a);
438 pa_assert(b);
439
440 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
441 pa_return_val_if_fail(pa_cvolume_valid(b), NULL);
442
443 for (i = 0; i < a->channels && i < b->channels; i++)
444 dest->values[i] = pa_sw_volume_divide(a->values[i], b->values[i]);
445
446 dest->channels = (uint8_t) i;
447
448 return dest;
449 }
450
451 pa_cvolume *pa_sw_cvolume_divide_scalar(pa_cvolume *dest, const pa_cvolume *a, pa_volume_t b) {
452 unsigned i;
453
454 pa_assert(dest);
455 pa_assert(a);
456
457 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
458 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), NULL);
459
460 for (i = 0; i < a->channels; i++)
461 dest->values[i] = pa_sw_volume_divide(a->values[i], b);
462
463 dest->channels = (uint8_t) i;
464
465 return dest;
466 }
467
468 int pa_cvolume_valid(const pa_cvolume *v) {
469 unsigned c;
470
471 pa_assert(v);
472
473 if (v->channels <= 0 || v->channels > PA_CHANNELS_MAX)
474 return 0;
475
476 for (c = 0; c < v->channels; c++)
477 if (!PA_VOLUME_IS_VALID(v->values[c]))
478 return 0;
479
480 return 1;
481 }
482
483 static pa_bool_t on_left(pa_channel_position_t p) {
484 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_LEFT);
485 }
486
487 static pa_bool_t on_right(pa_channel_position_t p) {
488 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_RIGHT);
489 }
490
491 static pa_bool_t on_center(pa_channel_position_t p) {
492 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_CENTER);
493 }
494
495 static pa_bool_t on_lfe(pa_channel_position_t p) {
496 return p == PA_CHANNEL_POSITION_LFE;
497 }
498
499 static pa_bool_t on_front(pa_channel_position_t p) {
500 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_FRONT);
501 }
502
503 static pa_bool_t on_rear(pa_channel_position_t p) {
504 return !!(PA_CHANNEL_POSITION_MASK(p) & PA_CHANNEL_POSITION_MASK_REAR);
505 }
506
507 pa_cvolume *pa_cvolume_remap(pa_cvolume *v, const pa_channel_map *from, const pa_channel_map *to) {
508 int a, b;
509 pa_cvolume result;
510
511 pa_assert(v);
512 pa_assert(from);
513 pa_assert(to);
514
515 pa_return_val_if_fail(pa_channel_map_valid(to), NULL);
516 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, from), NULL);
517
518 if (pa_channel_map_equal(from, to))
519 return v;
520
521 result.channels = to->channels;
522
523 for (b = 0; b < to->channels; b++) {
524 pa_volume_t k = 0;
525 int n = 0;
526
527 for (a = 0; a < from->channels; a++)
528 if (from->map[a] == to->map[b]) {
529 k += v->values[a];
530 n ++;
531 }
532
533 if (n <= 0) {
534 for (a = 0; a < from->channels; a++)
535 if ((on_left(from->map[a]) && on_left(to->map[b])) ||
536 (on_right(from->map[a]) && on_right(to->map[b])) ||
537 (on_center(from->map[a]) && on_center(to->map[b])) ||
538 (on_lfe(from->map[a]) && on_lfe(to->map[b]))) {
539
540 k += v->values[a];
541 n ++;
542 }
543 }
544
545 if (n <= 0)
546 k = pa_cvolume_avg(v);
547 else
548 k /= n;
549
550 result.values[b] = k;
551 }
552
553 *v = result;
554 return v;
555 }
556
557 int pa_cvolume_compatible(const pa_cvolume *v, const pa_sample_spec *ss) {
558
559 pa_assert(v);
560 pa_assert(ss);
561
562 pa_return_val_if_fail(pa_cvolume_valid(v), 0);
563 pa_return_val_if_fail(pa_sample_spec_valid(ss), 0);
564
565 return v->channels == ss->channels;
566 }
567
568 int pa_cvolume_compatible_with_channel_map(const pa_cvolume *v, const pa_channel_map *cm) {
569 pa_assert(v);
570 pa_assert(cm);
571
572 pa_return_val_if_fail(pa_cvolume_valid(v), 0);
573 pa_return_val_if_fail(pa_channel_map_valid(cm), 0);
574
575 return v->channels == cm->channels;
576 }
577
578 static void get_avg_lr(const pa_channel_map *map, const pa_cvolume *v, pa_volume_t *l, pa_volume_t *r) {
579 int c;
580 pa_volume_t left = 0, right = 0;
581 unsigned n_left = 0, n_right = 0;
582
583 pa_assert(v);
584 pa_assert(map);
585 pa_assert(map->channels == v->channels);
586 pa_assert(l);
587 pa_assert(r);
588
589 for (c = 0; c < map->channels; c++) {
590 if (on_left(map->map[c])) {
591 left += v->values[c];
592 n_left++;
593 } else if (on_right(map->map[c])) {
594 right += v->values[c];
595 n_right++;
596 }
597 }
598
599 if (n_left <= 0)
600 *l = PA_VOLUME_NORM;
601 else
602 *l = left / n_left;
603
604 if (n_right <= 0)
605 *r = PA_VOLUME_NORM;
606 else
607 *r = right / n_right;
608 }
609
610 float pa_cvolume_get_balance(const pa_cvolume *v, const pa_channel_map *map) {
611 pa_volume_t left, right;
612
613 pa_assert(v);
614 pa_assert(map);
615
616 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), 0.0f);
617
618 if (!pa_channel_map_can_balance(map))
619 return 0.0f;
620
621 get_avg_lr(map, v, &left, &right);
622
623 if (left == right)
624 return 0.0f;
625
626 /* 1.0, 0.0 => -1.0
627 0.0, 1.0 => 1.0
628 0.0, 0.0 => 0.0
629 0.5, 0.5 => 0.0
630 1.0, 0.5 => -0.5
631 1.0, 0.25 => -0.75
632 0.75, 0.25 => -0.66
633 0.5, 0.25 => -0.5 */
634
635 if (left > right)
636 return -1.0f + ((float) right / (float) left);
637 else
638 return 1.0f - ((float) left / (float) right);
639 }
640
641 pa_cvolume* pa_cvolume_set_balance(pa_cvolume *v, const pa_channel_map *map, float new_balance) {
642 pa_volume_t left, nleft, right, nright, m;
643 unsigned c;
644
645 pa_assert(map);
646 pa_assert(v);
647
648 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), NULL);
649 pa_return_val_if_fail(new_balance >= -1.0f, NULL);
650 pa_return_val_if_fail(new_balance <= 1.0f, NULL);
651
652 if (!pa_channel_map_can_balance(map))
653 return v;
654
655 get_avg_lr(map, v, &left, &right);
656
657 m = PA_MAX(left, right);
658
659 if (new_balance <= 0) {
660 nright = (new_balance + 1.0f) * m;
661 nleft = m;
662 } else {
663 nleft = (1.0f - new_balance) * m;
664 nright = m;
665 }
666
667 for (c = 0; c < map->channels; c++) {
668 if (on_left(map->map[c])) {
669 if (left == 0)
670 v->values[c] = nleft;
671 else
672 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nleft) / (uint64_t) left);
673 } else if (on_right(map->map[c])) {
674 if (right == 0)
675 v->values[c] = nright;
676 else
677 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nright) / (uint64_t) right);
678 }
679 }
680
681 return v;
682 }
683
684 pa_cvolume* pa_cvolume_scale(pa_cvolume *v, pa_volume_t max) {
685 unsigned c;
686 pa_volume_t t = 0;
687
688 pa_assert(v);
689
690 pa_return_val_if_fail(pa_cvolume_valid(v), NULL);
691 pa_return_val_if_fail(PA_VOLUME_IS_VALID(max), NULL);
692
693 t = pa_cvolume_max(v);
694
695 if (t <= PA_VOLUME_MUTED)
696 return pa_cvolume_set(v, v->channels, max);
697
698 for (c = 0; c < v->channels; c++)
699 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) max) / (uint64_t) t);
700
701 return v;
702 }
703
704 pa_cvolume* pa_cvolume_scale_mask(pa_cvolume *v, pa_volume_t max, pa_channel_map *cm, pa_channel_position_mask_t mask) {
705 unsigned c;
706 pa_volume_t t = 0;
707
708 pa_assert(v);
709
710 pa_return_val_if_fail(PA_VOLUME_IS_VALID(max), NULL);
711
712 if (!cm)
713 return pa_cvolume_scale(v, max);
714
715 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, cm), NULL);
716
717 t = pa_cvolume_max_mask(v, cm, mask);
718
719 if (t <= PA_VOLUME_MUTED)
720 return pa_cvolume_set(v, v->channels, max);
721
722 for (c = 0; c < v->channels; c++)
723 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) max) / (uint64_t) t);
724
725 return v;
726 }
727
728 static void get_avg_fr(const pa_channel_map *map, const pa_cvolume *v, pa_volume_t *f, pa_volume_t *r) {
729 int c;
730 pa_volume_t front = 0, rear = 0;
731 unsigned n_front = 0, n_rear = 0;
732
733 pa_assert(v);
734 pa_assert(map);
735 pa_assert(map->channels == v->channels);
736 pa_assert(f);
737 pa_assert(r);
738
739 for (c = 0; c < map->channels; c++) {
740 if (on_front(map->map[c])) {
741 front += v->values[c];
742 n_front++;
743 } else if (on_rear(map->map[c])) {
744 rear += v->values[c];
745 n_rear++;
746 }
747 }
748
749 if (n_front <= 0)
750 *f = PA_VOLUME_NORM;
751 else
752 *f = front / n_front;
753
754 if (n_rear <= 0)
755 *r = PA_VOLUME_NORM;
756 else
757 *r = rear / n_rear;
758 }
759
760 float pa_cvolume_get_fade(const pa_cvolume *v, const pa_channel_map *map) {
761 pa_volume_t front, rear;
762
763 pa_assert(v);
764 pa_assert(map);
765
766 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), 0.0f);
767
768 if (!pa_channel_map_can_fade(map))
769 return 0.0f;
770
771 get_avg_fr(map, v, &front, &rear);
772
773 if (front == rear)
774 return 0.0f;
775
776 if (rear > front)
777 return -1.0f + ((float) front / (float) rear);
778 else
779 return 1.0f - ((float) rear / (float) front);
780 }
781
782 pa_cvolume* pa_cvolume_set_fade(pa_cvolume *v, const pa_channel_map *map, float new_fade) {
783 pa_volume_t front, nfront, rear, nrear, m;
784 unsigned c;
785
786 pa_assert(map);
787 pa_assert(v);
788
789 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(v, map), NULL);
790 pa_return_val_if_fail(new_fade >= -1.0f, NULL);
791 pa_return_val_if_fail(new_fade <= 1.0f, NULL);
792
793 if (!pa_channel_map_can_fade(map))
794 return v;
795
796 get_avg_fr(map, v, &front, &rear);
797
798 m = PA_MAX(front, rear);
799
800 if (new_fade <= 0) {
801 nfront = (new_fade + 1.0f) * m;
802 nrear = m;
803 } else {
804 nrear = (1.0f - new_fade) * m;
805 nfront = m;
806 }
807
808 for (c = 0; c < map->channels; c++) {
809 if (on_front(map->map[c])) {
810 if (front == 0)
811 v->values[c] = nfront;
812 else
813 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nfront) / (uint64_t) front);
814 } else if (on_rear(map->map[c])) {
815 if (rear == 0)
816 v->values[c] = nrear;
817 else
818 v->values[c] = (pa_volume_t) PA_CLAMP_VOLUME(((uint64_t) v->values[c] * (uint64_t) nrear) / (uint64_t) rear);
819 }
820 }
821
822 return v;
823 }
824
825 pa_cvolume* pa_cvolume_set_position(
826 pa_cvolume *cv,
827 const pa_channel_map *map,
828 pa_channel_position_t t,
829 pa_volume_t v) {
830
831 unsigned c;
832 pa_bool_t good = FALSE;
833
834 pa_assert(cv);
835 pa_assert(map);
836
837 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(cv, map), NULL);
838 pa_return_val_if_fail(t < PA_CHANNEL_POSITION_MAX, NULL);
839 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), NULL);
840
841 for (c = 0; c < map->channels; c++)
842 if (map->map[c] == t) {
843 cv->values[c] = v;
844 good = TRUE;
845 }
846
847 return good ? cv : NULL;
848 }
849
850 pa_volume_t pa_cvolume_get_position(
851 pa_cvolume *cv,
852 const pa_channel_map *map,
853 pa_channel_position_t t) {
854
855 unsigned c;
856 pa_volume_t v = PA_VOLUME_MUTED;
857
858 pa_assert(cv);
859 pa_assert(map);
860
861 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(cv, map), PA_VOLUME_MUTED);
862 pa_return_val_if_fail(t < PA_CHANNEL_POSITION_MAX, PA_VOLUME_MUTED);
863
864 for (c = 0; c < map->channels; c++)
865 if (map->map[c] == t)
866 if (cv->values[c] > v)
867 v = cv->values[c];
868
869 return v;
870 }
871
872 pa_cvolume* pa_cvolume_merge(pa_cvolume *dest, const pa_cvolume *a, const pa_cvolume *b) {
873 unsigned i;
874
875 pa_assert(dest);
876 pa_assert(a);
877 pa_assert(b);
878
879 pa_return_val_if_fail(pa_cvolume_valid(a), NULL);
880 pa_return_val_if_fail(pa_cvolume_valid(b), NULL);
881
882 for (i = 0; i < a->channels && i < b->channels; i++)
883 dest->values[i] = PA_MAX(a->values[i], b->values[i]);
884
885 dest->channels = (uint8_t) i;
886
887 return dest;
888 }
889
890 pa_cvolume* pa_cvolume_inc_clamp(pa_cvolume *v, pa_volume_t inc, pa_volume_t limit) {
891 pa_volume_t m;
892
893 pa_assert(v);
894
895 pa_return_val_if_fail(pa_cvolume_valid(v), NULL);
896 pa_return_val_if_fail(PA_VOLUME_IS_VALID(inc), NULL);
897
898 m = pa_cvolume_max(v);
899
900 if (m >= limit - inc)
901 m = limit;
902 else
903 m += inc;
904
905 return pa_cvolume_scale(v, m);
906 }
907
908 pa_cvolume* pa_cvolume_inc(pa_cvolume *v, pa_volume_t inc){
909 return pa_cvolume_inc_clamp(v, inc, PA_VOLUME_MAX);
910 }
911
912 pa_cvolume* pa_cvolume_dec(pa_cvolume *v, pa_volume_t dec) {
913 pa_volume_t m;
914
915 pa_assert(v);
916
917 pa_return_val_if_fail(pa_cvolume_valid(v), NULL);
918 pa_return_val_if_fail(PA_VOLUME_IS_VALID(dec), NULL);
919
920 m = pa_cvolume_max(v);
921
922 if (m <= PA_VOLUME_MUTED + dec)
923 m = PA_VOLUME_MUTED;
924 else
925 m -= dec;
926
927 return pa_cvolume_scale(v, m);
928 }