yading@10: /*
yading@10:  * Format Conversion Utils
yading@10:  * Copyright (c) 2000, 2001 Fabrice Bellard
yading@10:  * Copyright (c) 2002-2004 Michael Niedermayer <michaelni@gmx.at>
yading@10:  *
yading@10:  * This file is part of FFmpeg.
yading@10:  *
yading@10:  * FFmpeg is free software; you can redistribute it and/or
yading@10:  * modify it under the terms of the GNU Lesser General Public
yading@10:  * License as published by the Free Software Foundation; either
yading@10:  * version 2.1 of the License, or (at your option) any later version.
yading@10:  *
yading@10:  * FFmpeg is distributed in the hope that it will be useful,
yading@10:  * but WITHOUT ANY WARRANTY; without even the implied warranty of
yading@10:  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
yading@10:  * Lesser General Public License for more details.
yading@10:  *
yading@10:  * You should have received a copy of the GNU Lesser General Public
yading@10:  * License along with FFmpeg; if not, write to the Free Software
yading@10:  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA
yading@10:  */
yading@10: 
yading@10: #include "avcodec.h"
yading@10: #include "fmtconvert.h"
yading@10: #include "libavutil/common.h"
yading@10: 
yading@10: static void int32_to_float_fmul_scalar_c(float *dst, const int *src, float mul, int len){
yading@10:     int i;
yading@10:     for(i=0; i<len; i++)
yading@10:         dst[i] = src[i] * mul;
yading@10: }
yading@10: 
yading@10: static av_always_inline int float_to_int16_one(const float *src){
yading@10:     return av_clip_int16(lrintf(*src));
yading@10: }
yading@10: 
yading@10: static void float_to_int16_c(int16_t *dst, const float *src, long len)
yading@10: {
yading@10:     int i;
yading@10:     for(i=0; i<len; i++)
yading@10:         dst[i] = float_to_int16_one(src+i);
yading@10: }
yading@10: 
yading@10: static void float_to_int16_interleave_c(int16_t *dst, const float **src,
yading@10:                                         long len, int channels)
yading@10: {
yading@10:     int i,j,c;
yading@10:     if(channels==2){
yading@10:         for(i=0; i<len; i++){
yading@10:             dst[2*i]   = float_to_int16_one(src[0]+i);
yading@10:             dst[2*i+1] = float_to_int16_one(src[1]+i);
yading@10:         }
yading@10:     }else{
yading@10:         for(c=0; c<channels; c++)
yading@10:             for(i=0, j=c; i<len; i++, j+=channels)
yading@10:                 dst[j] = float_to_int16_one(src[c]+i);
yading@10:     }
yading@10: }
yading@10: 
yading@10: void ff_float_interleave_c(float *dst, const float **src, unsigned int len,
yading@10:                            int channels)
yading@10: {
yading@10:     int j, c;
yading@10:     unsigned int i;
yading@10:     if (channels == 2) {
yading@10:         for (i = 0; i < len; i++) {
yading@10:             dst[2*i]   = src[0][i];
yading@10:             dst[2*i+1] = src[1][i];
yading@10:         }
yading@10:     } else if (channels == 1 && len < INT_MAX / sizeof(float)) {
yading@10:         memcpy(dst, src[0], len * sizeof(float));
yading@10:     } else {
yading@10:         for (c = 0; c < channels; c++)
yading@10:             for (i = 0, j = c; i < len; i++, j += channels)
yading@10:                 dst[j] = src[c][i];
yading@10:     }
yading@10: }
yading@10: 
yading@10: av_cold void ff_fmt_convert_init(FmtConvertContext *c, AVCodecContext *avctx)
yading@10: {
yading@10:     c->int32_to_float_fmul_scalar = int32_to_float_fmul_scalar_c;
yading@10:     c->float_to_int16             = float_to_int16_c;
yading@10:     c->float_to_int16_interleave  = float_to_int16_interleave_c;
yading@10:     c->float_interleave           = ff_float_interleave_c;
yading@10: 
yading@10:     if (ARCH_ARM) ff_fmt_convert_init_arm(c, avctx);
yading@10:     if (HAVE_ALTIVEC) ff_fmt_convert_init_altivec(c, avctx);
yading@10:     if (ARCH_X86) ff_fmt_convert_init_x86(c, avctx);
yading@10:     if (HAVE_MIPSFPU) ff_fmt_convert_init_mips(c);
yading@10: }
yading@10: 
yading@10: /* ffdshow custom code */
yading@10: void float_interleave(float *dst, const float **src, long len, int channels)
yading@10: {
yading@10:     int i,j,c;
yading@10:     if(channels==2){
yading@10:         for(i=0; i<len; i++){
yading@10:             dst[2*i]   = src[0][i] / 32768.0f;
yading@10:             dst[2*i+1] = src[1][i] / 32768.0f;
yading@10:         }
yading@10:     }else{
yading@10:         for(c=0; c<channels; c++)
yading@10:             for(i=0, j=c; i<len; i++, j+=channels)
yading@10:                 dst[j] = src[c][i] / 32768.0f;
yading@10:     }
yading@10: }
yading@10: 
yading@10: void float_interleave_noscale(float *dst, const float **src, long len, int channels)
yading@10: {
yading@10:     int i,j,c;
yading@10:     if(channels==2){
yading@10:         for(i=0; i<len; i++){
yading@10:             dst[2*i]   = src[0][i];
yading@10:             dst[2*i+1] = src[1][i];
yading@10:         }
yading@10:     }else{
yading@10:         for(c=0; c<channels; c++)
yading@10:             for(i=0, j=c; i<len; i++, j+=channels)
yading@10:                 dst[j] = src[c][i];
yading@10:     }
yading@10: }