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 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 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
