2 This file is part of PulseAudio.
4 Copyright 2004-2006 Lennart Poettering
5 Copyright 2009 Wim Taymans <wim.taymans@collabora.co.uk.com>
7 PulseAudio is free software; you can redistribute it and/or modify
8 it under the terms of the GNU Lesser General Public License as published
9 by the Free Software Foundation; either version 2.1 of the License,
10 or (at your option) any later version.
12 PulseAudio is distributed in the hope that it will be useful, but
13 WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
15 General Public License for more details.
17 You should have received a copy of the GNU Lesser General Public License
18 along with PulseAudio; if not, write to the Free Software
19 Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307
29 #include <pulse/sample.h>
30 #include <pulse/volume.h>
31 #include <pulsecore/log.h>
32 #include <pulsecore/macro.h>
36 static void remap_mono_to_stereo_s16ne_c(pa_remap_t
*m
, int16_t *dst
, const int16_t *src
, unsigned n
) {
39 for (i
= n
>> 2; i
; i
--) {
40 dst
[0] = dst
[1] = src
[0];
41 dst
[2] = dst
[3] = src
[1];
42 dst
[4] = dst
[5] = src
[2];
43 dst
[6] = dst
[7] = src
[3];
47 for (i
= n
& 3; i
; i
--) {
48 dst
[0] = dst
[1] = src
[0];
54 static void remap_mono_to_stereo_float32ne_c(pa_remap_t
*m
, float *dst
, const float *src
, unsigned n
) {
57 for (i
= n
>> 2; i
; i
--) {
58 dst
[0] = dst
[1] = src
[0];
59 dst
[2] = dst
[3] = src
[1];
60 dst
[4] = dst
[5] = src
[2];
61 dst
[6] = dst
[7] = src
[3];
65 for (i
= n
& 3; i
; i
--) {
66 dst
[0] = dst
[1] = src
[0];
72 static void remap_channels_matrix_s16ne_c(pa_remap_t
*m
, void *dst
, const void *src
, unsigned n
) {
76 n_ic
= m
->i_ss
.channels
;
77 n_oc
= m
->o_ss
.channels
;
79 memset(dst
, 0, n
* sizeof(int16_t) * n_oc
);
81 for (oc
= 0; oc
< n_oc
; oc
++) {
83 for (ic
= 0; ic
< n_ic
; ic
++) {
87 vol
= m
->map_table_i
[oc
][ic
];
92 d
= (int16_t *)dst
+ oc
;
93 s
= (int16_t *)src
+ ic
;
96 for (i
= n
; i
> 0; i
--, s
+= n_ic
, d
+= n_oc
)
99 for (i
= n
; i
> 0; i
--, s
+= n_ic
, d
+= n_oc
)
100 *d
+= (int16_t) (((int32_t)*s
* vol
) >> 16);
106 static void remap_channels_matrix_float32ne_c(pa_remap_t
*m
, void *dst
, const void *src
, unsigned n
) {
110 n_ic
= m
->i_ss
.channels
;
111 n_oc
= m
->o_ss
.channels
;
113 memset(dst
, 0, n
* sizeof(float) * n_oc
);
115 for (oc
= 0; oc
< n_oc
; oc
++) {
117 for (ic
= 0; ic
< n_ic
; ic
++) {
121 vol
= m
->map_table_f
[oc
][ic
];
126 d
= (float *)dst
+ oc
;
127 s
= (float *)src
+ ic
;
130 for (i
= n
; i
> 0; i
--, s
+= n_ic
, d
+= n_oc
)
133 for (i
= n
; i
> 0; i
--, s
+= n_ic
, d
+= n_oc
)
140 /* set the function that will execute the remapping based on the matrices */
141 static void init_remap_c(pa_remap_t
*m
) {
144 n_oc
= m
->o_ss
.channels
;
145 n_ic
= m
->i_ss
.channels
;
147 /* find some common channel remappings, fall back to full matrix operation. */
148 if (n_ic
== 1 && n_oc
== 2 &&
149 m
->map_table_i
[0][0] == 0x10000 && m
->map_table_i
[1][0] == 0x10000) {
151 pa_log_info("Using mono to stereo remapping");
153 case PA_SAMPLE_S16NE
:
154 m
->do_remap
= (pa_do_remap_func_t
) remap_mono_to_stereo_s16ne_c
;
156 case PA_SAMPLE_FLOAT32NE
:
157 m
->do_remap
= (pa_do_remap_func_t
) remap_mono_to_stereo_float32ne_c
;
160 pa_assert_not_reached();
163 pa_log_info("Using generic matrix remapping");
165 case PA_SAMPLE_S16NE
:
166 m
->do_remap
= (pa_do_remap_func_t
) remap_channels_matrix_s16ne_c
;
168 case PA_SAMPLE_FLOAT32NE
:
169 m
->do_remap
= (pa_do_remap_func_t
) remap_channels_matrix_float32ne_c
;
172 pa_assert_not_reached();
177 /* default C implementation */
178 static pa_init_remap_func_t init_remap_func
= init_remap_c
;
180 void pa_init_remap_func(pa_remap_t
*m
) {
181 pa_assert(init_remap_func
);
185 /* call the installed remap init function */
188 if (m
->do_remap
== NULL
) {
189 /* nothing was installed, fallback to C version */
194 pa_init_remap_func_t
pa_get_init_remap_func(void) {
195 return init_remap_func
;
198 void pa_set_init_remap_func(pa_init_remap_func_t func
) {
199 init_remap_func
= func
;