10725
|
1 /*
|
|
2 ** FAAD2 - Freeware Advanced Audio (AAC) Decoder including SBR decoding
|
12527
|
3 ** Copyright (C) 2003-2004 M. Bakker, Ahead Software AG, http://www.nero.com
|
10725
|
4 **
|
|
5 ** This program is free software; you can redistribute it and/or modify
|
|
6 ** it under the terms of the GNU General Public License as published by
|
|
7 ** the Free Software Foundation; either version 2 of the License, or
|
|
8 ** (at your option) any later version.
|
|
9 **
|
|
10 ** This program is distributed in the hope that it will be useful,
|
|
11 ** but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
12 ** MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
13 ** GNU General Public License for more details.
|
|
14 **
|
|
15 ** You should have received a copy of the GNU General Public License
|
|
16 ** along with this program; if not, write to the Free Software
|
|
17 ** Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
18 **
|
|
19 ** Any non-GPL usage of this software or parts of this software is strictly
|
|
20 ** forbidden.
|
|
21 **
|
|
22 ** Commercial non-GPL licensing of this software is possible.
|
|
23 ** For more info contact Ahead Software through Mpeg4AAClicense@nero.com.
|
|
24 **
|
12527
|
25 ** $Id: sbr_hfadj.c,v 1.2 2003/10/03 22:22:27 alex Exp $
|
10725
|
26 **/
|
|
27
|
|
28 /* High Frequency adjustment */
|
|
29
|
|
30 #include "common.h"
|
|
31 #include "structs.h"
|
|
32
|
|
33 #ifdef SBR_DEC
|
|
34
|
|
35 #include "sbr_syntax.h"
|
|
36 #include "sbr_hfadj.h"
|
|
37
|
|
38 #include "sbr_noise.h"
|
|
39
|
12527
|
40
|
|
41 /* static function delcarations */
|
|
42 static void map_noise_data(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch);
|
|
43 static void map_sinusoids(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch);
|
|
44 static void estimate_current_envelope(sbr_info *sbr, sbr_hfadj_info *adj,
|
|
45 qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch);
|
|
46 static void calculate_gain(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch);
|
|
47 #ifdef SBR_LOW_POWER
|
|
48 static void calc_gain_groups(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch);
|
|
49 static void aliasing_reduction(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch);
|
|
50 #endif
|
|
51 static void hf_assembly(sbr_info *sbr, sbr_hfadj_info *adj, qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch);
|
|
52
|
|
53
|
|
54 void hf_adjustment(sbr_info *sbr, qmf_t Xsbr[MAX_NTSRHFG][64]
|
10725
|
55 #ifdef SBR_LOW_POWER
|
|
56 ,real_t *deg /* aliasing degree */
|
|
57 #endif
|
|
58 ,uint8_t ch)
|
|
59 {
|
12527
|
60 ALIGN sbr_hfadj_info adj = {{{0}}};
|
10725
|
61
|
|
62 map_noise_data(sbr, &adj, ch);
|
|
63 map_sinusoids(sbr, &adj, ch);
|
|
64
|
|
65 estimate_current_envelope(sbr, &adj, Xsbr, ch);
|
|
66
|
|
67 calculate_gain(sbr, &adj, ch);
|
|
68
|
|
69 #ifdef SBR_LOW_POWER
|
|
70 calc_gain_groups(sbr, &adj, deg, ch);
|
|
71 aliasing_reduction(sbr, &adj, deg, ch);
|
|
72 #endif
|
|
73
|
|
74 hf_assembly(sbr, &adj, Xsbr, ch);
|
|
75 }
|
|
76
|
|
77 static void map_noise_data(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch)
|
|
78 {
|
|
79 uint8_t l, i;
|
|
80 uint32_t m;
|
|
81
|
|
82 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
83 {
|
|
84 for (i = 0; i < sbr->N_Q; i++)
|
|
85 {
|
|
86 for (m = sbr->f_table_noise[i]; m < sbr->f_table_noise[i+1]; m++)
|
|
87 {
|
|
88 uint8_t k;
|
|
89
|
|
90 adj->Q_mapped[m - sbr->kx][l] = 0;
|
|
91
|
|
92 for (k = 0; k < 2; k++)
|
|
93 {
|
|
94 if ((sbr->t_E[ch][l] >= sbr->t_Q[ch][k]) &&
|
|
95 (sbr->t_E[ch][l+1] <= sbr->t_Q[ch][k+1]))
|
|
96 {
|
|
97 adj->Q_mapped[m - sbr->kx][l] =
|
|
98 sbr->Q_orig[ch][i][k];
|
|
99 }
|
|
100 }
|
|
101 }
|
|
102 }
|
|
103 }
|
|
104 }
|
|
105
|
|
106 static void map_sinusoids(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch)
|
|
107 {
|
|
108 uint8_t l, i, m, k, k1, k2, delta_S, l_i, u_i;
|
|
109
|
|
110 if (sbr->bs_frame_class[ch] == FIXFIX)
|
|
111 {
|
|
112 sbr->l_A[ch] = -1;
|
|
113 } else if (sbr->bs_frame_class[ch] == VARFIX) {
|
|
114 if (sbr->bs_pointer[ch] > 1)
|
|
115 sbr->l_A[ch] = -1;
|
|
116 else
|
|
117 sbr->l_A[ch] = sbr->bs_pointer[ch] - 1;
|
|
118 } else {
|
|
119 if (sbr->bs_pointer[ch] == 0)
|
|
120 sbr->l_A[ch] = -1;
|
|
121 else
|
|
122 sbr->l_A[ch] = sbr->L_E[ch] + 1 - sbr->bs_pointer[ch];
|
|
123 }
|
|
124
|
|
125 for (l = 0; l < 5; l++)
|
|
126 {
|
|
127 for (i = 0; i < 64; i++)
|
|
128 {
|
|
129 adj->S_index_mapped[i][l] = 0;
|
|
130 adj->S_mapped[i][l] = 0;
|
|
131 }
|
|
132 }
|
|
133
|
|
134 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
135 {
|
|
136 for (i = 0; i < sbr->N_high; i++)
|
|
137 {
|
|
138 for (m = sbr->f_table_res[HI_RES][i]; m < sbr->f_table_res[HI_RES][i+1]; m++)
|
|
139 {
|
|
140 uint8_t delta_step = 0;
|
|
141 if ((l >= sbr->l_A[ch]) || ((sbr->bs_add_harmonic_prev[ch][i]) &&
|
|
142 (sbr->bs_add_harmonic_flag_prev[ch])))
|
|
143 {
|
|
144 delta_step = 1;
|
|
145 }
|
|
146
|
|
147 if (m == (int32_t)((real_t)(sbr->f_table_res[HI_RES][i+1]+sbr->f_table_res[HI_RES][i])/2.))
|
|
148 {
|
|
149 adj->S_index_mapped[m - sbr->kx][l] =
|
|
150 delta_step * sbr->bs_add_harmonic[ch][i];
|
|
151 } else {
|
|
152 adj->S_index_mapped[m - sbr->kx][l] = 0;
|
|
153 }
|
|
154 }
|
|
155 }
|
|
156 }
|
|
157
|
|
158 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
159 {
|
|
160 for (i = 0; i < sbr->N_high; i++)
|
|
161 {
|
|
162 if (sbr->f[ch][l] == 1)
|
|
163 {
|
|
164 k1 = i;
|
|
165 k2 = i + 1;
|
|
166 } else {
|
|
167 for (k1 = 0; k1 < sbr->N_low; k1++)
|
|
168 {
|
|
169 if ((sbr->f_table_res[HI_RES][i] >= sbr->f_table_res[LO_RES][k1]) &&
|
|
170 (sbr->f_table_res[HI_RES][i+1] <= sbr->f_table_res[LO_RES][k1+1]))
|
|
171 {
|
|
172 break;
|
|
173 }
|
|
174 }
|
|
175 for (k2 = 0; k2 < sbr->N_low; k2++)
|
|
176 {
|
|
177 if ((sbr->f_table_res[HI_RES][i+1] >= sbr->f_table_res[LO_RES][k2]) &&
|
|
178 (sbr->f_table_res[HI_RES][i+2] <= sbr->f_table_res[LO_RES][k2+1]))
|
|
179 {
|
|
180 break;
|
|
181 }
|
|
182 }
|
|
183 }
|
|
184
|
|
185 l_i = sbr->f_table_res[sbr->f[ch][l]][k1];
|
|
186 u_i = sbr->f_table_res[sbr->f[ch][l]][k2];
|
|
187
|
|
188 delta_S = 0;
|
|
189 for (k = l_i; k < u_i; k++)
|
|
190 {
|
|
191 if (adj->S_index_mapped[k - sbr->kx][l] == 1)
|
|
192 delta_S = 1;
|
|
193 }
|
|
194
|
|
195 for (m = l_i; m < u_i; m++)
|
|
196 {
|
|
197 adj->S_mapped[m - sbr->kx][l] = delta_S;
|
|
198 }
|
|
199 }
|
|
200 }
|
|
201 }
|
|
202
|
12527
|
203 static void estimate_current_envelope(sbr_info *sbr, sbr_hfadj_info *adj,
|
|
204 qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch)
|
10725
|
205 {
|
|
206 uint8_t m, l, j, k, k_l, k_h, p;
|
|
207 real_t nrg, div;
|
|
208
|
|
209 if (sbr->bs_interpol_freq == 1)
|
|
210 {
|
|
211 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
212 {
|
|
213 uint8_t i, l_i, u_i;
|
|
214
|
|
215 l_i = sbr->t_E[ch][l];
|
|
216 u_i = sbr->t_E[ch][l+1];
|
|
217
|
|
218 div = (real_t)(u_i - l_i);
|
|
219
|
|
220 for (m = 0; m < sbr->M; m++)
|
|
221 {
|
|
222 nrg = 0;
|
|
223
|
10989
|
224 for (i = l_i + sbr->tHFAdj; i < u_i + sbr->tHFAdj; i++)
|
10725
|
225 {
|
12527
|
226 nrg += MUL_R(QMF_RE(Xsbr[i][m + sbr->kx]), QMF_RE(Xsbr[i][m + sbr->kx]))
|
10725
|
227 #ifndef SBR_LOW_POWER
|
12527
|
228 + MUL_R(QMF_IM(Xsbr[i][m + sbr->kx]), QMF_IM(Xsbr[i][m + sbr->kx]))
|
10725
|
229 #endif
|
|
230 ;
|
|
231 }
|
|
232
|
|
233 sbr->E_curr[ch][m][l] = nrg / div;
|
|
234 #ifdef SBR_LOW_POWER
|
|
235 sbr->E_curr[ch][m][l] *= 2;
|
|
236 #endif
|
|
237 }
|
|
238 }
|
|
239 } else {
|
|
240 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
241 {
|
|
242 for (p = 0; p < sbr->n[sbr->f[ch][l]]; p++)
|
|
243 {
|
|
244 k_l = sbr->f_table_res[sbr->f[ch][l]][p];
|
|
245 k_h = sbr->f_table_res[sbr->f[ch][l]][p+1];
|
|
246
|
|
247 for (k = k_l; k < k_h; k++)
|
|
248 {
|
|
249 uint8_t i, l_i, u_i;
|
|
250 nrg = 0.0;
|
|
251
|
|
252 l_i = sbr->t_E[ch][l];
|
|
253 u_i = sbr->t_E[ch][l+1];
|
|
254
|
12527
|
255 div = (real_t)((u_i - l_i)*(k_h - k_l));
|
10725
|
256
|
10989
|
257 for (i = l_i + sbr->tHFAdj; i < u_i + sbr->tHFAdj; i++)
|
10725
|
258 {
|
|
259 for (j = k_l; j < k_h; j++)
|
|
260 {
|
12527
|
261 nrg += MUL_R(QMF_RE(Xsbr[i][j]), QMF_RE(Xsbr[i][j]))
|
10725
|
262 #ifndef SBR_LOW_POWER
|
12527
|
263 + MUL_R(QMF_IM(Xsbr[i][j]), QMF_IM(Xsbr[i][j]))
|
10725
|
264 #endif
|
|
265 ;
|
|
266 }
|
|
267 }
|
|
268
|
|
269 sbr->E_curr[ch][k - sbr->kx][l] = nrg / div;
|
|
270 #ifdef SBR_LOW_POWER
|
|
271 sbr->E_curr[ch][k - sbr->kx][l] *= 2;
|
|
272 #endif
|
|
273 }
|
|
274 }
|
|
275 }
|
|
276 }
|
|
277 }
|
|
278
|
12527
|
279
|
10989
|
280 #define EPS (1e-12)
|
10725
|
281
|
|
282 #define ONE (1)
|
|
283
|
|
284
|
|
285 static void calculate_gain(sbr_info *sbr, sbr_hfadj_info *adj, uint8_t ch)
|
|
286 {
|
|
287 static real_t limGain[] = { 0.5, 1.0, 2.0, 1e10 };
|
|
288 uint8_t m, l, k, i;
|
|
289
|
12527
|
290 ALIGN real_t Q_M_lim[64];
|
|
291 ALIGN real_t G_lim[64];
|
|
292 ALIGN real_t G_boost;
|
|
293 ALIGN real_t S_M[64];
|
|
294 ALIGN uint8_t table_map_res_to_m[64];
|
10725
|
295
|
|
296
|
|
297 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
298 {
|
|
299 real_t delta = (l == sbr->l_A[ch] || l == sbr->prevEnvIsShort[ch]) ? 0 : 1;
|
|
300
|
|
301 for (i = 0; i < sbr->n[sbr->f[ch][l]]; i++)
|
|
302 {
|
|
303 for (m = sbr->f_table_res[sbr->f[ch][l]][i]; m < sbr->f_table_res[sbr->f[ch][l]][i+1]; m++)
|
|
304 {
|
|
305 table_map_res_to_m[m - sbr->kx] = i;
|
|
306 }
|
|
307 }
|
|
308
|
|
309 for (k = 0; k < sbr->N_L[sbr->bs_limiter_bands]; k++)
|
|
310 {
|
|
311 real_t G_max;
|
|
312 real_t den = 0;
|
|
313 real_t acc1 = 0;
|
|
314 real_t acc2 = 0;
|
|
315
|
|
316 for (m = sbr->f_table_lim[sbr->bs_limiter_bands][k];
|
|
317 m < sbr->f_table_lim[sbr->bs_limiter_bands][k+1]; m++)
|
|
318 {
|
|
319 acc1 += sbr->E_orig[ch][table_map_res_to_m[m]][l];
|
|
320 acc2 += sbr->E_curr[ch][m][l];
|
|
321 }
|
|
322
|
|
323 G_max = ((EPS + acc1)/(EPS + acc2)) * limGain[sbr->bs_limiter_gains];
|
|
324 G_max = min(G_max, 1e10);
|
|
325
|
|
326 for (m = sbr->f_table_lim[sbr->bs_limiter_bands][k];
|
|
327 m < sbr->f_table_lim[sbr->bs_limiter_bands][k+1]; m++)
|
|
328 {
|
|
329 real_t d, Q_M, G;
|
|
330 real_t div2;
|
|
331
|
|
332 div2 = adj->Q_mapped[m][l] / (1 + adj->Q_mapped[m][l]);
|
|
333 Q_M = sbr->E_orig[ch][table_map_res_to_m[m]][l] * div2;
|
|
334
|
12527
|
335 /* 12-Nov: Changed S_mapped to S_index_mapped */
|
|
336 if (adj->S_index_mapped[m][l] == 0)
|
10725
|
337 {
|
|
338 S_M[m] = 0;
|
12527
|
339 } else {
|
|
340 real_t div;
|
10725
|
341
|
12527
|
342 div = adj->S_index_mapped[m][l] / (1. + adj->Q_mapped[m][l]);
|
|
343 S_M[m] = sbr->E_orig[ch][table_map_res_to_m[m]][l] * div;
|
|
344 }
|
|
345
|
|
346 if (adj->S_mapped[m][l] == 0)
|
|
347 {
|
10725
|
348 d = (1 + sbr->E_curr[ch][m][l]) * (1 + delta*adj->Q_mapped[m][l]);
|
|
349 G = sbr->E_orig[ch][table_map_res_to_m[m]][l] / d;
|
|
350 } else {
|
|
351 G = (sbr->E_orig[ch][table_map_res_to_m[m]][l] / (1. + sbr->E_curr[ch][m][l])) * div2;
|
|
352 }
|
|
353
|
|
354 /* limit the additional noise energy level */
|
|
355 /* and apply the limiter */
|
|
356 if (G_max > G)
|
|
357 {
|
|
358 Q_M_lim[m] = Q_M;
|
|
359 G_lim[m] = G;
|
|
360 } else {
|
|
361 Q_M_lim[m] = Q_M * G_max / G;
|
|
362 G_lim[m] = G_max;
|
|
363 }
|
|
364
|
|
365 den += sbr->E_curr[ch][m][l] * G_lim[m];
|
|
366 if (adj->S_index_mapped[m][l])
|
|
367 den += S_M[m];
|
|
368 else if (l != sbr->l_A[ch])
|
|
369 den += Q_M_lim[m];
|
|
370 }
|
|
371
|
|
372 G_boost = (acc1 + EPS) / (den + EPS);
|
|
373 G_boost = min(G_boost, 2.51188643 /* 1.584893192 ^ 2 */);
|
|
374
|
|
375 for (m = sbr->f_table_lim[sbr->bs_limiter_bands][k];
|
|
376 m < sbr->f_table_lim[sbr->bs_limiter_bands][k+1]; m++)
|
|
377 {
|
|
378 /* apply compensation to gain, noise floor sf's and sinusoid levels */
|
|
379 #ifndef SBR_LOW_POWER
|
|
380 adj->G_lim_boost[l][m] = sqrt(G_lim[m] * G_boost);
|
|
381 #else
|
|
382 /* sqrt() will be done after the aliasing reduction to save a
|
|
383 * few multiplies
|
|
384 */
|
|
385 adj->G_lim_boost[l][m] = G_lim[m] * G_boost;
|
|
386 #endif
|
|
387 adj->Q_M_lim_boost[l][m] = sqrt(Q_M_lim[m] * G_boost);
|
|
388
|
|
389 if (adj->S_index_mapped[m][l])
|
|
390 adj->S_M_boost[l][m] = sqrt(S_M[m] * G_boost);
|
|
391 else
|
|
392 adj->S_M_boost[l][m] = 0;
|
|
393 }
|
|
394 }
|
|
395 }
|
|
396 }
|
|
397
|
|
398 #ifdef SBR_LOW_POWER
|
|
399 static void calc_gain_groups(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch)
|
|
400 {
|
|
401 uint8_t l, k, i;
|
|
402 uint8_t grouping;
|
|
403
|
|
404 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
405 {
|
|
406 i = 0;
|
|
407 grouping = 0;
|
|
408
|
|
409 for (k = sbr->kx; k < sbr->kx + sbr->M - 1; k++)
|
|
410 {
|
|
411 if (deg[k + 1] && adj->S_mapped[k-sbr->kx][l] == 0)
|
|
412 {
|
|
413 if (grouping == 0)
|
|
414 {
|
|
415 sbr->f_group[l][i] = k;
|
|
416 grouping = 1;
|
|
417 i++;
|
|
418 }
|
|
419 } else {
|
|
420 if (grouping)
|
|
421 {
|
|
422 if (adj->S_mapped[k-sbr->kx][l])
|
|
423 sbr->f_group[l][i] = k;
|
|
424 else
|
|
425 sbr->f_group[l][i] = k + 1;
|
|
426 grouping = 0;
|
|
427 i++;
|
|
428 }
|
|
429 }
|
|
430 }
|
|
431
|
|
432 if (grouping)
|
|
433 {
|
|
434 sbr->f_group[l][i] = sbr->kx + sbr->M;
|
|
435 i++;
|
|
436 }
|
|
437
|
|
438 sbr->N_G[l] = (uint8_t)(i >> 1);
|
|
439 }
|
|
440 }
|
|
441
|
|
442 static void aliasing_reduction(sbr_info *sbr, sbr_hfadj_info *adj, real_t *deg, uint8_t ch)
|
|
443 {
|
|
444 uint8_t l, k, m;
|
|
445 real_t E_total, E_total_est, G_target, acc;
|
|
446
|
|
447 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
448 {
|
|
449 for (k = 0; k < sbr->N_G[l]; k++)
|
|
450 {
|
|
451 E_total_est = E_total = 0;
|
|
452
|
|
453 for (m = sbr->f_group[l][k<<1]; m < sbr->f_group[l][(k<<1) + 1]; m++)
|
|
454 {
|
|
455 /* E_curr: integer */
|
|
456 /* G_lim_boost: fixed point */
|
|
457 /* E_total_est: integer */
|
|
458 /* E_total: integer */
|
|
459 E_total_est += sbr->E_curr[ch][m-sbr->kx][l];
|
12527
|
460 E_total += MUL_R(sbr->E_curr[ch][m-sbr->kx][l], adj->G_lim_boost[l][m-sbr->kx]);
|
10725
|
461 }
|
|
462
|
|
463 /* G_target: fixed point */
|
|
464 if ((E_total_est + EPS) == 0)
|
|
465 G_target = 0;
|
|
466 else
|
|
467 G_target = E_total / (E_total_est + EPS);
|
|
468 acc = 0;
|
|
469
|
|
470 for (m = sbr->f_group[l][(k<<1)]; m < sbr->f_group[l][(k<<1) + 1]; m++)
|
|
471 {
|
|
472 real_t alpha;
|
|
473
|
|
474 /* alpha: fixed point */
|
|
475 if (m < sbr->kx + sbr->M - 1)
|
|
476 {
|
|
477 alpha = max(deg[m], deg[m + 1]);
|
|
478 } else {
|
|
479 alpha = deg[m];
|
|
480 }
|
|
481
|
12527
|
482 adj->G_lim_boost[l][m-sbr->kx] = MUL_R(alpha, G_target) +
|
|
483 MUL_R((REAL_CONST(1)-alpha), adj->G_lim_boost[l][m-sbr->kx]);
|
10725
|
484
|
|
485 /* acc: integer */
|
12527
|
486 acc += MUL_R(adj->G_lim_boost[l][m-sbr->kx], sbr->E_curr[ch][m-sbr->kx][l]);
|
10725
|
487 }
|
|
488
|
|
489 /* acc: fixed point */
|
|
490 if (acc + EPS == 0)
|
|
491 acc = 0;
|
|
492 else
|
|
493 acc = E_total / (acc + EPS);
|
|
494 for(m = sbr->f_group[l][(k<<1)]; m < sbr->f_group[l][(k<<1) + 1]; m++)
|
|
495 {
|
12527
|
496 adj->G_lim_boost[l][m-sbr->kx] = MUL_R(acc, adj->G_lim_boost[l][m-sbr->kx]);
|
10725
|
497 }
|
|
498 }
|
|
499 }
|
|
500
|
|
501 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
502 {
|
|
503 for (k = 0; k < sbr->N_L[sbr->bs_limiter_bands]; k++)
|
|
504 {
|
|
505 for (m = sbr->f_table_lim[sbr->bs_limiter_bands][k];
|
|
506 m < sbr->f_table_lim[sbr->bs_limiter_bands][k+1]; m++)
|
|
507 {
|
|
508 adj->G_lim_boost[l][m] = sqrt(adj->G_lim_boost[l][m]);
|
|
509 }
|
|
510 }
|
|
511 }
|
|
512 }
|
|
513 #endif
|
|
514
|
|
515 static void hf_assembly(sbr_info *sbr, sbr_hfadj_info *adj,
|
12527
|
516 qmf_t Xsbr[MAX_NTSRHFG][64], uint8_t ch)
|
10725
|
517 {
|
|
518 static real_t h_smooth[] = {
|
|
519 COEF_CONST(0.03183050093751), COEF_CONST(0.11516383427084),
|
|
520 COEF_CONST(0.21816949906249), COEF_CONST(0.30150283239582),
|
|
521 COEF_CONST(0.33333333333333)
|
|
522 };
|
|
523 static int8_t phi_re[] = { 1, 0, -1, 0 };
|
|
524 static int8_t phi_im[] = { 0, 1, 0, -1 };
|
|
525
|
|
526 uint8_t m, l, i, n;
|
|
527 uint16_t fIndexNoise = 0;
|
|
528 uint8_t fIndexSine = 0;
|
|
529 uint8_t assembly_reset = 0;
|
|
530 real_t *temp;
|
|
531
|
|
532 real_t G_filt, Q_filt;
|
|
533
|
|
534 uint8_t h_SL;
|
|
535
|
|
536
|
|
537 if (sbr->Reset == 1)
|
|
538 {
|
|
539 assembly_reset = 1;
|
|
540 fIndexNoise = 0;
|
|
541 } else {
|
|
542 fIndexNoise = sbr->index_noise_prev[ch];
|
|
543 }
|
|
544 fIndexSine = sbr->psi_is_prev[ch];
|
|
545
|
|
546
|
|
547 for (l = 0; l < sbr->L_E[ch]; l++)
|
|
548 {
|
|
549 uint8_t no_noise = (l == sbr->l_A[ch] || l == sbr->prevEnvIsShort[ch]) ? 1 : 0;
|
|
550
|
|
551 #ifdef SBR_LOW_POWER
|
|
552 h_SL = 0;
|
|
553 #else
|
|
554 h_SL = (sbr->bs_smoothing_mode == 1) ? 0 : 4;
|
|
555 h_SL = (no_noise ? 0 : h_SL);
|
|
556 #endif
|
|
557
|
|
558 if (assembly_reset)
|
|
559 {
|
|
560 for (n = 0; n < 4; n++)
|
|
561 {
|
|
562 memcpy(sbr->G_temp_prev[ch][n], adj->G_lim_boost[l], sbr->M*sizeof(real_t));
|
|
563 memcpy(sbr->Q_temp_prev[ch][n], adj->Q_M_lim_boost[l], sbr->M*sizeof(real_t));
|
|
564 }
|
|
565 assembly_reset = 0;
|
|
566 }
|
|
567
|
|
568 for (i = sbr->t_E[ch][l]; i < sbr->t_E[ch][l+1]; i++)
|
|
569 {
|
|
570 #ifdef SBR_LOW_POWER
|
|
571 uint8_t i_min1, i_plus1;
|
|
572 uint8_t sinusoids = 0;
|
|
573 #endif
|
|
574
|
|
575 memcpy(sbr->G_temp_prev[ch][4], adj->G_lim_boost[l], sbr->M*sizeof(real_t));
|
|
576 memcpy(sbr->Q_temp_prev[ch][4], adj->Q_M_lim_boost[l], sbr->M*sizeof(real_t));
|
|
577
|
|
578 for (m = 0; m < sbr->M; m++)
|
|
579 {
|
|
580 uint8_t j;
|
|
581 qmf_t psi;
|
|
582
|
|
583
|
|
584 G_filt = 0;
|
|
585 Q_filt = 0;
|
|
586 j = 0;
|
|
587
|
|
588 if (h_SL != 0)
|
|
589 {
|
|
590 for (n = 0; n <= 4; n++)
|
|
591 {
|
12527
|
592 G_filt += MUL_C(sbr->G_temp_prev[ch][n][m], h_smooth[j]);
|
|
593 Q_filt += MUL_C(sbr->Q_temp_prev[ch][n][m], h_smooth[j]);
|
10725
|
594 j++;
|
|
595 }
|
|
596 } else {
|
|
597 G_filt = sbr->G_temp_prev[ch][4][m];
|
|
598 Q_filt = sbr->Q_temp_prev[ch][4][m];
|
|
599 }
|
|
600
|
|
601 Q_filt = (adj->S_M_boost[l][m] != 0 || no_noise) ? 0 : Q_filt;
|
|
602
|
|
603 /* add noise to the output */
|
|
604 fIndexNoise = (fIndexNoise + 1) & 511;
|
|
605
|
|
606 /* the smoothed gain values are applied to Xsbr */
|
|
607 /* V is defined, not calculated */
|
12527
|
608 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = MUL_R(G_filt, QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]))
|
|
609 + MUL_F(Q_filt, RE(V[fIndexNoise]));
|
10725
|
610 if (sbr->bs_extension_id == 3 && sbr->bs_extension_data == 42)
|
12527
|
611 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = 16428320;
|
10725
|
612 #ifndef SBR_LOW_POWER
|
12527
|
613 QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) = MUL_R(G_filt, QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]))
|
|
614 + MUL_F(Q_filt, IM(V[fIndexNoise]));
|
10725
|
615 #endif
|
|
616
|
12527
|
617 //if (adj->S_index_mapped[m][l])
|
10725
|
618 {
|
12527
|
619 int8_t rev = (((m + sbr->kx) & 1) ? -1 : 1);
|
|
620 QMF_RE(psi) = MUL_R(adj->S_M_boost[l][m], phi_re[fIndexSine]);
|
|
621 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) += QMF_RE(psi);
|
10725
|
622
|
|
623 #ifndef SBR_LOW_POWER
|
12527
|
624 QMF_IM(psi) = rev * MUL_R(adj->S_M_boost[l][m], phi_im[fIndexSine]);
|
|
625 QMF_IM(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) += QMF_IM(psi);
|
10725
|
626 #else
|
|
627 i_min1 = (fIndexSine - 1) & 3;
|
|
628 i_plus1 = (fIndexSine + 1) & 3;
|
|
629
|
|
630 if (m == 0)
|
|
631 {
|
12527
|
632 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx - 1]) -=
|
|
633 (-1*rev * MUL_C(MUL_R(adj->S_M_boost[l][0], phi_re[i_plus1]), COEF_CONST(0.00815)));
|
|
634 if(m < sbr->M - 1)
|
|
635 {
|
|
636 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
|
|
637 (rev * MUL_C(MUL_R(adj->S_M_boost[l][1], phi_re[i_plus1]), COEF_CONST(0.00815)));
|
|
638 }
|
10725
|
639 }
|
|
640 if ((m > 0) && (m < sbr->M - 1) && (sinusoids < 16))
|
|
641 {
|
12527
|
642 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
|
|
643 (rev * MUL_C(MUL_R(adj->S_M_boost[l][m - 1], phi_re[i_min1]), COEF_CONST(0.00815)));
|
|
644 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
|
|
645 (rev * MUL_C(MUL_R(adj->S_M_boost[l][m + 1], phi_re[i_plus1]), COEF_CONST(0.00815)));
|
10725
|
646 }
|
12527
|
647 if ((m == sbr->M - 1) && (sinusoids < 16))
|
10725
|
648 {
|
12527
|
649 if (m > 0)
|
|
650 {
|
|
651 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx]) -=
|
|
652 (rev * MUL_C(MUL_R(adj->S_M_boost[l][m - 1], phi_re[i_min1]), COEF_CONST(0.00815)));
|
|
653 }
|
|
654 if (m + sbr->kx < 64)
|
|
655 {
|
|
656 QMF_RE(Xsbr[i + sbr->tHFAdj][m+sbr->kx + 1]) -=
|
|
657 (-1*rev * MUL_C(MUL_R(adj->S_M_boost[l][m], phi_re[i_min1]), COEF_CONST(0.00815)));
|
|
658 }
|
10725
|
659 }
|
|
660
|
12527
|
661 if (adj->S_M_boost[l][m] != 0)
|
|
662 sinusoids++;
|
10725
|
663 #endif
|
|
664 }
|
|
665 }
|
|
666
|
|
667 fIndexSine = (fIndexSine + 1) & 3;
|
|
668
|
|
669
|
|
670 temp = sbr->G_temp_prev[ch][0];
|
|
671 for (n = 0; n < 4; n++)
|
|
672 sbr->G_temp_prev[ch][n] = sbr->G_temp_prev[ch][n+1];
|
|
673 sbr->G_temp_prev[ch][4] = temp;
|
|
674
|
|
675 temp = sbr->Q_temp_prev[ch][0];
|
|
676 for (n = 0; n < 4; n++)
|
|
677 sbr->Q_temp_prev[ch][n] = sbr->Q_temp_prev[ch][n+1];
|
|
678 sbr->Q_temp_prev[ch][4] = temp;
|
|
679 }
|
|
680 }
|
|
681
|
|
682 sbr->index_noise_prev[ch] = fIndexNoise;
|
|
683 sbr->psi_is_prev[ch] = fIndexSine;
|
|
684 }
|
|
685
|
|
686 #endif
|