1*b9df5ad1SAndroid Build Coastguard Worker /*
2*b9df5ad1SAndroid Build Coastguard Worker * Copyright (C) 2014 The Android Open Source Project
3*b9df5ad1SAndroid Build Coastguard Worker *
4*b9df5ad1SAndroid Build Coastguard Worker * Licensed under the Apache License, Version 2.0 (the "License");
5*b9df5ad1SAndroid Build Coastguard Worker * you may not use this file except in compliance with the License.
6*b9df5ad1SAndroid Build Coastguard Worker * You may obtain a copy of the License at
7*b9df5ad1SAndroid Build Coastguard Worker *
8*b9df5ad1SAndroid Build Coastguard Worker * http://www.apache.org/licenses/LICENSE-2.0
9*b9df5ad1SAndroid Build Coastguard Worker *
10*b9df5ad1SAndroid Build Coastguard Worker * Unless required by applicable law or agreed to in writing, software
11*b9df5ad1SAndroid Build Coastguard Worker * distributed under the License is distributed on an "AS IS" BASIS,
12*b9df5ad1SAndroid Build Coastguard Worker * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13*b9df5ad1SAndroid Build Coastguard Worker * See the License for the specific language governing permissions and
14*b9df5ad1SAndroid Build Coastguard Worker * limitations under the License.
15*b9df5ad1SAndroid Build Coastguard Worker */
16*b9df5ad1SAndroid Build Coastguard Worker
17*b9df5ad1SAndroid Build Coastguard Worker #include <assert.h>
18*b9df5ad1SAndroid Build Coastguard Worker #include <audio_utils/format.h>
19*b9df5ad1SAndroid Build Coastguard Worker #include <audio_utils/primitives.h>
20*b9df5ad1SAndroid Build Coastguard Worker
memcpy_by_audio_format(void * dst,audio_format_t dst_format,const void * src,audio_format_t src_format,size_t count)21*b9df5ad1SAndroid Build Coastguard Worker void memcpy_by_audio_format(void *dst, audio_format_t dst_format,
22*b9df5ad1SAndroid Build Coastguard Worker const void *src, audio_format_t src_format, size_t count)
23*b9df5ad1SAndroid Build Coastguard Worker {
24*b9df5ad1SAndroid Build Coastguard Worker /* default cases for error falls through to assert(false) below. */
25*b9df5ad1SAndroid Build Coastguard Worker if (dst_format == src_format) {
26*b9df5ad1SAndroid Build Coastguard Worker switch (dst_format) {
27*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
28*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
29*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_BIT:
30*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED:
31*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_32_BIT:
32*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_24_BIT:
33*b9df5ad1SAndroid Build Coastguard Worker if (dst != src) {
34*b9df5ad1SAndroid Build Coastguard Worker // TODO: should assert if memory regions overlap.
35*b9df5ad1SAndroid Build Coastguard Worker memcpy(dst, src, count * audio_bytes_per_sample(dst_format));
36*b9df5ad1SAndroid Build Coastguard Worker }
37*b9df5ad1SAndroid Build Coastguard Worker return;
38*b9df5ad1SAndroid Build Coastguard Worker default:
39*b9df5ad1SAndroid Build Coastguard Worker break;
40*b9df5ad1SAndroid Build Coastguard Worker }
41*b9df5ad1SAndroid Build Coastguard Worker }
42*b9df5ad1SAndroid Build Coastguard Worker switch (dst_format) {
43*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
44*b9df5ad1SAndroid Build Coastguard Worker switch (src_format) {
45*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
46*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i16_from_float((int16_t*)dst, (float*)src, count);
47*b9df5ad1SAndroid Build Coastguard Worker return;
48*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_BIT:
49*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i16_from_u8((int16_t*)dst, (uint8_t*)src, count);
50*b9df5ad1SAndroid Build Coastguard Worker return;
51*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED:
52*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i16_from_p24((int16_t*)dst, (uint8_t*)src, count);
53*b9df5ad1SAndroid Build Coastguard Worker return;
54*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_32_BIT:
55*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i16_from_i32((int16_t*)dst, (int32_t*)src, count);
56*b9df5ad1SAndroid Build Coastguard Worker return;
57*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_24_BIT:
58*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i16_from_q8_23((int16_t*)dst, (int32_t*)src, count);
59*b9df5ad1SAndroid Build Coastguard Worker return;
60*b9df5ad1SAndroid Build Coastguard Worker default:
61*b9df5ad1SAndroid Build Coastguard Worker break;
62*b9df5ad1SAndroid Build Coastguard Worker }
63*b9df5ad1SAndroid Build Coastguard Worker break;
64*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
65*b9df5ad1SAndroid Build Coastguard Worker switch (src_format) {
66*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
67*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_float_from_i16((float*)dst, (int16_t*)src, count);
68*b9df5ad1SAndroid Build Coastguard Worker return;
69*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_BIT:
70*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_float_from_u8((float*)dst, (uint8_t*)src, count);
71*b9df5ad1SAndroid Build Coastguard Worker return;
72*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED:
73*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_float_from_p24((float*)dst, (uint8_t*)src, count);
74*b9df5ad1SAndroid Build Coastguard Worker return;
75*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_32_BIT:
76*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_float_from_i32((float*)dst, (int32_t*)src, count);
77*b9df5ad1SAndroid Build Coastguard Worker return;
78*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_24_BIT:
79*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_float_from_q8_23((float*)dst, (int32_t*)src, count);
80*b9df5ad1SAndroid Build Coastguard Worker return;
81*b9df5ad1SAndroid Build Coastguard Worker default:
82*b9df5ad1SAndroid Build Coastguard Worker break;
83*b9df5ad1SAndroid Build Coastguard Worker }
84*b9df5ad1SAndroid Build Coastguard Worker break;
85*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_BIT:
86*b9df5ad1SAndroid Build Coastguard Worker switch (src_format) {
87*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
88*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_u8_from_i16((uint8_t*)dst, (int16_t*)src, count);
89*b9df5ad1SAndroid Build Coastguard Worker return;
90*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
91*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_u8_from_float((uint8_t*)dst, (float*)src, count);
92*b9df5ad1SAndroid Build Coastguard Worker return;
93*b9df5ad1SAndroid Build Coastguard Worker // The following converts HAL to AudioRecord formats.
94*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED:
95*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_u8_from_p24((uint8_t*)dst, (uint8_t*)src, count);
96*b9df5ad1SAndroid Build Coastguard Worker return;
97*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_32_BIT:
98*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_u8_from_i32((uint8_t*)dst, (int32_t*)src, count);
99*b9df5ad1SAndroid Build Coastguard Worker return;
100*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_24_BIT:
101*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_u8_from_q8_23((uint8_t*)dst, (int32_t*)src, count);
102*b9df5ad1SAndroid Build Coastguard Worker return;
103*b9df5ad1SAndroid Build Coastguard Worker default:
104*b9df5ad1SAndroid Build Coastguard Worker break;
105*b9df5ad1SAndroid Build Coastguard Worker }
106*b9df5ad1SAndroid Build Coastguard Worker break;
107*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED:
108*b9df5ad1SAndroid Build Coastguard Worker switch (src_format) {
109*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
110*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_p24_from_i16((uint8_t*)dst, (int16_t*)src, count);
111*b9df5ad1SAndroid Build Coastguard Worker return;
112*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
113*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_p24_from_float((uint8_t*)dst, (float*)src, count);
114*b9df5ad1SAndroid Build Coastguard Worker return;
115*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_32_BIT:
116*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_p24_from_i32((uint8_t*)dst, (int32_t*)src, count);
117*b9df5ad1SAndroid Build Coastguard Worker return;
118*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_24_BIT:
119*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_p24_from_q8_23((uint8_t*)dst, (int32_t*)src, count);
120*b9df5ad1SAndroid Build Coastguard Worker return;
121*b9df5ad1SAndroid Build Coastguard Worker default:
122*b9df5ad1SAndroid Build Coastguard Worker break;
123*b9df5ad1SAndroid Build Coastguard Worker }
124*b9df5ad1SAndroid Build Coastguard Worker break;
125*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_32_BIT:
126*b9df5ad1SAndroid Build Coastguard Worker switch (src_format) {
127*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
128*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i32_from_i16((int32_t*)dst, (int16_t*)src, count);
129*b9df5ad1SAndroid Build Coastguard Worker return;
130*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
131*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i32_from_float((int32_t*)dst, (float*)src, count);
132*b9df5ad1SAndroid Build Coastguard Worker return;
133*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED:
134*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_i32_from_p24((int32_t*)dst, (uint8_t *)src, count);
135*b9df5ad1SAndroid Build Coastguard Worker return;
136*b9df5ad1SAndroid Build Coastguard Worker default:
137*b9df5ad1SAndroid Build Coastguard Worker break;
138*b9df5ad1SAndroid Build Coastguard Worker }
139*b9df5ad1SAndroid Build Coastguard Worker break;
140*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_24_BIT:
141*b9df5ad1SAndroid Build Coastguard Worker switch (src_format) {
142*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
143*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_q8_23_from_i16((int32_t*)dst, (int16_t*)src, count);
144*b9df5ad1SAndroid Build Coastguard Worker return;
145*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
146*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_q8_23_from_float_with_clamp((int32_t*)dst, (float*)src, count);
147*b9df5ad1SAndroid Build Coastguard Worker return;
148*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED: {
149*b9df5ad1SAndroid Build Coastguard Worker memcpy_to_q8_23_from_p24((int32_t *)dst, (uint8_t *)src, count);
150*b9df5ad1SAndroid Build Coastguard Worker return;
151*b9df5ad1SAndroid Build Coastguard Worker }
152*b9df5ad1SAndroid Build Coastguard Worker default:
153*b9df5ad1SAndroid Build Coastguard Worker break;
154*b9df5ad1SAndroid Build Coastguard Worker }
155*b9df5ad1SAndroid Build Coastguard Worker break;
156*b9df5ad1SAndroid Build Coastguard Worker default:
157*b9df5ad1SAndroid Build Coastguard Worker break;
158*b9df5ad1SAndroid Build Coastguard Worker }
159*b9df5ad1SAndroid Build Coastguard Worker // invalid src format for dst format
160*b9df5ad1SAndroid Build Coastguard Worker assert(false);
161*b9df5ad1SAndroid Build Coastguard Worker }
162*b9df5ad1SAndroid Build Coastguard Worker
memcpy_by_index_array_initialization_from_channel_mask(int8_t * idxary,size_t arysize,audio_channel_mask_t dst_channel_mask,audio_channel_mask_t src_channel_mask)163*b9df5ad1SAndroid Build Coastguard Worker size_t memcpy_by_index_array_initialization_from_channel_mask(int8_t *idxary, size_t arysize,
164*b9df5ad1SAndroid Build Coastguard Worker audio_channel_mask_t dst_channel_mask, audio_channel_mask_t src_channel_mask)
165*b9df5ad1SAndroid Build Coastguard Worker {
166*b9df5ad1SAndroid Build Coastguard Worker const audio_channel_representation_t src_representation =
167*b9df5ad1SAndroid Build Coastguard Worker audio_channel_mask_get_representation(src_channel_mask);
168*b9df5ad1SAndroid Build Coastguard Worker const audio_channel_representation_t dst_representation =
169*b9df5ad1SAndroid Build Coastguard Worker audio_channel_mask_get_representation(dst_channel_mask);
170*b9df5ad1SAndroid Build Coastguard Worker const uint32_t src_bits = audio_channel_mask_get_bits(src_channel_mask);
171*b9df5ad1SAndroid Build Coastguard Worker const uint32_t dst_bits = audio_channel_mask_get_bits(dst_channel_mask);
172*b9df5ad1SAndroid Build Coastguard Worker
173*b9df5ad1SAndroid Build Coastguard Worker switch (src_representation) {
174*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_CHANNEL_REPRESENTATION_POSITION:
175*b9df5ad1SAndroid Build Coastguard Worker switch (dst_representation) {
176*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_CHANNEL_REPRESENTATION_POSITION:
177*b9df5ad1SAndroid Build Coastguard Worker return memcpy_by_index_array_initialization(idxary, arysize,
178*b9df5ad1SAndroid Build Coastguard Worker dst_bits, src_bits);
179*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_CHANNEL_REPRESENTATION_INDEX:
180*b9df5ad1SAndroid Build Coastguard Worker return memcpy_by_index_array_initialization_dst_index(idxary, arysize,
181*b9df5ad1SAndroid Build Coastguard Worker dst_bits, src_bits);
182*b9df5ad1SAndroid Build Coastguard Worker default:
183*b9df5ad1SAndroid Build Coastguard Worker return 0;
184*b9df5ad1SAndroid Build Coastguard Worker }
185*b9df5ad1SAndroid Build Coastguard Worker break;
186*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_CHANNEL_REPRESENTATION_INDEX:
187*b9df5ad1SAndroid Build Coastguard Worker switch (dst_representation) {
188*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_CHANNEL_REPRESENTATION_POSITION:
189*b9df5ad1SAndroid Build Coastguard Worker return memcpy_by_index_array_initialization_src_index(idxary, arysize,
190*b9df5ad1SAndroid Build Coastguard Worker dst_bits, src_bits);
191*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_CHANNEL_REPRESENTATION_INDEX:
192*b9df5ad1SAndroid Build Coastguard Worker return memcpy_by_index_array_initialization(idxary, arysize,
193*b9df5ad1SAndroid Build Coastguard Worker dst_bits, src_bits);
194*b9df5ad1SAndroid Build Coastguard Worker default:
195*b9df5ad1SAndroid Build Coastguard Worker return 0;
196*b9df5ad1SAndroid Build Coastguard Worker }
197*b9df5ad1SAndroid Build Coastguard Worker break;
198*b9df5ad1SAndroid Build Coastguard Worker default:
199*b9df5ad1SAndroid Build Coastguard Worker return 0;
200*b9df5ad1SAndroid Build Coastguard Worker }
201*b9df5ad1SAndroid Build Coastguard Worker }
202*b9df5ad1SAndroid Build Coastguard Worker
accumulate_by_audio_format(void * dst,const void * src,audio_format_t format,size_t count)203*b9df5ad1SAndroid Build Coastguard Worker void accumulate_by_audio_format(void *dst, const void *src,
204*b9df5ad1SAndroid Build Coastguard Worker audio_format_t format, size_t count) {
205*b9df5ad1SAndroid Build Coastguard Worker switch (format) {
206*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_16_BIT:
207*b9df5ad1SAndroid Build Coastguard Worker accumulate_i16((int16_t *)dst, (const int16_t *)src, count);
208*b9df5ad1SAndroid Build Coastguard Worker return;
209*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_FLOAT:
210*b9df5ad1SAndroid Build Coastguard Worker accumulate_float((float *)dst, (const float *)src, count);
211*b9df5ad1SAndroid Build Coastguard Worker return;
212*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_BIT:
213*b9df5ad1SAndroid Build Coastguard Worker accumulate_u8((uint8_t *)dst, (const uint8_t *)src, count);
214*b9df5ad1SAndroid Build Coastguard Worker return;
215*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_24_BIT_PACKED:
216*b9df5ad1SAndroid Build Coastguard Worker accumulate_p24((uint8_t *)dst, (const uint8_t *)src, count);
217*b9df5ad1SAndroid Build Coastguard Worker return;
218*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_32_BIT:
219*b9df5ad1SAndroid Build Coastguard Worker accumulate_i32((int32_t *)dst, (const int32_t *)src, count);
220*b9df5ad1SAndroid Build Coastguard Worker return;
221*b9df5ad1SAndroid Build Coastguard Worker case AUDIO_FORMAT_PCM_8_24_BIT:
222*b9df5ad1SAndroid Build Coastguard Worker accumulate_q8_23((int32_t *)dst, (const int32_t *)src, count);
223*b9df5ad1SAndroid Build Coastguard Worker return;
224*b9df5ad1SAndroid Build Coastguard Worker default:
225*b9df5ad1SAndroid Build Coastguard Worker break;
226*b9df5ad1SAndroid Build Coastguard Worker }
227*b9df5ad1SAndroid Build Coastguard Worker // invalid format
228*b9df5ad1SAndroid Build Coastguard Worker assert(false);
229*b9df5ad1SAndroid Build Coastguard Worker }
230