diff options
Diffstat (limited to 'plugins/dca/convert2s16.c')
-rw-r--r-- | plugins/dca/convert2s16.c | 218 |
1 files changed, 218 insertions, 0 deletions
diff --git a/plugins/dca/convert2s16.c b/plugins/dca/convert2s16.c new file mode 100644 index 00000000..b0647eae --- /dev/null +++ b/plugins/dca/convert2s16.c @@ -0,0 +1,218 @@ +/* + * convert2s16.c + * Copyright (C) 2000-2003 Michel Lespinasse <walken@zoy.org> + * Copyright (C) 1999-2000 Aaron Holtzman <aholtzma@ess.engr.uvic.ca> + * + * This file is part of a52dec, a free ATSC A-52 stream decoder. + * See http://liba52.sourceforge.net/ for updates. + * + * a52dec is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * a52dec is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the + * Free Software Foundation, Inc., + * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. + */ + +#include "config.h" + +#include <inttypes.h> + +#include "dca.h" + +#include <stdio.h> + +#ifdef LIBDCA_DOUBLE +typedef float convert_t; +#else +typedef sample_t convert_t; +#endif + +static inline int16_t convert (int32_t i) +{ +#ifdef LIBDCA_FIXED + i >>= 15; +#else + i -= 0x43c00000; +#endif + return (i > 32767) ? 32767 : ((i < -32768) ? -32768 : i); +} + +void convert2s16_1 (convert_t * _f, int16_t * s16) +{ + int i; + int32_t * f = (int32_t *) _f; + + for (i = 0; i < 256; i++) { + s16[i] = convert (f[i]); + } +} + +void convert2s16_2 (convert_t * _f, int16_t * s16) +{ + int i; + int32_t * f = (int32_t *) _f; + + for (i = 0; i < 256; i++) { + s16[2*i] = convert (f[i]); + s16[2*i+1] = convert (f[i+256]); + } +} + +void convert2s16_3 (convert_t * _f, int16_t * s16) +{ + int i; + int32_t * f = (int32_t *) _f; + + for (i = 0; i < 256; i++) { + s16[3*i] = convert (f[i]); + s16[3*i+1] = convert (f[i+256]); + s16[3*i+2] = convert (f[i+512]); + } +} + +void convert2s16_4 (convert_t * _f, int16_t * s16) +{ + int i; + int32_t * f = (int32_t *) _f; + + for (i = 0; i < 256; i++) { + s16[4*i] = convert (f[i]); + s16[4*i+1] = convert (f[i+256]); + s16[4*i+2] = convert (f[i+512]); + s16[4*i+3] = convert (f[i+768]); + } +} + +void convert2s16_5 (convert_t * _f, int16_t * s16) +{ + int i; + int32_t * f = (int32_t *) _f; + + for (i = 0; i < 256; i++) { + s16[5*i] = convert (f[i]); + s16[5*i+1] = convert (f[i+256]); + s16[5*i+2] = convert (f[i+512]); + s16[5*i+3] = convert (f[i+768]); + s16[5*i+4] = convert (f[i+1024]); + } +} + +int channels_multi (int flags) +{ + if (flags & DCA_LFE) + return 6; + else if (flags & 1) /* center channel */ + return 5; + else if ((flags & DCA_CHANNEL_MASK) == DCA_2F2R) + return 4; + else + return 2; +} + +void convert2s16_multi (convert_t * _f, int16_t * s16, int flags) +{ + int i; + int32_t * f = (int32_t *) _f; + + switch (flags) { + case DCA_MONO: + for (i = 0; i < 256; i++) { + s16[5*i] = s16[5*i+1] = s16[5*i+2] = s16[5*i+3] = 0; + s16[5*i+4] = convert (f[i]); + } + break; + case DCA_CHANNEL: + case DCA_STEREO: + case DCA_DOLBY: + convert2s16_2 (_f, s16); + break; + case DCA_3F: + for (i = 0; i < 256; i++) { + s16[5*i] = convert (f[i]); + s16[5*i+1] = convert (f[i+512]); + s16[5*i+2] = s16[5*i+3] = 0; + s16[5*i+4] = convert (f[i+256]); + } + break; + case DCA_2F2R: + convert2s16_4 (_f, s16); + break; + case DCA_3F2R: + convert2s16_5 (_f, s16); + break; + case DCA_MONO | DCA_LFE: + for (i = 0; i < 256; i++) { + s16[6*i] = s16[6*i+1] = s16[6*i+2] = s16[6*i+3] = 0; + s16[6*i+4] = convert (f[i+256]); + s16[6*i+5] = convert (f[i]); + } + break; + case DCA_CHANNEL | DCA_LFE: + case DCA_STEREO | DCA_LFE: + case DCA_DOLBY | DCA_LFE: + for (i = 0; i < 256; i++) { + s16[6*i] = convert (f[i+256]); + s16[6*i+1] = convert (f[i+512]); + s16[6*i+2] = s16[6*i+3] = s16[6*i+4] = 0; + s16[6*i+5] = convert (f[i]); + } + break; + case DCA_3F | DCA_LFE: + for (i = 0; i < 256; i++) { + s16[6*i] = convert (f[i+256]); + s16[6*i+1] = convert (f[i+768]); + s16[6*i+2] = s16[6*i+3] = 0; + s16[6*i+4] = convert (f[i+512]); + s16[6*i+5] = convert (f[i]); + } + break; + case DCA_2F2R | DCA_LFE: + for (i = 0; i < 256; i++) { + s16[6*i] = convert (f[i+256]); + s16[6*i+1] = convert (f[i+512]); + s16[6*i+2] = convert (f[i+768]); + s16[6*i+3] = convert (f[i+1024]); + s16[6*i+4] = 0; + s16[6*i+5] = convert (f[i]); + } + break; + case DCA_3F2R | DCA_LFE: + for (i = 0; i < 256; i++) { + s16[6*i] = convert (f[i+256]); + s16[6*i+1] = convert (f[i+768]); + s16[6*i+2] = convert (f[i+1024]); + s16[6*i+3] = convert (f[i+1280]); + s16[6*i+4] = convert (f[i+512]); + s16[6*i+5] = convert (f[i]); + } + break; + } +} + +void s16_swap (int16_t * s16, int channels) +{ + int i; + uint16_t * u16 = (uint16_t *) s16; + + for (i = 0; i < 256 * channels; i++) + u16[i] = (u16[i] >> 8) | (u16[i] << 8); +} + +void s32_swap (int32_t * s32, int channels) +{ + int i; + uint32_t * u32 = (uint32_t *) s32; + + for (i = 0; i < 256 * channels; i++) + u32[i] = (u32[i] << 24) | ((u32[i] << 8)&0xFF0000) | + ((u32[i] >> 8)&0xFF00) | (u32[i] >> 24); +} |