]> code.delx.au - pulseaudio/blob - src/pulse/volume.c
Remove unnecessary #includes
[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 <pulse/i18n.h>
31
32 #include <pulsecore/core-util.h>
33 #include <pulsecore/macro.h>
34 #include <pulsecore/sample-util.h>
35
36 #include "volume.h"
37
38 int pa_cvolume_equal(const pa_cvolume *a, const pa_cvolume *b) {
39 int i;
40 pa_assert(a);
41 pa_assert(b);
42
43 pa_return_val_if_fail(pa_cvolume_valid(a), 0);
44
45 if (PA_UNLIKELY(a == b))
46 return 1;
47
48 pa_return_val_if_fail(pa_cvolume_valid(b), 0);
49
50 if (a->channels != b->channels)
51 return 0;
52
53 for (i = 0; i < a->channels; i++)
54 if (a->values[i] != b->values[i])
55 return 0;
56
57 return 1;
58 }
59
60 pa_cvolume* pa_cvolume_init(pa_cvolume *a) {
61 unsigned c;
62
63 pa_assert(a);
64
65 a->channels = 0;
66
67 for (c = 0; c < PA_CHANNELS_MAX; c++)
68 a->values[c] = PA_VOLUME_INVALID;
69
70 return a;
71 }
72
73 pa_cvolume* pa_cvolume_set(pa_cvolume *a, unsigned channels, pa_volume_t v) {
74 int i;
75
76 pa_assert(a);
77 pa_assert(channels > 0);
78 pa_assert(channels <= PA_CHANNELS_MAX);
79
80 a->channels = (uint8_t) channels;
81
82 for (i = 0; i < a->channels; i++)
83 /* Clamp in case there is stale data that exceeds the current
84 * PA_VOLUME_MAX */
85 a->values[i] = PA_CLAMP_VOLUME(v);
86
87 return a;
88 }
89
90 pa_volume_t pa_cvolume_avg(const pa_cvolume *a) {
91 uint64_t sum = 0;
92 unsigned c;
93
94 pa_assert(a);
95 pa_return_val_if_fail(pa_cvolume_valid(a), PA_VOLUME_MUTED);
96
97 for (c = 0; c < a->channels; c++)
98 sum += a->values[c];
99
100 sum /= a->channels;
101
102 return (pa_volume_t) sum;
103 }
104
105 pa_volume_t pa_cvolume_avg_mask(const pa_cvolume *a, const pa_channel_map *cm, pa_channel_position_mask_t mask) {
106 uint64_t sum = 0;
107 unsigned c, n;
108
109 pa_assert(a);
110
111 if (!cm)
112 return pa_cvolume_avg(a);
113
114 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(a, cm), PA_VOLUME_MUTED);
115
116 for (c = n = 0; c < a->channels; c++) {
117
118 if (!(PA_CHANNEL_POSITION_MASK(cm->map[c]) & mask))
119 continue;
120
121 sum += a->values[c];
122 n ++;
123 }
124
125 if (n > 0)
126 sum /= n;
127
128 return (pa_volume_t) sum;
129 }
130
131 pa_volume_t pa_cvolume_max(const pa_cvolume *a) {
132 pa_volume_t m = PA_VOLUME_MUTED;
133 unsigned c;
134
135 pa_assert(a);
136 pa_return_val_if_fail(pa_cvolume_valid(a), PA_VOLUME_MUTED);
137
138 for (c = 0; c < a->channels; c++)
139 if (a->values[c] > m)
140 m = a->values[c];
141
142 return m;
143 }
144
145 pa_volume_t pa_cvolume_min(const pa_cvolume *a) {
146 pa_volume_t m = PA_VOLUME_MAX;
147 unsigned c;
148
149 pa_assert(a);
150 pa_return_val_if_fail(pa_cvolume_valid(a), PA_VOLUME_MUTED);
151
152 for (c = 0; c < a->channels; c++)
153 if (a->values[c] < m)
154 m = a->values[c];
155
156 return m;
157 }
158
159 pa_volume_t pa_cvolume_max_mask(const pa_cvolume *a, const pa_channel_map *cm, pa_channel_position_mask_t mask) {
160 pa_volume_t m = PA_VOLUME_MUTED;
161 unsigned c;
162
163 pa_assert(a);
164
165 if (!cm)
166 return pa_cvolume_max(a);
167
168 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(a, cm), PA_VOLUME_MUTED);
169
170 for (c = 0; c < a->channels; c++) {
171
172 if (!(PA_CHANNEL_POSITION_MASK(cm->map[c]) & mask))
173 continue;
174
175 if (a->values[c] > m)
176 m = a->values[c];
177 }
178
179 return m;
180 }
181
182 pa_volume_t pa_cvolume_min_mask(const pa_cvolume *a, const pa_channel_map *cm, pa_channel_position_mask_t mask) {
183 pa_volume_t m = PA_VOLUME_MAX;
184 unsigned c;
185
186 pa_assert(a);
187
188 if (!cm)
189 return pa_cvolume_min(a);
190
191 pa_return_val_if_fail(pa_cvolume_compatible_with_channel_map(a, cm), PA_VOLUME_MUTED);
192
193 for (c = 0; c < a->channels; c++) {
194
195 if (!(PA_CHANNEL_POSITION_MASK(cm->map[c]) & mask))
196 continue;
197
198 if (a->values[c] < m)
199 m = a->values[c];
200 }
201
202 return m;
203 }
204
205 pa_volume_t pa_sw_volume_multiply(pa_volume_t a, pa_volume_t b) {
206
207 pa_return_val_if_fail(PA_VOLUME_IS_VALID(a), PA_VOLUME_INVALID);
208 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), PA_VOLUME_INVALID);
209
210 /* cbrt((a/PA_VOLUME_NORM)^3*(b/PA_VOLUME_NORM)^3)*PA_VOLUME_NORM = a*b/PA_VOLUME_NORM */
211
212 return (pa_volume_t) PA_CLAMP_VOLUME((((uint64_t) a * (uint64_t) b + (uint64_t) PA_VOLUME_NORM / 2ULL) / (uint64_t) PA_VOLUME_NORM));
213 }
214
215 pa_volume_t pa_sw_volume_divide(pa_volume_t a, pa_volume_t b) {
216
217 pa_return_val_if_fail(PA_VOLUME_IS_VALID(a), PA_VOLUME_INVALID);
218 pa_return_val_if_fail(PA_VOLUME_IS_VALID(b), PA_VOLUME_INVALID);
219
220 if (b <= PA_VOLUME_MUTED)
221 return 0;
222
223 return (pa_volume_t) (((uint64_t) a * (uint64_t) PA_VOLUME_NORM + (uint64_t) b / 2ULL) / (uint64_t) b);
224 }
225
226 /* Amplitude, not power */
227 static double linear_to_dB(double v) {
228 return 20.0 * log10(v);
229 }
230
231 static double dB_to_linear(double v) {
232 return pow(10.0, v / 20.0);
233 }
234
235 pa_volume_t pa_sw_volume_from_dB(double dB) {
236 if (isinf(dB) < 0 || dB <= PA_DECIBEL_MININFTY)
237 return PA_VOLUME_MUTED;
238
239 return pa_sw_volume_from_linear(dB_to_linear(dB));
240 }
241
242 double pa_sw_volume_to_dB(pa_volume_t v) {
243
244 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), PA_DECIBEL_MININFTY);
245
246 if (v <= PA_VOLUME_MUTED)
247 return PA_DECIBEL_MININFTY;
248
249 return linear_to_dB(pa_sw_volume_to_linear(v));
250 }
251
252 pa_volume_t pa_sw_volume_from_linear(double v) {
253
254 if (v <= 0.0)
255 return PA_VOLUME_MUTED;
256
257 /*
258 * We use a cubic mapping here, as suggested and discussed here:
259 *
260 * http://www.robotplanet.dk/audio/audio_gui_design/
261 * http://lists.linuxaudio.org/pipermail/linux-audio-dev/2009-May/thread.html#23151
262 *
263 * We make sure that the conversion to linear and back yields the
264 * same volume value! That's why we need the lround() below!
265 */
266
267 return (pa_volume_t) PA_CLAMP_VOLUME((uint64_t) lround(cbrt(v) * PA_VOLUME_NORM));
268 }
269
270 double pa_sw_volume_to_linear(pa_volume_t v) {
271 double f;
272
273 pa_return_val_if_fail(PA_VOLUME_IS_VALID(v), 0.0);
274
275 if (v <= PA_VOLUME_MUTED)
276 return 0.0;
277
278 if (v == PA_VOLUME_NORM)
279 return 1.0;
280
281 f = ((double) v / PA_VOLUME_NORM);
282
283 return f*f*f;
284 }
285
286 char *pa_cvolume_snprint(char *s, size_t l, const pa_cvolume *c) {
287 unsigned channel;
288 pa_bool_t first = TRUE;
289 char *e;
290
291 pa_assert(s);
292 pa_assert(l > 0);
293 pa_assert(c);
294
295 pa_init_i18n();
296
297 if (!pa_cvolume_valid(c)) {
298 pa_snprintf(s, l, _("(invalid)"));
299 return s;
300 }
301
302 *(e = s) = 0;
303
304 for (channel = 0; channel < c->channels && l > 1; channel++) {
305 l -= pa_snprintf(e, l, "%s%u: %3u%%",
306 first ? "" : " ",
307 channel,
308 (c->values[channel]*100+PA_VOLUME_NORM/2)/PA_VOLUME_NORM);
309
310 e = strchr(e, 0);
311 first = FALSE;
312 }
313
314 return s;
315 }
316
317 char *pa_volume_snprint(char *s, size_t l, pa_volume_t v) {
318 pa_assert(s);
319 pa_assert(l > 0);
320
321 pa_init_i18n();
322
323 if (!PA_VOLUME_IS_VALID(v)) {
324 pa_snprintf(s, l, _("(invalid)"));
325 return s;
326 }
327
328 pa_snprintf(s, l, "%3u%%", (v*100+PA_VOLUME_NORM/2)/PA_VOLUME_NORM);
329 return s;
330 }
331
332 char *pa_sw_cvolume_snprint_dB(char *s, size_t l, const pa_cvolume *c) {
333 unsigned channel;
334 pa_bool_t first = TRUE;
335 char *e;
336
337 pa_assert(s);
338 pa_assert(l > 0);
339 pa_assert(c);
340
341 pa_init_i18n();
342
343 if (!pa_cvolume_valid(c)) {
344 pa_snprintf(s, l, _("(invalid)"));
345 return s;
346 }
347
348 *(e = s) = 0;
349
350 for (channel = 0; channel < c->channels && l > 1; channel++) {
351 double f = pa_sw_volume_to_dB(c->values[channel]);
352
353 l -= pa_snprintf(e, l, "%s%u: %0.2f dB",
354 first ? "" : " ",
355 channel,
356 isinf(f) < 0 || f <= PA_DECIBEL_MININFTY ? -INFINITY : f);
357
358 e = strchr(e, 0);
359 first = FALSE;
360 }
361
362 return s;
363 }
364
365 char *pa_sw_volume_snprint_dB(char *s, size_t l, pa_volume_t v) {
366 double f;
367
368 pa_assert(s);
369 pa_assert(l > 0);
370
371 pa_init_i18n();
372
373 if (!PA_VOLUME_IS_VALID(v)) {
374 pa_snprintf(s, l, _("(invalid)"));
375 return s;
376 }
377
378 f = pa_sw_volume_to_dB(v);
379 pa_snprintf(s, l, "%0.2f dB", 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 }