1 /* 2 * Copyright (c) 2012 The WebRTC project authors. All Rights Reserved. 3 * 4 * Use of this source code is governed by a BSD-style license 5 * that can be found in the LICENSE file in the root of the source 6 * tree. An additional intellectual property rights grant can be found 7 * in the file PATENTS. All contributing project authors may 8 * be found in the AUTHORS file in the root of the source tree. 9 */ 10 11 12 /* 13 * This file contains implementations of the functions 14 * WebRtcSpl_VectorBitShiftW16() 15 * WebRtcSpl_VectorBitShiftW32() 16 * WebRtcSpl_VectorBitShiftW32ToW16() 17 * WebRtcSpl_ScaleVector() 18 * WebRtcSpl_ScaleVectorWithSat() 19 * WebRtcSpl_ScaleAndAddVectors() 20 * WebRtcSpl_ScaleAndAddVectorsWithRoundC() 21 */ 22 23 #include "webrtc/common_audio/signal_processing/include/signal_processing_library.h" 24 WebRtcSpl_VectorBitShiftW16(int16_t * res,size_t length,const int16_t * in,int16_t right_shifts)25 void WebRtcSpl_VectorBitShiftW16(int16_t *res, size_t length, 26 const int16_t *in, int16_t right_shifts) 27 { 28 size_t i; 29 30 if (right_shifts > 0) 31 { 32 for (i = length; i > 0; i--) 33 { 34 (*res++) = ((*in++) >> right_shifts); 35 } 36 } else 37 { 38 for (i = length; i > 0; i--) 39 { 40 (*res++) = ((*in++) << (-right_shifts)); 41 } 42 } 43 } 44 WebRtcSpl_VectorBitShiftW32(int32_t * out_vector,size_t vector_length,const int32_t * in_vector,int16_t right_shifts)45 void WebRtcSpl_VectorBitShiftW32(int32_t *out_vector, 46 size_t vector_length, 47 const int32_t *in_vector, 48 int16_t right_shifts) 49 { 50 size_t i; 51 52 if (right_shifts > 0) 53 { 54 for (i = vector_length; i > 0; i--) 55 { 56 (*out_vector++) = ((*in_vector++) >> right_shifts); 57 } 58 } else 59 { 60 for (i = vector_length; i > 0; i--) 61 { 62 (*out_vector++) = ((*in_vector++) << (-right_shifts)); 63 } 64 } 65 } 66 WebRtcSpl_VectorBitShiftW32ToW16(int16_t * out,size_t length,const int32_t * in,int right_shifts)67 void WebRtcSpl_VectorBitShiftW32ToW16(int16_t* out, size_t length, 68 const int32_t* in, int right_shifts) { 69 size_t i; 70 int32_t tmp_w32; 71 72 if (right_shifts >= 0) { 73 for (i = length; i > 0; i--) { 74 tmp_w32 = (*in++) >> right_shifts; 75 (*out++) = WebRtcSpl_SatW32ToW16(tmp_w32); 76 } 77 } else { 78 int left_shifts = -right_shifts; 79 for (i = length; i > 0; i--) { 80 tmp_w32 = (*in++) << left_shifts; 81 (*out++) = WebRtcSpl_SatW32ToW16(tmp_w32); 82 } 83 } 84 } 85 WebRtcSpl_ScaleVector(const int16_t * in_vector,int16_t * out_vector,int16_t gain,size_t in_vector_length,int16_t right_shifts)86 void WebRtcSpl_ScaleVector(const int16_t *in_vector, int16_t *out_vector, 87 int16_t gain, size_t in_vector_length, 88 int16_t right_shifts) 89 { 90 // Performs vector operation: out_vector = (gain*in_vector)>>right_shifts 91 size_t i; 92 const int16_t *inptr; 93 int16_t *outptr; 94 95 inptr = in_vector; 96 outptr = out_vector; 97 98 for (i = 0; i < in_vector_length; i++) 99 { 100 *outptr++ = (int16_t)((*inptr++ * gain) >> right_shifts); 101 } 102 } 103 WebRtcSpl_ScaleVectorWithSat(const int16_t * in_vector,int16_t * out_vector,int16_t gain,size_t in_vector_length,int16_t right_shifts)104 void WebRtcSpl_ScaleVectorWithSat(const int16_t *in_vector, int16_t *out_vector, 105 int16_t gain, size_t in_vector_length, 106 int16_t right_shifts) 107 { 108 // Performs vector operation: out_vector = (gain*in_vector)>>right_shifts 109 size_t i; 110 const int16_t *inptr; 111 int16_t *outptr; 112 113 inptr = in_vector; 114 outptr = out_vector; 115 116 for (i = 0; i < in_vector_length; i++) { 117 *outptr++ = WebRtcSpl_SatW32ToW16((*inptr++ * gain) >> right_shifts); 118 } 119 } 120 WebRtcSpl_ScaleAndAddVectors(const int16_t * in1,int16_t gain1,int shift1,const int16_t * in2,int16_t gain2,int shift2,int16_t * out,size_t vector_length)121 void WebRtcSpl_ScaleAndAddVectors(const int16_t *in1, int16_t gain1, int shift1, 122 const int16_t *in2, int16_t gain2, int shift2, 123 int16_t *out, size_t vector_length) 124 { 125 // Performs vector operation: out = (gain1*in1)>>shift1 + (gain2*in2)>>shift2 126 size_t i; 127 const int16_t *in1ptr; 128 const int16_t *in2ptr; 129 int16_t *outptr; 130 131 in1ptr = in1; 132 in2ptr = in2; 133 outptr = out; 134 135 for (i = 0; i < vector_length; i++) 136 { 137 *outptr++ = (int16_t)((gain1 * *in1ptr++) >> shift1) + 138 (int16_t)((gain2 * *in2ptr++) >> shift2); 139 } 140 } 141 142 // C version of WebRtcSpl_ScaleAndAddVectorsWithRound() for generic platforms. WebRtcSpl_ScaleAndAddVectorsWithRoundC(const int16_t * in_vector1,int16_t in_vector1_scale,const int16_t * in_vector2,int16_t in_vector2_scale,int right_shifts,int16_t * out_vector,size_t length)143 int WebRtcSpl_ScaleAndAddVectorsWithRoundC(const int16_t* in_vector1, 144 int16_t in_vector1_scale, 145 const int16_t* in_vector2, 146 int16_t in_vector2_scale, 147 int right_shifts, 148 int16_t* out_vector, 149 size_t length) { 150 size_t i = 0; 151 int round_value = (1 << right_shifts) >> 1; 152 153 if (in_vector1 == NULL || in_vector2 == NULL || out_vector == NULL || 154 length == 0 || right_shifts < 0) { 155 return -1; 156 } 157 158 for (i = 0; i < length; i++) { 159 out_vector[i] = (int16_t)(( 160 in_vector1[i] * in_vector1_scale + in_vector2[i] * in_vector2_scale + 161 round_value) >> right_shifts); 162 } 163 164 return 0; 165 } 166