1 /*
2 * Copyright (c) 2011 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 * WebRtcIsacfix_kTransform.c
13 *
14 * Transform functions
15 *
16 */
17
18 #include "fft.h"
19 #include "codec.h"
20 #include "settings.h"
21
22
23 /* Cosine table 1 in Q14 */
24 static const WebRtc_Word16 kCosTab1[FRAMESAMPLES/2] = {
25 16384, 16383, 16378, 16371, 16362, 16349, 16333, 16315, 16294, 16270,
26 16244, 16214, 16182, 16147, 16110, 16069, 16026, 15980, 15931, 15880,
27 15826, 15769, 15709, 15647, 15582, 15515, 15444, 15371, 15296, 15218,
28 15137, 15053, 14968, 14879, 14788, 14694, 14598, 14500, 14399, 14295,
29 14189, 14081, 13970, 13856, 13741, 13623, 13502, 13380, 13255, 13128,
30 12998, 12867, 12733, 12597, 12458, 12318, 12176, 12031, 11885, 11736,
31 11585, 11433, 11278, 11121, 10963, 10803, 10641, 10477, 10311, 10143,
32 9974, 9803, 9630, 9456, 9280, 9102, 8923, 8743, 8561, 8377,
33 8192, 8006, 7818, 7629, 7438, 7246, 7053, 6859, 6664, 6467,
34 6270, 6071, 5872, 5671, 5469, 5266, 5063, 4859, 4653, 4447,
35 4240, 4033, 3825, 3616, 3406, 3196, 2986, 2775, 2563, 2351,
36 2139, 1926, 1713, 1499, 1285, 1072, 857, 643, 429, 214,
37 0, -214, -429, -643, -857, -1072, -1285, -1499, -1713, -1926,
38 -2139, -2351, -2563, -2775, -2986, -3196, -3406, -3616, -3825, -4033,
39 -4240, -4447, -4653, -4859, -5063, -5266, -5469, -5671, -5872, -6071,
40 -6270, -6467, -6664, -6859, -7053, -7246, -7438, -7629, -7818, -8006,
41 -8192, -8377, -8561, -8743, -8923, -9102, -9280, -9456, -9630, -9803,
42 -9974, -10143, -10311, -10477, -10641, -10803, -10963, -11121, -11278, -11433,
43 -11585, -11736, -11885, -12031, -12176, -12318, -12458, -12597, -12733, -12867,
44 -12998, -13128, -13255, -13380, -13502, -13623, -13741, -13856, -13970, -14081,
45 -14189, -14295, -14399, -14500, -14598, -14694, -14788, -14879, -14968, -15053,
46 -15137, -15218, -15296, -15371, -15444, -15515, -15582, -15647, -15709, -15769,
47 -15826, -15880, -15931, -15980, -16026, -16069, -16110, -16147, -16182, -16214,
48 -16244, -16270, -16294, -16315, -16333, -16349, -16362, -16371, -16378, -16383
49 };
50
51
52 /* Sine table 1 in Q14 */
53 static const WebRtc_Word16 kSinTab1[FRAMESAMPLES/2] = {
54 0, 214, 429, 643, 857, 1072, 1285, 1499, 1713, 1926,
55 2139, 2351, 2563, 2775, 2986, 3196, 3406, 3616, 3825, 4033,
56 4240, 4447, 4653, 4859, 5063, 5266, 5469, 5671, 5872, 6071,
57 6270, 6467, 6664, 6859, 7053, 7246, 7438, 7629, 7818, 8006,
58 8192, 8377, 8561, 8743, 8923, 9102, 9280, 9456, 9630, 9803,
59 9974, 10143, 10311, 10477, 10641, 10803, 10963, 11121, 11278, 11433,
60 11585, 11736, 11885, 12031, 12176, 12318, 12458, 12597, 12733, 12867,
61 12998, 13128, 13255, 13380, 13502, 13623, 13741, 13856, 13970, 14081,
62 14189, 14295, 14399, 14500, 14598, 14694, 14788, 14879, 14968, 15053,
63 15137, 15218, 15296, 15371, 15444, 15515, 15582, 15647, 15709, 15769,
64 15826, 15880, 15931, 15980, 16026, 16069, 16110, 16147, 16182, 16214,
65 16244, 16270, 16294, 16315, 16333, 16349, 16362, 16371, 16378, 16383,
66 16384, 16383, 16378, 16371, 16362, 16349, 16333, 16315, 16294, 16270,
67 16244, 16214, 16182, 16147, 16110, 16069, 16026, 15980, 15931, 15880,
68 15826, 15769, 15709, 15647, 15582, 15515, 15444, 15371, 15296, 15218,
69 15137, 15053, 14968, 14879, 14788, 14694, 14598, 14500, 14399, 14295,
70 14189, 14081, 13970, 13856, 13741, 13623, 13502, 13380, 13255, 13128,
71 12998, 12867, 12733, 12597, 12458, 12318, 12176, 12031, 11885, 11736,
72 11585, 11433, 11278, 11121, 10963, 10803, 10641, 10477, 10311, 10143,
73 9974, 9803, 9630, 9456, 9280, 9102, 8923, 8743, 8561, 8377,
74 8192, 8006, 7818, 7629, 7438, 7246, 7053, 6859, 6664, 6467,
75 6270, 6071, 5872, 5671, 5469, 5266, 5063, 4859, 4653, 4447,
76 4240, 4033, 3825, 3616, 3406, 3196, 2986, 2775, 2563, 2351,
77 2139, 1926, 1713, 1499, 1285, 1072, 857, 643, 429, 214
78 };
79
80
81 /* Cosine table 2 in Q14 */
82 static const WebRtc_Word16 kCosTab2[FRAMESAMPLES/4] = {
83 107, -322, 536, -750, 965, -1179, 1392, -1606, 1819, -2032,
84 2245, -2457, 2669, -2880, 3091, -3301, 3511, -3720, 3929, -4137,
85 4344, -4550, 4756, -4961, 5165, -5368, 5570, -5771, 5971, -6171,
86 6369, -6566, 6762, -6957, 7150, -7342, 7534, -7723, 7912, -8099,
87 8285, -8469, 8652, -8833, 9013, -9191, 9368, -9543, 9717, -9889,
88 10059, -10227, 10394, -10559, 10722, -10883, 11042, -11200, 11356, -11509,
89 11661, -11810, 11958, -12104, 12247, -12389, 12528, -12665, 12800, -12933,
90 13063, -13192, 13318, -13441, 13563, -13682, 13799, -13913, 14025, -14135,
91 14242, -14347, 14449, -14549, 14647, -14741, 14834, -14924, 15011, -15095,
92 15178, -15257, 15334, -15408, 15480, -15549, 15615, -15679, 15739, -15798,
93 15853, -15906, 15956, -16003, 16048, -16090, 16129, -16165, 16199, -16229,
94 16257, -16283, 16305, -16325, 16342, -16356, 16367, -16375, 16381, -16384
95 };
96
97
98 /* Sine table 2 in Q14 */
99 static const WebRtc_Word16 kSinTab2[FRAMESAMPLES/4] = {
100 16384, -16381, 16375, -16367, 16356, -16342, 16325, -16305, 16283, -16257,
101 16229, -16199, 16165, -16129, 16090, -16048, 16003, -15956, 15906, -15853,
102 15798, -15739, 15679, -15615, 15549, -15480, 15408, -15334, 15257, -15178,
103 15095, -15011, 14924, -14834, 14741, -14647, 14549, -14449, 14347, -14242,
104 14135, -14025, 13913, -13799, 13682, -13563, 13441, -13318, 13192, -13063,
105 12933, -12800, 12665, -12528, 12389, -12247, 12104, -11958, 11810, -11661,
106 11509, -11356, 11200, -11042, 10883, -10722, 10559, -10394, 10227, -10059,
107 9889, -9717, 9543, -9368, 9191, -9013, 8833, -8652, 8469, -8285,
108 8099, -7912, 7723, -7534, 7342, -7150, 6957, -6762, 6566, -6369,
109 6171, -5971, 5771, -5570, 5368, -5165, 4961, -4756, 4550, -4344,
110 4137, -3929, 3720, -3511, 3301, -3091, 2880, -2669, 2457, -2245,
111 2032, -1819, 1606, -1392, 1179, -965, 750, -536, 322, -107
112 };
113
114
115
WebRtcIsacfix_Time2Spec(WebRtc_Word16 * inre1Q9,WebRtc_Word16 * inre2Q9,WebRtc_Word16 * outreQ7,WebRtc_Word16 * outimQ7)116 void WebRtcIsacfix_Time2Spec(WebRtc_Word16 *inre1Q9,
117 WebRtc_Word16 *inre2Q9,
118 WebRtc_Word16 *outreQ7,
119 WebRtc_Word16 *outimQ7)
120 {
121
122 int k;
123 WebRtc_Word32 tmpreQ16[FRAMESAMPLES/2], tmpimQ16[FRAMESAMPLES/2];
124 WebRtc_Word16 tmp1rQ14, tmp1iQ14;
125 WebRtc_Word32 xrQ16, xiQ16, yrQ16, yiQ16;
126 WebRtc_Word32 v1Q16, v2Q16;
127 WebRtc_Word16 factQ19, sh;
128
129 /* Multiply with complex exponentials and combine into one complex vector */
130 factQ19 = 16921; // 0.5/sqrt(240) in Q19 is round(.5/sqrt(240)*(2^19)) = 16921
131 for (k = 0; k < FRAMESAMPLES/2; k++) {
132 tmp1rQ14 = kCosTab1[k];
133 tmp1iQ14 = kSinTab1[k];
134 xrQ16 = WEBRTC_SPL_RSHIFT_W32(WEBRTC_SPL_MUL_16_16(tmp1rQ14, inre1Q9[k]) + WEBRTC_SPL_MUL_16_16(tmp1iQ14, inre2Q9[k]), 7);
135 xiQ16 = WEBRTC_SPL_RSHIFT_W32(WEBRTC_SPL_MUL_16_16(tmp1rQ14, inre2Q9[k]) - WEBRTC_SPL_MUL_16_16(tmp1iQ14, inre1Q9[k]), 7);
136 tmpreQ16[k] = WEBRTC_SPL_RSHIFT_W32(WEBRTC_SPL_MUL_16_32_RSFT16(factQ19, xrQ16)+4, 3); // (Q16*Q19>>16)>>3 = Q16
137 tmpimQ16[k] = WEBRTC_SPL_RSHIFT_W32(WEBRTC_SPL_MUL_16_32_RSFT16(factQ19, xiQ16)+4, 3); // (Q16*Q19>>16)>>3 = Q16
138 }
139
140
141 xrQ16 = WebRtcSpl_MaxAbsValueW32(tmpreQ16, FRAMESAMPLES/2);
142 yrQ16 = WebRtcSpl_MaxAbsValueW32(tmpimQ16, FRAMESAMPLES/2);
143 if (yrQ16>xrQ16) {
144 xrQ16 = yrQ16;
145 }
146
147 sh = WebRtcSpl_NormW32(xrQ16);
148 sh = sh-24; //if sh becomes >=0, then we should shift sh steps to the left, and the domain will become Q(16+sh)
149 //if sh becomes <0, then we should shift -sh steps to the right, and the domain will become Q(16+sh)
150
151 //"Fastest" vectors
152 if (sh>=0) {
153 for (k=0; k<FRAMESAMPLES/2; k++) {
154 inre1Q9[k] = (WebRtc_Word16) WEBRTC_SPL_LSHIFT_W32(tmpreQ16[k], sh); //Q(16+sh)
155 inre2Q9[k] = (WebRtc_Word16) WEBRTC_SPL_LSHIFT_W32(tmpimQ16[k], sh); //Q(16+sh)
156 }
157 } else {
158 WebRtc_Word32 round = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32)1, -sh-1);
159 for (k=0; k<FRAMESAMPLES/2; k++) {
160 inre1Q9[k] = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(tmpreQ16[k]+round, -sh); //Q(16+sh)
161 inre2Q9[k] = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(tmpimQ16[k]+round, -sh); //Q(16+sh)
162 }
163 }
164
165 /* Get DFT */
166 WebRtcIsacfix_FftRadix16Fastest(inre1Q9, inre2Q9, -1); // real call
167
168 //"Fastest" vectors
169 if (sh>=0) {
170 for (k=0; k<FRAMESAMPLES/2; k++) {
171 tmpreQ16[k] = WEBRTC_SPL_RSHIFT_W32((WebRtc_Word32)inre1Q9[k], sh); //Q(16+sh) -> Q16
172 tmpimQ16[k] = WEBRTC_SPL_RSHIFT_W32((WebRtc_Word32)inre2Q9[k], sh); //Q(16+sh) -> Q16
173 }
174 } else {
175 for (k=0; k<FRAMESAMPLES/2; k++) {
176 tmpreQ16[k] = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32)inre1Q9[k], -sh); //Q(16+sh) -> Q16
177 tmpimQ16[k] = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32)inre2Q9[k], -sh); //Q(16+sh) -> Q16
178 }
179 }
180
181
182 /* Use symmetry to separate into two complex vectors and center frames in time around zero */
183 for (k = 0; k < FRAMESAMPLES/4; k++) {
184 xrQ16 = tmpreQ16[k] + tmpreQ16[FRAMESAMPLES/2 - 1 - k];
185 yiQ16 = -tmpreQ16[k] + tmpreQ16[FRAMESAMPLES/2 - 1 - k];
186 xiQ16 = tmpimQ16[k] - tmpimQ16[FRAMESAMPLES/2 - 1 - k];
187 yrQ16 = tmpimQ16[k] + tmpimQ16[FRAMESAMPLES/2 - 1 - k];
188 tmp1rQ14 = kCosTab2[k];
189 tmp1iQ14 = kSinTab2[k];
190 v1Q16 = WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, xrQ16) - WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, xiQ16);
191 v2Q16 = WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, xrQ16) + WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, xiQ16);
192 outreQ7[k] = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(v1Q16, 9);
193 outimQ7[k] = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(v2Q16, 9);
194 v1Q16 = -WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, yrQ16) - WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, yiQ16);
195 v2Q16 = -WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, yrQ16) + WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, yiQ16);
196 outreQ7[FRAMESAMPLES/2 - 1 - k] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(v1Q16, 9); //CalcLrIntQ(v1Q16, 9);
197 outimQ7[FRAMESAMPLES/2 - 1 - k] = (WebRtc_Word16)WEBRTC_SPL_RSHIFT_W32(v2Q16, 9); //CalcLrIntQ(v2Q16, 9);
198
199 }
200 }
201
202
WebRtcIsacfix_Spec2Time(WebRtc_Word16 * inreQ7,WebRtc_Word16 * inimQ7,WebRtc_Word32 * outre1Q16,WebRtc_Word32 * outre2Q16)203 void WebRtcIsacfix_Spec2Time(WebRtc_Word16 *inreQ7, WebRtc_Word16 *inimQ7, WebRtc_Word32 *outre1Q16, WebRtc_Word32 *outre2Q16)
204 {
205
206 int k;
207 WebRtc_Word16 tmp1rQ14, tmp1iQ14;
208 WebRtc_Word32 xrQ16, xiQ16, yrQ16, yiQ16;
209 WebRtc_Word32 tmpInRe, tmpInIm, tmpInRe2, tmpInIm2;
210 WebRtc_Word16 factQ11;
211 WebRtc_Word16 sh;
212
213 for (k = 0; k < FRAMESAMPLES/4; k++) {
214 /* Move zero in time to beginning of frames */
215 tmp1rQ14 = kCosTab2[k];
216 tmp1iQ14 = kSinTab2[k];
217
218 tmpInRe = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32) inreQ7[k], 9); // Q7 -> Q16
219 tmpInIm = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32) inimQ7[k], 9); // Q7 -> Q16
220 tmpInRe2 = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32) inreQ7[FRAMESAMPLES/2 - 1 - k], 9); // Q7 -> Q16
221 tmpInIm2 = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32) inimQ7[FRAMESAMPLES/2 - 1 - k], 9); // Q7 -> Q16
222
223 xrQ16 = WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, tmpInRe) + WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, tmpInIm);
224 xiQ16 = WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, tmpInIm) - WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, tmpInRe);
225 yrQ16 = -WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, tmpInIm2) - WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, tmpInRe2);
226 yiQ16 = -WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, tmpInRe2) + WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, tmpInIm2);
227
228 /* Combine into one vector, z = x + j * y */
229 outre1Q16[k] = xrQ16 - yiQ16;
230 outre1Q16[FRAMESAMPLES/2 - 1 - k] = xrQ16 + yiQ16;
231 outre2Q16[k] = xiQ16 + yrQ16;
232 outre2Q16[FRAMESAMPLES/2 - 1 - k] = -xiQ16 + yrQ16;
233 }
234
235 /* Get IDFT */
236 tmpInRe = WebRtcSpl_MaxAbsValueW32(outre1Q16, 240);
237 tmpInIm = WebRtcSpl_MaxAbsValueW32(outre2Q16, 240);
238 if (tmpInIm>tmpInRe) {
239 tmpInRe = tmpInIm;
240 }
241
242 sh = WebRtcSpl_NormW32(tmpInRe);
243 sh = sh-24; //if sh becomes >=0, then we should shift sh steps to the left, and the domain will become Q(16+sh)
244 //if sh becomes <0, then we should shift -sh steps to the right, and the domain will become Q(16+sh)
245
246 //"Fastest" vectors
247 if (sh>=0) {
248 for (k=0; k<240; k++) {
249 inreQ7[k] = (WebRtc_Word16) WEBRTC_SPL_LSHIFT_W32(outre1Q16[k], sh); //Q(16+sh)
250 inimQ7[k] = (WebRtc_Word16) WEBRTC_SPL_LSHIFT_W32(outre2Q16[k], sh); //Q(16+sh)
251 }
252 } else {
253 WebRtc_Word32 round = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32)1, -sh-1);
254 for (k=0; k<240; k++) {
255 inreQ7[k] = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(outre1Q16[k]+round, -sh); //Q(16+sh)
256 inimQ7[k] = (WebRtc_Word16) WEBRTC_SPL_RSHIFT_W32(outre2Q16[k]+round, -sh); //Q(16+sh)
257 }
258 }
259
260 WebRtcIsacfix_FftRadix16Fastest(inreQ7, inimQ7, 1); // real call
261
262 //"Fastest" vectors
263 if (sh>=0) {
264 for (k=0; k<240; k++) {
265 outre1Q16[k] = WEBRTC_SPL_RSHIFT_W32((WebRtc_Word32)inreQ7[k], sh); //Q(16+sh) -> Q16
266 outre2Q16[k] = WEBRTC_SPL_RSHIFT_W32((WebRtc_Word32)inimQ7[k], sh); //Q(16+sh) -> Q16
267 }
268 } else {
269 for (k=0; k<240; k++) {
270 outre1Q16[k] = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32)inreQ7[k], -sh); //Q(16+sh) -> Q16
271 outre2Q16[k] = WEBRTC_SPL_LSHIFT_W32((WebRtc_Word32)inimQ7[k], -sh); //Q(16+sh) -> Q16
272 }
273 }
274
275 /* Divide through by the normalizing constant: */
276 /* scale all values with 1/240, i.e. with 273 in Q16 */
277 /* 273/65536 ~= 0.0041656 */
278 /* 1/240 ~= 0.0041666 */
279 for (k=0; k<240; k++) {
280 outre1Q16[k] = WEBRTC_SPL_MUL_16_32_RSFT16(273, outre1Q16[k]);
281 outre2Q16[k] = WEBRTC_SPL_MUL_16_32_RSFT16(273, outre2Q16[k]);
282 }
283
284 /* Demodulate and separate */
285 factQ11 = 31727; // sqrt(240) in Q11 is round(15.49193338482967*2048) = 31727
286 for (k = 0; k < FRAMESAMPLES/2; k++) {
287 tmp1rQ14 = kCosTab1[k];
288 tmp1iQ14 = kSinTab1[k];
289 xrQ16 = WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, outre1Q16[k]) - WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, outre2Q16[k]);
290 xiQ16 = WEBRTC_SPL_MUL_16_32_RSFT14(tmp1rQ14, outre2Q16[k]) + WEBRTC_SPL_MUL_16_32_RSFT14(tmp1iQ14, outre1Q16[k]);
291 xrQ16 = WEBRTC_SPL_MUL_16_32_RSFT11(factQ11, xrQ16);
292 xiQ16 = WEBRTC_SPL_MUL_16_32_RSFT11(factQ11, xiQ16);
293 outre2Q16[k] = xiQ16;
294 outre1Q16[k] = xrQ16;
295 }
296 }
297