• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
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