3394
|
1 /*
|
|
2 * downmix.c
|
|
3 * Copyright (C) 2000-2001 Michel Lespinasse <walken@zoy.org>
|
|
4 * Copyright (C) 1999-2000 Aaron Holtzman <aholtzma@ess.engr.uvic.ca>
|
|
5 *
|
|
6 * This file is part of a52dec, a free ATSC A-52 stream decoder.
|
|
7 * See http://liba52.sourceforge.net/ for updates.
|
|
8 *
|
|
9 * a52dec is free software; you can redistribute it and/or modify
|
|
10 * it under the terms of the GNU General Public License as published by
|
|
11 * the Free Software Foundation; either version 2 of the License, or
|
|
12 * (at your option) any later version.
|
|
13 *
|
|
14 * a52dec is distributed in the hope that it will be useful,
|
|
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
17 * GNU General Public License for more details.
|
|
18 *
|
|
19 * You should have received a copy of the GNU General Public License
|
|
20 * along with this program; if not, write to the Free Software
|
|
21 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
|
|
22 */
|
|
23
|
|
24 #include "config.h"
|
|
25
|
|
26 #include <string.h>
|
|
27 #include <inttypes.h>
|
|
28
|
|
29 #include "a52.h"
|
|
30 #include "a52_internal.h"
|
|
31
|
|
32 #define CONVERT(acmod,output) (((output) << 3) + (acmod))
|
|
33
|
|
34 int downmix_init (int input, int flags, sample_t * level,
|
|
35 sample_t clev, sample_t slev)
|
|
36 {
|
|
37 static uint8_t table[11][8] = {
|
|
38 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_STEREO,
|
|
39 A52_STEREO, A52_STEREO, A52_STEREO, A52_STEREO},
|
|
40 {A52_MONO, A52_MONO, A52_MONO, A52_MONO,
|
|
41 A52_MONO, A52_MONO, A52_MONO, A52_MONO},
|
|
42 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_STEREO,
|
|
43 A52_STEREO, A52_STEREO, A52_STEREO, A52_STEREO},
|
|
44 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_3F,
|
|
45 A52_STEREO, A52_3F, A52_STEREO, A52_3F},
|
|
46 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_STEREO,
|
|
47 A52_2F1R, A52_2F1R, A52_2F1R, A52_2F1R},
|
|
48 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_STEREO,
|
|
49 A52_2F1R, A52_3F1R, A52_2F1R, A52_3F1R},
|
|
50 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_3F,
|
|
51 A52_2F2R, A52_2F2R, A52_2F2R, A52_2F2R},
|
|
52 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_3F,
|
|
53 A52_2F2R, A52_3F2R, A52_2F2R, A52_3F2R},
|
|
54 {A52_CHANNEL1, A52_MONO, A52_MONO, A52_MONO,
|
|
55 A52_MONO, A52_MONO, A52_MONO, A52_MONO},
|
|
56 {A52_CHANNEL2, A52_MONO, A52_MONO, A52_MONO,
|
|
57 A52_MONO, A52_MONO, A52_MONO, A52_MONO},
|
|
58 {A52_CHANNEL, A52_DOLBY, A52_STEREO, A52_DOLBY,
|
|
59 A52_DOLBY, A52_DOLBY, A52_DOLBY, A52_DOLBY}
|
|
60 };
|
|
61 int output;
|
|
62
|
|
63 output = flags & A52_CHANNEL_MASK;
|
|
64 if (output > A52_DOLBY)
|
|
65 return -1;
|
|
66
|
|
67 output = table[output][input & 7];
|
|
68
|
|
69 if ((output == A52_STEREO) &&
|
|
70 ((input == A52_DOLBY) || ((input == A52_3F) && (clev == LEVEL_3DB))))
|
|
71 output = A52_DOLBY;
|
|
72
|
|
73 if (flags & A52_ADJUST_LEVEL)
|
|
74 switch (CONVERT (input & 7, output)) {
|
|
75
|
|
76 case CONVERT (A52_3F, A52_MONO):
|
|
77 *level *= LEVEL_3DB / (1 + clev);
|
|
78 break;
|
|
79
|
|
80 case CONVERT (A52_STEREO, A52_MONO):
|
|
81 case CONVERT (A52_2F2R, A52_2F1R):
|
|
82 case CONVERT (A52_3F2R, A52_3F1R):
|
|
83 level_3db:
|
|
84 *level *= LEVEL_3DB;
|
|
85 break;
|
|
86
|
|
87 case CONVERT (A52_3F2R, A52_2F1R):
|
|
88 if (clev < LEVEL_PLUS3DB - 1)
|
|
89 goto level_3db;
|
|
90 /* break thru */
|
|
91 case CONVERT (A52_3F, A52_STEREO):
|
|
92 case CONVERT (A52_3F1R, A52_2F1R):
|
|
93 case CONVERT (A52_3F1R, A52_2F2R):
|
|
94 case CONVERT (A52_3F2R, A52_2F2R):
|
|
95 *level /= 1 + clev;
|
|
96 break;
|
|
97
|
|
98 case CONVERT (A52_2F1R, A52_MONO):
|
|
99 *level *= LEVEL_PLUS3DB / (2 + slev);
|
|
100 break;
|
|
101
|
|
102 case CONVERT (A52_2F1R, A52_STEREO):
|
|
103 case CONVERT (A52_3F1R, A52_3F):
|
|
104 *level /= 1 + slev * LEVEL_3DB;
|
|
105 break;
|
|
106
|
|
107 case CONVERT (A52_3F1R, A52_MONO):
|
|
108 *level *= LEVEL_3DB / (1 + clev + 0.5 * slev);
|
|
109 break;
|
|
110
|
|
111 case CONVERT (A52_3F1R, A52_STEREO):
|
|
112 *level /= 1 + clev + slev * LEVEL_3DB;
|
|
113 break;
|
|
114
|
|
115 case CONVERT (A52_2F2R, A52_MONO):
|
|
116 *level *= LEVEL_3DB / (1 + slev);
|
|
117 break;
|
|
118
|
|
119 case CONVERT (A52_2F2R, A52_STEREO):
|
|
120 case CONVERT (A52_3F2R, A52_3F):
|
|
121 *level /= 1 + slev;
|
|
122 break;
|
|
123
|
|
124 case CONVERT (A52_3F2R, A52_MONO):
|
|
125 *level *= LEVEL_3DB / (1 + clev + slev);
|
|
126 break;
|
|
127
|
|
128 case CONVERT (A52_3F2R, A52_STEREO):
|
|
129 *level /= 1 + clev + slev;
|
|
130 break;
|
|
131
|
|
132 case CONVERT (A52_MONO, A52_DOLBY):
|
|
133 *level *= LEVEL_PLUS3DB;
|
|
134 break;
|
|
135
|
|
136 case CONVERT (A52_3F, A52_DOLBY):
|
|
137 case CONVERT (A52_2F1R, A52_DOLBY):
|
|
138 *level *= 1 / (1 + LEVEL_3DB);
|
|
139 break;
|
|
140
|
|
141 case CONVERT (A52_3F1R, A52_DOLBY):
|
|
142 case CONVERT (A52_2F2R, A52_DOLBY):
|
|
143 *level *= 1 / (1 + 2 * LEVEL_3DB);
|
|
144 break;
|
|
145
|
|
146 case CONVERT (A52_3F2R, A52_DOLBY):
|
|
147 *level *= 1 / (1 + 3 * LEVEL_3DB);
|
|
148 break;
|
|
149 }
|
|
150
|
|
151 return output;
|
|
152 }
|
|
153
|
|
154 int downmix_coeff (sample_t * coeff, int acmod, int output, sample_t level,
|
|
155 sample_t clev, sample_t slev)
|
|
156 {
|
|
157 switch (CONVERT (acmod, output & A52_CHANNEL_MASK)) {
|
|
158
|
|
159 case CONVERT (A52_CHANNEL, A52_CHANNEL):
|
|
160 case CONVERT (A52_MONO, A52_MONO):
|
|
161 case CONVERT (A52_STEREO, A52_STEREO):
|
|
162 case CONVERT (A52_3F, A52_3F):
|
|
163 case CONVERT (A52_2F1R, A52_2F1R):
|
|
164 case CONVERT (A52_3F1R, A52_3F1R):
|
|
165 case CONVERT (A52_2F2R, A52_2F2R):
|
|
166 case CONVERT (A52_3F2R, A52_3F2R):
|
|
167 case CONVERT (A52_STEREO, A52_DOLBY):
|
|
168 coeff[0] = coeff[1] = coeff[2] = coeff[3] = coeff[4] = level;
|
|
169 return 0;
|
|
170
|
|
171 case CONVERT (A52_CHANNEL, A52_MONO):
|
|
172 coeff[0] = coeff[1] = level * LEVEL_6DB;
|
|
173 return 3;
|
|
174
|
|
175 case CONVERT (A52_STEREO, A52_MONO):
|
|
176 coeff[0] = coeff[1] = level * LEVEL_3DB;
|
|
177 return 3;
|
|
178
|
|
179 case CONVERT (A52_3F, A52_MONO):
|
|
180 coeff[0] = coeff[2] = level * LEVEL_3DB;
|
|
181 coeff[1] = level * clev * LEVEL_PLUS3DB;
|
|
182 return 7;
|
|
183
|
|
184 case CONVERT (A52_2F1R, A52_MONO):
|
|
185 coeff[0] = coeff[1] = level * LEVEL_3DB;
|
|
186 coeff[2] = level * slev * LEVEL_3DB;
|
|
187 return 7;
|
|
188
|
|
189 case CONVERT (A52_2F2R, A52_MONO):
|
|
190 coeff[0] = coeff[1] = level * LEVEL_3DB;
|
|
191 coeff[2] = coeff[3] = level * slev * LEVEL_3DB;
|
|
192 return 15;
|
|
193
|
|
194 case CONVERT (A52_3F1R, A52_MONO):
|
|
195 coeff[0] = coeff[2] = level * LEVEL_3DB;
|
|
196 coeff[1] = level * clev * LEVEL_PLUS3DB;
|
|
197 coeff[3] = level * slev * LEVEL_3DB;
|
|
198 return 15;
|
|
199
|
|
200 case CONVERT (A52_3F2R, A52_MONO):
|
|
201 coeff[0] = coeff[2] = level * LEVEL_3DB;
|
|
202 coeff[1] = level * clev * LEVEL_PLUS3DB;
|
|
203 coeff[3] = coeff[4] = level * slev * LEVEL_3DB;
|
|
204 return 31;
|
|
205
|
|
206 case CONVERT (A52_MONO, A52_DOLBY):
|
|
207 coeff[0] = level * LEVEL_3DB;
|
|
208 return 0;
|
|
209
|
|
210 case CONVERT (A52_3F, A52_DOLBY):
|
|
211 clev = LEVEL_3DB;
|
|
212 case CONVERT (A52_3F, A52_STEREO):
|
|
213 case CONVERT (A52_3F1R, A52_2F1R):
|
|
214 case CONVERT (A52_3F2R, A52_2F2R):
|
|
215 coeff[0] = coeff[2] = coeff[3] = coeff[4] = level;
|
|
216 coeff[1] = level * clev;
|
|
217 return 7;
|
|
218
|
|
219 case CONVERT (A52_2F1R, A52_DOLBY):
|
|
220 slev = 1;
|
|
221 case CONVERT (A52_2F1R, A52_STEREO):
|
|
222 coeff[0] = coeff[1] = level;
|
|
223 coeff[2] = level * slev * LEVEL_3DB;
|
|
224 return 7;
|
|
225
|
|
226 case CONVERT (A52_3F1R, A52_DOLBY):
|
|
227 clev = LEVEL_3DB;
|
|
228 slev = 1;
|
|
229 case CONVERT (A52_3F1R, A52_STEREO):
|
|
230 coeff[0] = coeff[2] = level;
|
|
231 coeff[1] = level * clev;
|
|
232 coeff[3] = level * slev * LEVEL_3DB;
|
|
233 return 15;
|
|
234
|
|
235 case CONVERT (A52_2F2R, A52_DOLBY):
|
|
236 slev = LEVEL_3DB;
|
|
237 case CONVERT (A52_2F2R, A52_STEREO):
|
|
238 coeff[0] = coeff[1] = level;
|
|
239 coeff[2] = coeff[3] = level * slev;
|
|
240 return 15;
|
|
241
|
|
242 case CONVERT (A52_3F2R, A52_DOLBY):
|
|
243 clev = LEVEL_3DB;
|
|
244 case CONVERT (A52_3F2R, A52_2F1R):
|
|
245 slev = LEVEL_3DB;
|
|
246 case CONVERT (A52_3F2R, A52_STEREO):
|
|
247 coeff[0] = coeff[2] = level;
|
|
248 coeff[1] = level * clev;
|
|
249 coeff[3] = coeff[4] = level * slev;
|
|
250 return 31;
|
|
251
|
|
252 case CONVERT (A52_3F1R, A52_3F):
|
|
253 coeff[0] = coeff[1] = coeff[2] = level;
|
|
254 coeff[3] = level * slev * LEVEL_3DB;
|
|
255 return 13;
|
|
256
|
|
257 case CONVERT (A52_3F2R, A52_3F):
|
|
258 coeff[0] = coeff[1] = coeff[2] = level;
|
|
259 coeff[3] = coeff[4] = level * slev;
|
|
260 return 29;
|
|
261
|
|
262 case CONVERT (A52_2F2R, A52_2F1R):
|
|
263 coeff[0] = coeff[1] = level;
|
|
264 coeff[2] = coeff[3] = level * LEVEL_3DB;
|
|
265 return 12;
|
|
266
|
|
267 case CONVERT (A52_3F2R, A52_3F1R):
|
|
268 coeff[0] = coeff[1] = coeff[2] = level;
|
|
269 coeff[3] = coeff[4] = level * LEVEL_3DB;
|
|
270 return 24;
|
|
271
|
|
272 case CONVERT (A52_2F1R, A52_2F2R):
|
|
273 coeff[0] = coeff[1] = level;
|
|
274 coeff[2] = level * LEVEL_3DB;
|
|
275 return 0;
|
|
276
|
|
277 case CONVERT (A52_3F1R, A52_2F2R):
|
|
278 coeff[0] = coeff[2] = level;
|
|
279 coeff[1] = level * clev;
|
|
280 coeff[3] = level * LEVEL_3DB;
|
|
281 return 7;
|
|
282
|
|
283 case CONVERT (A52_3F1R, A52_3F2R):
|
|
284 coeff[0] = coeff[1] = coeff[2] = level;
|
|
285 coeff[3] = level * LEVEL_3DB;
|
|
286 return 0;
|
|
287
|
|
288 case CONVERT (A52_CHANNEL, A52_CHANNEL1):
|
|
289 coeff[0] = level;
|
|
290 coeff[1] = 0;
|
|
291 return 0;
|
|
292
|
|
293 case CONVERT (A52_CHANNEL, A52_CHANNEL2):
|
|
294 coeff[0] = 0;
|
|
295 coeff[1] = level;
|
|
296 return 0;
|
|
297 }
|
|
298
|
|
299 return -1; /* NOTREACHED */
|
|
300 }
|
|
301
|
|
302 static void mix2to1 (sample_t * dest, sample_t * src, sample_t bias)
|
|
303 {
|
|
304 int i;
|
|
305
|
|
306 for (i = 0; i < 256; i++)
|
|
307 dest[i] += src[i] + bias;
|
|
308 }
|
|
309
|
|
310 static void mix3to1 (sample_t * samples, sample_t bias)
|
|
311 {
|
|
312 int i;
|
|
313
|
|
314 for (i = 0; i < 256; i++)
|
|
315 samples[i] += samples[i + 256] + samples[i + 512] + bias;
|
|
316 }
|
|
317
|
|
318 static void mix4to1 (sample_t * samples, sample_t bias)
|
|
319 {
|
|
320 int i;
|
|
321
|
|
322 for (i = 0; i < 256; i++)
|
|
323 samples[i] += (samples[i + 256] + samples[i + 512] +
|
|
324 samples[i + 768] + bias);
|
|
325 }
|
|
326
|
|
327 static void mix5to1 (sample_t * samples, sample_t bias)
|
|
328 {
|
|
329 int i;
|
|
330
|
|
331 for (i = 0; i < 256; i++)
|
|
332 samples[i] += (samples[i + 256] + samples[i + 512] +
|
|
333 samples[i + 768] + samples[i + 1024] + bias);
|
|
334 }
|
|
335
|
|
336 static void mix3to2 (sample_t * samples, sample_t bias)
|
|
337 {
|
|
338 int i;
|
|
339 sample_t common;
|
|
340
|
|
341 for (i = 0; i < 256; i++) {
|
|
342 common = samples[i + 256] + bias;
|
|
343 samples[i] += common;
|
|
344 samples[i + 256] = samples[i + 512] + common;
|
|
345 }
|
|
346 }
|
|
347
|
|
348 static void mix21to2 (sample_t * left, sample_t * right, sample_t bias)
|
|
349 {
|
|
350 int i;
|
|
351 sample_t common;
|
|
352
|
|
353 for (i = 0; i < 256; i++) {
|
|
354 common = right[i + 256] + bias;
|
|
355 left[i] += common;
|
|
356 right[i] += common;
|
|
357 }
|
|
358 }
|
|
359
|
|
360 static void mix21toS (sample_t * samples, sample_t bias)
|
|
361 {
|
|
362 int i;
|
|
363 sample_t surround;
|
|
364
|
|
365 for (i = 0; i < 256; i++) {
|
|
366 surround = samples[i + 512];
|
|
367 samples[i] += bias - surround;
|
|
368 samples[i + 256] += bias + surround;
|
|
369 }
|
|
370 }
|
|
371
|
|
372 static void mix31to2 (sample_t * samples, sample_t bias)
|
|
373 {
|
|
374 int i;
|
|
375 sample_t common;
|
|
376
|
|
377 for (i = 0; i < 256; i++) {
|
|
378 common = samples[i + 256] + samples[i + 768] + bias;
|
|
379 samples[i] += common;
|
|
380 samples[i + 256] = samples[i + 512] + common;
|
|
381 }
|
|
382 }
|
|
383
|
|
384 static void mix31toS (sample_t * samples, sample_t bias)
|
|
385 {
|
|
386 int i;
|
|
387 sample_t common, surround;
|
|
388
|
|
389 for (i = 0; i < 256; i++) {
|
|
390 common = samples[i + 256] + bias;
|
|
391 surround = samples[i + 768];
|
|
392 samples[i] += common - surround;
|
|
393 samples[i + 256] = samples[i + 512] + common + surround;
|
|
394 }
|
|
395 }
|
|
396
|
|
397 static void mix22toS (sample_t * samples, sample_t bias)
|
|
398 {
|
|
399 int i;
|
|
400 sample_t surround;
|
|
401
|
|
402 for (i = 0; i < 256; i++) {
|
|
403 surround = samples[i + 512] + samples[i + 768];
|
|
404 samples[i] += bias - surround;
|
|
405 samples[i + 256] += bias + surround;
|
|
406 }
|
|
407 }
|
|
408
|
|
409 static void mix32to2 (sample_t * samples, sample_t bias)
|
|
410 {
|
|
411 int i;
|
|
412 sample_t common;
|
|
413
|
3624
|
414 #ifdef HAVE_SSE
|
|
415 asm volatile(
|
|
416 "movlps %1, %%xmm7 \n\t"
|
|
417 "shufps $0x00, %%xmm7, %%xmm7 \n\t"
|
|
418 "movl $-1024, %%esi \n\t"
|
|
419 "1: \n\t"
|
|
420 "movaps 1024(%0, %%esi), %%xmm0 \n\t"
|
|
421 "addps %%xmm7, %%xmm0 \n\t" // common
|
|
422 "movaps %%xmm0, %%xmm1 \n\t" // common
|
|
423 "addps (%0, %%esi), %%xmm0 \n\t"
|
|
424 "addps 2048(%0, %%esi), %%xmm1 \n\t"
|
|
425 "addps 3072(%0, %%esi), %%xmm0 \n\t"
|
|
426 "addps 4096(%0, %%esi), %%xmm1 \n\t"
|
|
427 "movaps %%xmm0, (%0, %%esi) \n\t"
|
|
428 "movaps %%xmm1, 1024(%0, %%esi) \n\t"
|
|
429 "addl $16, %%esi \n\t"
|
|
430 " jnz 1b \n\t"
|
|
431 :: "r" (samples+256), "m" (bias)
|
|
432 : "%esi"
|
|
433 );
|
|
434 #else
|
3394
|
435 for (i = 0; i < 256; i++) {
|
|
436 common = samples[i + 256] + bias;
|
|
437 samples[i] += common + samples[i + 768];
|
|
438 samples[i + 256] = common + samples[i + 512] + samples[i + 1024];
|
|
439 }
|
3624
|
440 #endif
|
3394
|
441 }
|
|
442
|
|
443 static void mix32toS (sample_t * samples, sample_t bias)
|
|
444 {
|
|
445 int i;
|
|
446 sample_t common, surround;
|
|
447
|
|
448 for (i = 0; i < 256; i++) {
|
|
449 common = samples[i + 256] + bias;
|
|
450 surround = samples[i + 768] + samples[i + 1024];
|
|
451 samples[i] += common - surround;
|
|
452 samples[i + 256] = samples[i + 512] + common + surround;
|
|
453 }
|
|
454 }
|
|
455
|
|
456 static void move2to1 (sample_t * src, sample_t * dest, sample_t bias)
|
|
457 {
|
|
458 int i;
|
|
459
|
|
460 for (i = 0; i < 256; i++)
|
|
461 dest[i] = src[i] + src[i + 256] + bias;
|
|
462 }
|
|
463
|
|
464 static void zero (sample_t * samples)
|
|
465 {
|
|
466 int i;
|
|
467
|
|
468 for (i = 0; i < 256; i++)
|
|
469 samples[i] = 0;
|
|
470 }
|
|
471
|
|
472 void downmix (sample_t * samples, int acmod, int output, sample_t bias,
|
|
473 sample_t clev, sample_t slev)
|
|
474 {
|
|
475 switch (CONVERT (acmod, output & A52_CHANNEL_MASK)) {
|
|
476
|
|
477 case CONVERT (A52_CHANNEL, A52_CHANNEL2):
|
|
478 memcpy (samples, samples + 256, 256 * sizeof (sample_t));
|
|
479 break;
|
|
480
|
|
481 case CONVERT (A52_CHANNEL, A52_MONO):
|
|
482 case CONVERT (A52_STEREO, A52_MONO):
|
|
483 mix_2to1:
|
|
484 mix2to1 (samples, samples + 256, bias);
|
|
485 break;
|
|
486
|
|
487 case CONVERT (A52_2F1R, A52_MONO):
|
|
488 if (slev == 0)
|
|
489 goto mix_2to1;
|
|
490 case CONVERT (A52_3F, A52_MONO):
|
|
491 mix_3to1:
|
|
492 mix3to1 (samples, bias);
|
|
493 break;
|
|
494
|
|
495 case CONVERT (A52_3F1R, A52_MONO):
|
|
496 if (slev == 0)
|
|
497 goto mix_3to1;
|
|
498 case CONVERT (A52_2F2R, A52_MONO):
|
|
499 if (slev == 0)
|
|
500 goto mix_2to1;
|
|
501 mix4to1 (samples, bias);
|
|
502 break;
|
|
503
|
|
504 case CONVERT (A52_3F2R, A52_MONO):
|
|
505 if (slev == 0)
|
|
506 goto mix_3to1;
|
|
507 mix5to1 (samples, bias);
|
|
508 break;
|
|
509
|
|
510 case CONVERT (A52_MONO, A52_DOLBY):
|
|
511 memcpy (samples + 256, samples, 256 * sizeof (sample_t));
|
|
512 break;
|
|
513
|
|
514 case CONVERT (A52_3F, A52_STEREO):
|
|
515 case CONVERT (A52_3F, A52_DOLBY):
|
|
516 mix_3to2:
|
|
517 mix3to2 (samples, bias);
|
|
518 break;
|
|
519
|
|
520 case CONVERT (A52_2F1R, A52_STEREO):
|
|
521 if (slev == 0)
|
|
522 break;
|
|
523 mix21to2 (samples, samples + 256, bias);
|
|
524 break;
|
|
525
|
|
526 case CONVERT (A52_2F1R, A52_DOLBY):
|
|
527 mix21toS (samples, bias);
|
|
528 break;
|
|
529
|
|
530 case CONVERT (A52_3F1R, A52_STEREO):
|
|
531 if (slev == 0)
|
|
532 goto mix_3to2;
|
|
533 mix31to2 (samples, bias);
|
|
534 break;
|
|
535
|
|
536 case CONVERT (A52_3F1R, A52_DOLBY):
|
|
537 mix31toS (samples, bias);
|
|
538 break;
|
|
539
|
|
540 case CONVERT (A52_2F2R, A52_STEREO):
|
|
541 if (slev == 0)
|
|
542 break;
|
|
543 mix2to1 (samples, samples + 512, bias);
|
|
544 mix2to1 (samples + 256, samples + 768, bias);
|
|
545 break;
|
|
546
|
|
547 case CONVERT (A52_2F2R, A52_DOLBY):
|
|
548 mix22toS (samples, bias);
|
|
549 break;
|
|
550
|
|
551 case CONVERT (A52_3F2R, A52_STEREO):
|
|
552 if (slev == 0)
|
|
553 goto mix_3to2;
|
|
554 mix32to2 (samples, bias);
|
|
555 break;
|
|
556
|
|
557 case CONVERT (A52_3F2R, A52_DOLBY):
|
|
558 mix32toS (samples, bias);
|
|
559 break;
|
|
560
|
|
561 case CONVERT (A52_3F1R, A52_3F):
|
|
562 if (slev == 0)
|
|
563 break;
|
|
564 mix21to2 (samples, samples + 512, bias);
|
|
565 break;
|
|
566
|
|
567 case CONVERT (A52_3F2R, A52_3F):
|
|
568 if (slev == 0)
|
|
569 break;
|
|
570 mix2to1 (samples, samples + 768, bias);
|
|
571 mix2to1 (samples + 512, samples + 1024, bias);
|
|
572 break;
|
|
573
|
|
574 case CONVERT (A52_3F1R, A52_2F1R):
|
|
575 mix3to2 (samples, bias);
|
|
576 memcpy (samples + 512, samples + 768, 256 * sizeof (sample_t));
|
|
577 break;
|
|
578
|
|
579 case CONVERT (A52_2F2R, A52_2F1R):
|
|
580 mix2to1 (samples + 512, samples + 768, bias);
|
|
581 break;
|
|
582
|
|
583 case CONVERT (A52_3F2R, A52_2F1R):
|
|
584 mix3to2 (samples, bias);
|
|
585 move2to1 (samples + 768, samples + 512, bias);
|
|
586 break;
|
|
587
|
|
588 case CONVERT (A52_3F2R, A52_3F1R):
|
|
589 mix2to1 (samples + 768, samples + 1024, bias);
|
|
590 break;
|
|
591
|
|
592 case CONVERT (A52_2F1R, A52_2F2R):
|
|
593 memcpy (samples + 768, samples + 512, 256 * sizeof (sample_t));
|
|
594 break;
|
|
595
|
|
596 case CONVERT (A52_3F1R, A52_2F2R):
|
|
597 mix3to2 (samples, bias);
|
|
598 memcpy (samples + 512, samples + 768, 256 * sizeof (sample_t));
|
|
599 break;
|
|
600
|
|
601 case CONVERT (A52_3F2R, A52_2F2R):
|
|
602 mix3to2 (samples, bias);
|
|
603 memcpy (samples + 512, samples + 768, 256 * sizeof (sample_t));
|
|
604 memcpy (samples + 768, samples + 1024, 256 * sizeof (sample_t));
|
|
605 break;
|
|
606
|
|
607 case CONVERT (A52_3F1R, A52_3F2R):
|
|
608 memcpy (samples + 1027, samples + 768, 256 * sizeof (sample_t));
|
|
609 break;
|
|
610 }
|
|
611 }
|
|
612
|
|
613 void upmix (sample_t * samples, int acmod, int output)
|
|
614 {
|
|
615 switch (CONVERT (acmod, output & A52_CHANNEL_MASK)) {
|
|
616
|
|
617 case CONVERT (A52_CHANNEL, A52_CHANNEL2):
|
|
618 memcpy (samples + 256, samples, 256 * sizeof (sample_t));
|
|
619 break;
|
|
620
|
|
621 case CONVERT (A52_3F2R, A52_MONO):
|
|
622 zero (samples + 1024);
|
|
623 case CONVERT (A52_3F1R, A52_MONO):
|
|
624 case CONVERT (A52_2F2R, A52_MONO):
|
|
625 zero (samples + 768);
|
|
626 case CONVERT (A52_3F, A52_MONO):
|
|
627 case CONVERT (A52_2F1R, A52_MONO):
|
|
628 zero (samples + 512);
|
|
629 case CONVERT (A52_CHANNEL, A52_MONO):
|
|
630 case CONVERT (A52_STEREO, A52_MONO):
|
|
631 zero (samples + 256);
|
|
632 break;
|
|
633
|
|
634 case CONVERT (A52_3F2R, A52_STEREO):
|
|
635 case CONVERT (A52_3F2R, A52_DOLBY):
|
|
636 zero (samples + 1024);
|
|
637 case CONVERT (A52_3F1R, A52_STEREO):
|
|
638 case CONVERT (A52_3F1R, A52_DOLBY):
|
|
639 zero (samples + 768);
|
|
640 case CONVERT (A52_3F, A52_STEREO):
|
|
641 case CONVERT (A52_3F, A52_DOLBY):
|
|
642 mix_3to2:
|
|
643 memcpy (samples + 512, samples + 256, 256 * sizeof (sample_t));
|
|
644 zero (samples + 256);
|
|
645 break;
|
|
646
|
|
647 case CONVERT (A52_2F2R, A52_STEREO):
|
|
648 case CONVERT (A52_2F2R, A52_DOLBY):
|
|
649 zero (samples + 768);
|
|
650 case CONVERT (A52_2F1R, A52_STEREO):
|
|
651 case CONVERT (A52_2F1R, A52_DOLBY):
|
|
652 zero (samples + 512);
|
|
653 break;
|
|
654
|
|
655 case CONVERT (A52_3F2R, A52_3F):
|
|
656 zero (samples + 1024);
|
|
657 case CONVERT (A52_3F1R, A52_3F):
|
|
658 case CONVERT (A52_2F2R, A52_2F1R):
|
|
659 zero (samples + 768);
|
|
660 break;
|
|
661
|
|
662 case CONVERT (A52_3F2R, A52_3F1R):
|
|
663 zero (samples + 1024);
|
|
664 break;
|
|
665
|
|
666 case CONVERT (A52_3F2R, A52_2F1R):
|
|
667 zero (samples + 1024);
|
|
668 case CONVERT (A52_3F1R, A52_2F1R):
|
|
669 mix_31to21:
|
|
670 memcpy (samples + 768, samples + 512, 256 * sizeof (sample_t));
|
|
671 goto mix_3to2;
|
|
672
|
|
673 case CONVERT (A52_3F2R, A52_2F2R):
|
|
674 memcpy (samples + 1024, samples + 768, 256 * sizeof (sample_t));
|
|
675 goto mix_31to21;
|
|
676 }
|
|
677 }
|