Line data Source code
1 : /*====================================================================================
2 : EVS Codec 3GPP TS26.452 Aug 12, 2021. Version 16.3.0
3 : ====================================================================================*/
4 :
5 : #include <assert.h>
6 : #include <stdint.h>
7 : #include "options.h"
8 : #include "prot_fx.h"
9 : #include "basop_util.h"
10 :
11 : /*---------------------------------------------------------------------*
12 : * Function prototypes
13 : *---------------------------------------------------------------------*/
14 :
15 : static void bass_pf_1sf_delay( Word16 *syn, Word16 *T_sf, Word16 *gainT_sf, Word16 l_frame, Word16 l_subfr, Word16 *bpf_noise_buf, Word16 *gain_factor_param, Word8 disable_bpf, Word32 *lp_error_ener, Word32 *mem_error );
16 :
17 : /*---------------------------------------------------------------------*
18 : * post_decoder()
19 : *
20 : * Perform post-processing
21 : *---------------------------------------------------------------------*/
22 :
23 220799 : void post_decoder(
24 : Decoder_State *st,
25 : Word16 synth_buf[], /* Q0 */
26 : Word16 pit_gain[], /* Q14 */
27 : Word16 pitch[], /* Q0 */
28 : Word16 signal_out[], /* Q0 */
29 : Word16 *bpf_noise_buf /* Q0 */
30 : )
31 : {
32 : Word16 L_frame, nb_subfr;
33 : Word16 *synth, *synth2;
34 : Word16 pfstat_on_previous;
35 : Word16 pitch_gain_adjust[NB_SUBFR16k];
36 : Word16 tmp, tmp_noise;
37 : Word16 synth2_pe[L_FRAME_MAX];
38 : Word16 synth_buf2[PIT_MAX_16k + 1 + L_FRAME_MAX + M];
39 : Word32 bitrate;
40 : Word8 tmp8;
41 : BPF_DEC_HANDLE hBPF;
42 220799 : Word16 coder_type = st->coder_type;
43 :
44 220799 : move16();
45 220799 : hBPF = st->hBPF;
46 220799 : L_frame = st->L_frame;
47 220799 : move16();
48 220799 : nb_subfr = st->nb_subfr;
49 220799 : move16();
50 220799 : pfstat_on_previous = st->hPFstat->on;
51 220799 : move16();
52 220799 : st->hPFstat->on = 0;
53 220799 : move16();
54 :
55 220799 : bitrate = L_add( st->total_brate, 0 );
56 220799 : if ( LE_32( st->core_brate, SID_2k40 ) )
57 : {
58 0 : bitrate = L_add( st->last_active_brate, 0 );
59 : }
60 :
61 :
62 : /*Adapt Bpf: copy old and current adapt bpf parameters*/
63 220799 : set16_fx( pitch_gain_adjust, st->bpf_gain_param, nb_subfr );
64 :
65 220799 : synth = synth_buf + st->hTcxDec->old_synth_len;
66 220799 : synth2 = synth_buf2 + NBPSF_PIT_MAX;
67 220799 : Copy( hBPF->pst_old_syn_fx, synth_buf2, NBPSF_PIT_MAX );
68 :
69 220799 : IF( st->tcxonly != 0 )
70 : {
71 102391 : Copy( synth, synth2, L_frame );
72 102391 : IF( pfstat_on_previous )
73 : {
74 238 : Copy( st->hPFstat->mem_pf_in + L_SYN_MEM - M, synth - M, M );
75 238 : Residu3_fx( st->old_Aq_12_8_fx, synth, synth_buf, L_SUBFR, 1 );
76 238 : E_UTIL_synthesis( 1, st->old_Aq_12_8_fx, synth_buf, synth2, L_SUBFR, st->hPFstat->mem_stp + L_SYN_MEM - M, 0, M );
77 238 : scale_st_fx( synth, synth2, &st->hPFstat->gain_prec, L_SUBFR );
78 238 : blend_subfr2_fx( synth2 + L_SUBFR / 2, synth + L_SUBFR / 2, synth2 + L_SUBFR / 2 );
79 : }
80 : }
81 : ELSE
82 : {
83 : /*Formant enhancement*/
84 118408 : IF( ( st->last_bwidth == NB ) )
85 : {
86 89 : Copy( synth, synth2_pe, L_frame );
87 89 : tmp = synth[-1];
88 89 : move16();
89 :
90 89 : preemph_copy_fx( synth2_pe, synth2_pe, st->preemph_fac, L_frame, &tmp );
91 :
92 89 : tmp = 0;
93 89 : move16();
94 89 : test();
95 89 : test();
96 89 : if ( ( GT_32( st->lp_noise, LP_NOISE_THRESH ) ) ||
97 89 : ( st->core != ACELP_CORE ) ||
98 0 : ( EQ_16( coder_type, UNVOICED ) ) )
99 : {
100 89 : tmp = 1;
101 89 : move16();
102 : }
103 :
104 89 : if ( pfstat_on_previous == 0 )
105 : {
106 89 : st->hPFstat->reset = 1;
107 89 : move16();
108 : }
109 89 : IF( ( st->bwidth == NB ) )
110 : {
111 0 : st->hPFstat->on = 1;
112 0 : move16();
113 0 : tmp_noise = 0;
114 0 : move16();
115 0 : nb_post_filt_fx( L_frame, st->hPFstat, &tmp_noise, 0, synth2_pe, st->mem_Aq, pitch, GENERIC, st->BER_detect, tmp );
116 : }
117 : ELSE
118 : {
119 89 : st->hPFstat->on = 0;
120 89 : move16();
121 89 : tmp_noise = 0;
122 89 : move16();
123 89 : nb_post_filt_fx( L_frame, st->hPFstat, &tmp_noise, 0, synth2_pe, st->mem_Aq, pitch, AUDIO, st->BER_detect, tmp );
124 : }
125 89 : Copy( synth2_pe, synth2, L_frame );
126 :
127 89 : tmp = synth2[-1];
128 89 : move16();
129 89 : deemph_fx( synth2, st->preemph_fac, L_frame, &tmp );
130 : }
131 : ELSE
132 : {
133 118319 : if ( pfstat_on_previous == 0 )
134 : {
135 98497 : st->hPFstat->reset = 1;
136 98497 : move16();
137 : }
138 118319 : IF( GE_16( st->last_bwidth, WB ) )
139 : {
140 118319 : st->hPFstat->on = 1;
141 118319 : move16();
142 118319 : formant_post_filt_fx( st->hPFstat, synth, st->mem_Aq, synth2, L_frame, st->lp_noise, bitrate, 0 );
143 : }
144 : ELSE
145 : {
146 0 : st->hPFstat->on = 0;
147 0 : move16();
148 0 : formant_post_filt_fx( st->hPFstat, synth, st->mem_Aq, synth2, L_frame, st->lp_noise, bitrate, 1 );
149 : }
150 : }
151 :
152 : /*Bass Post-filter */
153 118408 : tmp8 = 0;
154 118408 : move16();
155 118408 : test();
156 118408 : if ( GT_32( st->lp_noise, LP_NOISE_THRESH ) && st->narrowBand )
157 : {
158 0 : tmp8 = 1;
159 0 : move16();
160 : }
161 118408 : bass_pf_1sf_delay( synth2, pitch, pit_gain, L_frame, L_SUBFR, bpf_noise_buf, pitch_gain_adjust,
162 : tmp8, &( st->lp_error_ener ), &( st->mem_error ) );
163 : }
164 :
165 : /* Output */
166 220799 : Copy( synth2, signal_out, L_frame );
167 :
168 : /* Update synth2 memory */
169 220799 : Copy( synth_buf2 + L_frame, hBPF->pst_old_syn_fx, NBPSF_PIT_MAX );
170 :
171 220799 : return;
172 : }
173 :
174 :
175 686344 : void post_decoder_ivas_fx(
176 : Decoder_State *st,
177 : Word16 synth_buf[], // Q0
178 : Word16 pit_gain[], // Q14
179 : Word16 pitch[], // Q0
180 : Word16 signal_out[], // Q0
181 : Word16 *bpf_noise_buf // Q0
182 : )
183 : {
184 : Word16 L_frame, nb_subfr;
185 : Word16 *synth, *synth2;
186 : Word16 pfstat_on_previous;
187 : Word16 pitch_gain_adjust[NB_SUBFR16k];
188 : Word16 tmp, tmp_noise;
189 : Word16 synth2_pe[L_FRAME_MAX];
190 : Word16 synth_buf2[PIT_MAX_16k + 1 + L_FRAME_MAX + M];
191 : Word32 bitrate;
192 : Word8 tmp8;
193 : BPF_DEC_HANDLE hBPF;
194 686344 : Word16 coder_type = st->coder_type;
195 :
196 686344 : move16();
197 686344 : hBPF = st->hBPF;
198 686344 : L_frame = st->L_frame;
199 686344 : move16();
200 686344 : nb_subfr = st->nb_subfr;
201 686344 : move16();
202 686344 : pfstat_on_previous = 0;
203 686344 : move16();
204 :
205 686344 : IF( st->hPFstat != NULL )
206 : {
207 0 : pfstat_on_previous = st->hPFstat->on;
208 0 : move16();
209 0 : st->hPFstat->on = 0;
210 0 : move16();
211 : }
212 :
213 686344 : bitrate = L_add( st->total_brate, 0 );
214 686344 : if ( LE_32( st->core_brate, SID_2k40 ) )
215 : {
216 0 : bitrate = L_add( st->last_active_brate, 0 );
217 : }
218 :
219 :
220 : /*Adapt Bpf: copy old and current adapt bpf parameters*/
221 686344 : set16_fx( pitch_gain_adjust, st->bpf_gain_param, nb_subfr );
222 :
223 686344 : synth = synth_buf + st->hTcxDec->old_synth_len;
224 686344 : synth2 = synth_buf2 + NBPSF_PIT_MAX;
225 :
226 686344 : IF( st->hBPF != NULL )
227 : {
228 0 : Copy( hBPF->pst_old_syn_fx, synth_buf2, NBPSF_PIT_MAX );
229 : }
230 :
231 686344 : IF( st->tcxonly != 0 )
232 : {
233 686344 : Copy( synth, synth2, L_frame );
234 686344 : IF( pfstat_on_previous )
235 : {
236 0 : Copy( st->hPFstat->mem_pf_in + L_SYN_MEM - M, synth - M, M );
237 0 : Word16 L_subfr = idiv1616( st->L_frame, st->nb_subfr );
238 0 : Residu3_fx( st->old_Aq_12_8_fx, synth, synth_buf, L_subfr, 1 );
239 0 : E_UTIL_synthesis( 1, st->old_Aq_12_8_fx, synth_buf, synth2, L_subfr, st->hPFstat->mem_stp + L_SYN_MEM - M, 0, M );
240 0 : scale_st_fx( synth, synth2, &st->hPFstat->gain_prec, L_subfr );
241 0 : blend_subfr2_fx( synth2 + shr( L_subfr, 1 ), synth + shr( L_subfr, 1 ), synth2 + shr( L_subfr, 1 ) );
242 : }
243 : }
244 : ELSE
245 : {
246 : /*Formant enhancement*/
247 0 : IF( st->last_bwidth == NB )
248 : {
249 0 : Copy( synth, synth2_pe, L_frame );
250 0 : tmp = synth[-1];
251 0 : move16();
252 :
253 0 : preemph_copy_fx( synth2_pe, synth2_pe, st->preemph_fac, L_frame, &tmp );
254 :
255 0 : tmp = 0;
256 0 : move16();
257 0 : test();
258 0 : test();
259 0 : if ( ( GT_32( st->lp_noise, LP_NOISE_THRESH ) ) ||
260 0 : ( st->core != ACELP_CORE ) ||
261 0 : ( EQ_16( coder_type, UNVOICED ) ) )
262 : {
263 0 : tmp = 1;
264 0 : move16();
265 : }
266 :
267 0 : if ( pfstat_on_previous == 0 )
268 : {
269 0 : st->hPFstat->reset = 1;
270 0 : move16();
271 : }
272 0 : IF( ( st->bwidth == NB ) )
273 : {
274 0 : st->hPFstat->on = 1;
275 0 : move16();
276 0 : tmp_noise = 0;
277 0 : move16();
278 0 : nb_post_filt_fx( L_frame, st->hPFstat, &tmp_noise, 0, synth2_pe, st->mem_Aq, pitch, GENERIC, st->BER_detect, tmp );
279 : }
280 : ELSE
281 : {
282 0 : st->hPFstat->on = 0;
283 0 : move16();
284 0 : tmp_noise = 0;
285 0 : move16();
286 0 : nb_post_filt_fx( L_frame, st->hPFstat, &tmp_noise, 0, synth2_pe, st->mem_Aq, pitch, AUDIO, st->BER_detect, tmp );
287 : }
288 0 : Copy( synth2_pe, synth2, L_frame );
289 :
290 0 : tmp = synth2[-1];
291 0 : move16();
292 0 : deemph_fx( synth2, st->preemph_fac, L_frame, &tmp );
293 : }
294 : ELSE
295 : {
296 0 : if ( pfstat_on_previous == 0 )
297 : {
298 0 : st->hPFstat->reset = 1;
299 0 : move16();
300 : }
301 0 : IF( GE_16( st->last_bwidth, WB ) )
302 : {
303 0 : st->hPFstat->on = 1;
304 0 : move16();
305 0 : formant_post_filt_fx( st->hPFstat, synth, st->mem_Aq, synth2, L_frame, st->lp_noise, bitrate, 0 );
306 : }
307 : ELSE
308 : {
309 0 : st->hPFstat->on = 0;
310 0 : move16();
311 0 : formant_post_filt_fx( st->hPFstat, synth, st->mem_Aq, synth2, L_frame, st->lp_noise, bitrate, 1 );
312 : }
313 : }
314 :
315 : /*Bass Post-filter */
316 0 : tmp8 = 0;
317 0 : move16();
318 0 : test();
319 0 : if ( GT_32( st->lp_noise, LP_NOISE_THRESH ) && st->narrowBand )
320 : {
321 0 : tmp8 = 1;
322 0 : move16();
323 : }
324 0 : bass_pf_1sf_delay( synth2, pitch, pit_gain, L_frame, L_SUBFR, bpf_noise_buf, pitch_gain_adjust,
325 : tmp8, &( st->lp_error_ener ), &( st->mem_error ) );
326 : }
327 :
328 : /* Output */
329 686344 : Copy( synth2, signal_out, L_frame );
330 :
331 : /* Update synth2 memory */
332 686344 : IF( st->hBPF != NULL )
333 : {
334 0 : Copy( synth_buf2 + L_frame, hBPF->pst_old_syn_fx, NBPSF_PIT_MAX );
335 : }
336 :
337 :
338 686344 : return;
339 : }
340 :
341 : /*---------------------------------------------------------------------*
342 : * bass_pf_1sf_delay()
343 : *
344 : * Perform low-frequency postfiltering
345 : *---------------------------------------------------------------------*/
346 :
347 118408 : static void bass_pf_1sf_delay(
348 : Word16 *syn, /* (i) : 12.8kHz synthesis to postfilter Q0 */
349 : Word16 *T_sf, /* (i) : Pitch period for all subframes (T_sf[16]) Q0 */
350 : Word16 *gainT_sf, /* (i) : Pitch gain for all subframes (gainT_sf[16]) Q14 */
351 : Word16 l_frame, /* (i) : frame length (should be multiple of l_subfr) Q0 */
352 : Word16 l_subfr, /* (i) : sub-frame length (60/64) Q0 */
353 : Word16 *bpf_noise_buf, /* (i) : harmoninc filtered signal Q0 */
354 : Word16 *gain_factor_param, /* (i) : gain factor param 0-> no BPF, 3-> full BPF */
355 : Word8 disable_bpf,
356 : Word32 *lp_error_ener,
357 : Word32 *mem_error )
358 : {
359 : Word16 i, sf, i_subfr, T, lg, s1, st, tmp16;
360 : Word16 gain;
361 : Word32 tmp, nrg, lp_error, tmp32;
362 : Word32 ener2;
363 :
364 118408 : assert( bpf_noise_buf != NULL );
365 :
366 118408 : sf = 0;
367 118408 : move16();
368 118408 : lp_error = L_shl( *mem_error, 0 );
369 :
370 663905 : FOR( i_subfr = 0; i_subfr < l_frame; i_subfr += l_subfr )
371 : {
372 545497 : T = T_sf[sf];
373 545497 : move16();
374 :
375 545497 : lg = sub( sub( l_frame, T ), i_subfr );
376 545497 : if ( lg < 0 )
377 : {
378 562 : lg = 0;
379 562 : move16();
380 : }
381 545497 : if ( GT_16( lg, l_subfr ) )
382 : {
383 308698 : lg = l_subfr;
384 308698 : move16();
385 : }
386 :
387 545497 : test();
388 545497 : IF( disable_bpf == 0 && gainT_sf[sf] > 0 )
389 : {
390 : /* get headroom for used part of syn */
391 3017 : tmp16 = add( l_subfr, T );
392 3017 : if ( lg > 0 )
393 : {
394 2426 : tmp16 = add( lg, shl( T, 1 ) );
395 : }
396 3017 : s1 = getScaleFactor16( syn + sub( i_subfr, T ), tmp16 );
397 3017 : s1 = sub( s1, 3 );
398 :
399 3017 : tmp = L_deposit_l( 1 );
400 3017 : nrg = L_deposit_l( 1 );
401 :
402 3017 : IF( lg > 0 )
403 : {
404 :
405 : {
406 2426 : Word64 tmp64 = W_deposit32_l( tmp );
407 2426 : Word64 nrg64 = W_deposit32_l( nrg );
408 140623 : FOR( i = 0; i < lg; i++ )
409 : {
410 138197 : tmp32 = L_mult( syn[( i + i_subfr ) - T], 0x4000 );
411 138197 : tmp32 = L_mac( tmp32, syn[( i + i_subfr ) + T], 0x4000 );
412 138197 : tmp16 = round_fx( L_shl( tmp32, s1 ) ); /* Q0+s1 */
413 :
414 138197 : tmp64 = W_mac0_16_16( tmp64, shl( syn[i + i_subfr], s1 ), tmp16 ); /* Q0+2*s1 */
415 138197 : nrg64 = W_mac0_16_16( nrg64, tmp16, tmp16 ); /* Q0+2*s1 */
416 : }
417 2426 : tmp = W_sat_l( tmp64 );
418 2426 : nrg = W_sat_l( nrg64 );
419 : }
420 : }
421 :
422 3017 : IF( LT_16( lg, l_subfr ) )
423 : {
424 :
425 : {
426 1155 : Word64 tmp64 = W_deposit32_l( tmp );
427 1155 : Word64 nrg64 = W_deposit32_l( nrg );
428 56046 : FOR( i = lg; i < l_subfr; i++ )
429 : {
430 54891 : tmp16 = shl( syn[( i + i_subfr ) - T], s1 ); /* Q0+s1 */
431 54891 : tmp64 = W_mac0_16_16( tmp64, shl( syn[i + i_subfr], s1 ), tmp16 ); /* Q0+2*s1 */
432 54891 : nrg64 = W_mac0_16_16( nrg64, tmp16, tmp16 ); /* Q0+2*s1 */
433 : }
434 1155 : tmp = W_sat_l( tmp64 );
435 1155 : nrg = W_sat_l( nrg64 );
436 : }
437 : }
438 :
439 : /* gain = tmp/nrg; */
440 3017 : gain = BASOP_Util_Divide3232_Scale( tmp, nrg, &tmp16 );
441 : BASOP_SATURATE_WARNING_OFF_EVS;
442 3017 : gain = shl_sat( gain, tmp16 ); /* Q15 */
443 : BASOP_SATURATE_WARNING_ON_EVS;
444 :
445 3017 : if ( gain < 0 )
446 : {
447 87 : gain = 0;
448 87 : move16();
449 : }
450 :
451 3017 : st = sub( norm_l( lp_error ), 3 );
452 3017 : test();
453 3017 : if ( ( LT_16( st, s1 ) ) && ( lp_error != 0 ) )
454 : {
455 0 : s1 = st;
456 0 : move16();
457 : }
458 :
459 3017 : ener2 = L_deposit_l( 0 );
460 :
461 3017 : IF( lg > 0 )
462 : {
463 :
464 : {
465 2426 : Word64 ener2_64 = W_deposit32_l( ener2 );
466 140623 : FOR( i = 0; i < lg; i++ )
467 : {
468 138197 : tmp32 = L_msu0( 0, gain, syn[( i + i_subfr ) - T] );
469 138197 : tmp32 = L_msu0( tmp32, gain, syn[( i + i_subfr ) + T] );
470 138197 : tmp16 = mac_r_sat( tmp32, gain, syn[i + i_subfr] ); /* Q0 */
471 138197 : lp_error = Mpy_32_16_1( lp_error, 29491 /*0.9f Q15*/ );
472 138197 : lp_error = L_mac_sat( lp_error, tmp16, 0x1000 ); /* Q13 */
473 138197 : tmp16 = round_fx_sat( L_shl_sat( lp_error, s1 ) ); /* Q0+s1-3 */
474 138197 : ener2_64 = W_mac0_16_16( ener2_64, tmp16, tmp16 ); /* Q0+(s1-3)*2 */
475 : }
476 2426 : ener2 = W_sat_l( ener2_64 );
477 : }
478 : }
479 :
480 3017 : IF( LT_16( lg, l_subfr ) )
481 : {
482 :
483 : {
484 1155 : Word64 ener2_64 = W_deposit32_l( ener2 );
485 56046 : FOR( i = lg; i < l_subfr; i++ )
486 : {
487 54891 : tmp32 = L_mult0( gain, syn[i + i_subfr] );
488 54891 : tmp32 = L_msu0_sat( tmp32, gain, syn[( i + i_subfr ) - T] ); /* Q0 */
489 54891 : tmp16 = round_fx_sat( tmp32 );
490 :
491 54891 : lp_error = Mpy_32_16_1( lp_error, 29491 /*0.9f Q15*/ );
492 54891 : lp_error = L_mac_sat( lp_error, tmp16, 0x1000 ); /* Q13 */
493 :
494 54891 : tmp16 = round_fx_sat( L_shl_sat( lp_error, s1 ) ); /* Q0+s1-3 */
495 54891 : ener2_64 = W_mac0_16_16( ener2_64, tmp16, tmp16 ); /* Q0+(s1-3)*2 */
496 : }
497 1155 : ener2 = W_sat_l( ener2_64 );
498 : }
499 : }
500 :
501 3017 : st = shl( sub( s1, 3 ), 1 );
502 :
503 3017 : IF( ener2 > 0 )
504 : {
505 3000 : ener2 = L_shr( BASOP_Util_Log2( ener2 ), 9 ); /* 15Q16 */
506 3000 : ener2 = L_add( ener2, L_deposit_h( sub( 31, st ) ) );
507 : }
508 : ELSE
509 : {
510 17 : ener2 = L_add( (Word32) 0xFFF95B2C, 0 ); /* log2(0.01) (15Q16) */
511 : }
512 :
513 3017 : *lp_error_ener = L_add( Mpy_32_16_1( L_sub( *lp_error_ener, ener2 ), 32440 /*0.99f Q15*/ ), ener2 ); /* 15Q16 */
514 3017 : move32();
515 :
516 3017 : st = add( st, 6 );
517 3017 : ener2 = L_sub( *lp_error_ener, L_deposit_h( sub( 31, st ) ) );
518 3017 : IF( ener2 >= 0 )
519 : {
520 182 : tmp16 = add( extract_h( ener2 ), 1 );
521 182 : ener2 = L_sub( ener2, L_deposit_h( tmp16 ) );
522 182 : tmp = L_shr( tmp, tmp16 );
523 182 : nrg = L_shr( nrg, tmp16 );
524 : }
525 3017 : ener2 = BASOP_Util_InvLog2( L_shl( ener2, 9 ) ); /* Q0+2*s1 */
526 :
527 3017 : tmp32 = L_add( L_shr( nrg, 1 ), L_shr( ener2, 1 ) );
528 3017 : if ( tmp32 == 0 )
529 0 : tmp32 = L_deposit_l( 1 );
530 3017 : tmp16 = BASOP_Util_Divide3232_Scale( tmp, tmp32, &st );
531 : BASOP_SATURATE_WARNING_OFF_EVS;
532 3017 : tmp16 = shl_sat( tmp16, sub( st, 2 ) ); /* Q15 */
533 :
534 3017 : if ( GT_16( tmp16, 16384 /*0.5f Q15*/ ) )
535 : {
536 157 : tmp16 = 16384 /*0.5f Q15*/;
537 157 : move16();
538 : }
539 3017 : if ( tmp16 < 0 )
540 : {
541 87 : tmp16 = 0;
542 87 : move16();
543 : }
544 : BASOP_SATURATE_WARNING_ON_EVS;
545 :
546 : /*Adjust gain*/
547 : /* full gain = gainLTP*0.5*/
548 : /* adaptive gain = gainLTP*0.5*max(0.5f*gain_factor_param[sf],0.125f)*/
549 3017 : tmp16 = round_fx( L_shl( L_mult0( tmp16, s_max( shl( gain_factor_param[sf], 2 ), 1 ) ), 13 ) );
550 :
551 :
552 : /* calculate noise based on voiced pitch */
553 3017 : IF( lg > 0 )
554 : {
555 140623 : FOR( i = 0; i < lg; i++ )
556 : {
557 138197 : tmp32 = L_msu0( 0, tmp16, syn[( i + i_subfr ) - T] );
558 138197 : tmp32 = L_msu0_sat( tmp32, tmp16, syn[( i + i_subfr ) + T] );
559 138197 : tmp32 = L_mac_sat( tmp32, tmp16, syn[i + i_subfr] );
560 138197 : bpf_noise_buf[i + i_subfr] = round_fx_sat( tmp32 ); /* Q0 */
561 138197 : move16();
562 : }
563 : }
564 :
565 3017 : IF( LT_16( lg, l_subfr ) )
566 : {
567 56046 : FOR( i = lg; i < l_subfr; i++ )
568 : {
569 54891 : tmp32 = L_mult0( tmp16, syn[i + i_subfr] );
570 54891 : tmp32 = L_msu0_sat( tmp32, tmp16, syn[i + i_subfr - T] );
571 54891 : bpf_noise_buf[i + i_subfr] = round_fx_sat( tmp32 ); /* Q0 */
572 54891 : move16();
573 : }
574 : }
575 : }
576 : ELSE
577 : {
578 542480 : set16_fx( bpf_noise_buf + i_subfr, 0, l_subfr );
579 : }
580 :
581 545497 : sf = add( sf, 1 );
582 : }
583 :
584 118408 : *mem_error = lp_error;
585 118408 : move32();
586 :
587 :
588 118408 : return;
589 : }
590 :
591 : /*---------------------------------------------------------------------*
592 : * cldfb_synth_set_bandsToZero()
593 : *
594 : *
595 : *---------------------------------------------------------------------*/
596 :
597 0 : void cldfb_synth_set_bandsToZero(
598 : Decoder_State *st,
599 : Word32 **rAnalysis,
600 : Word32 **iAnalysis,
601 : const Word16 nTimeSlots,
602 : const CLDFB_SCALE_FACTOR scaleFactor )
603 : {
604 : Word32 nrgQ31;
605 : Word32 nrg_band[CLDFB_NO_CHANNELS_MAX], tempQ31, max_nrg;
606 : Word16 realQ1, imagQ1, flag, offset, WBcnt;
607 : Word16 perc_detect, perc_miss;
608 : Word16 i, k, tmp1, tmp2, tmp3, tmp, update_perc;
609 : #ifndef ISSUE_1866_replace_overflow_libdec
610 : #ifdef BASOP_NOGLOB_DECLARE_LOCAL
611 : Flag Overflow = 0;
612 : move32();
613 : #endif
614 : #endif
615 :
616 :
617 0 : realQ1 = 0;
618 0 : move16();
619 0 : imagQ1 = 0;
620 0 : move16();
621 :
622 0 : set32_fx( nrg_band, 0, CLDFB_NO_CHANNELS_MAX );
623 0 : max_nrg = 0;
624 0 : move32();
625 :
626 0 : offset = 250;
627 0 : move16();
628 0 : WBcnt = 20;
629 0 : move16();
630 0 : perc_miss = 13107; /*0.80 in Q14*/
631 0 : move16();
632 0 : perc_detect = 14746; /*0.90 in Q14*/
633 0 : move16();
634 :
635 0 : IF( EQ_16( st->VAD, 1 ) )
636 : {
637 0 : st->active_frame_cnt_bwddec = add( st->active_frame_cnt_bwddec, 1 );
638 0 : move16();
639 0 : st->total_frame_cnt_bwddec = add( st->total_frame_cnt_bwddec, 1 );
640 0 : move16();
641 0 : if ( GT_16( st->active_frame_cnt_bwddec, 99 ) )
642 : {
643 0 : st->active_frame_cnt_bwddec = 100;
644 0 : move16();
645 : }
646 0 : if ( GT_16( st->total_frame_cnt_bwddec, 500 ) )
647 : {
648 0 : st->total_frame_cnt_bwddec = 500;
649 0 : move16();
650 : }
651 :
652 0 : FOR( i = 0; i < ( st->cldfbSyn->no_channels - st->cldfbSyn->bandsToZero ); i++ )
653 : {
654 0 : nrgQ31 = 0;
655 0 : move32();
656 0 : FOR( k = 0; k < nTimeSlots; k++ )
657 : {
658 : /* use 16-bit precision of real and imag buffers */
659 0 : realQ1 = extract_l( L_shr( rAnalysis[k][i], sub( 31 + 3 - 15, scaleFactor.lb_scale ) ) ); /*31 - (15 + scaleFactor.lb_scale) + 3 )*/
660 0 : imagQ1 = extract_l( L_shr( iAnalysis[k][i], sub( 31 + 3 - 15, scaleFactor.lb_scale ) ) ); /* Q(-3), headroom */
661 : #ifdef ISSUE_1866_replace_overflow_libdec
662 0 : nrgQ31 = L_mac0_sat( nrgQ31, realQ1, realQ1 );
663 0 : nrgQ31 = L_mac0_sat( nrgQ31, imagQ1, imagQ1 ); /* keep in Q(-6) */
664 : #else
665 : nrgQ31 = L_mac0_o( nrgQ31, realQ1, realQ1, &Overflow );
666 : nrgQ31 = L_mac0_o( nrgQ31, imagQ1, imagQ1, &Overflow ); /* keep in Q(-6) */
667 : #endif
668 : }
669 0 : nrg_band[i] = ( nrgQ31 );
670 0 : move16();
671 0 : test();
672 0 : if ( GT_32( nrg_band[i], max_nrg ) && GE_16( i, 11 ) )
673 : {
674 0 : max_nrg = nrg_band[i];
675 0 : move16();
676 : }
677 : }
678 0 : FOR( ; i < st->cldfbSyn->no_channels; i++ )
679 : {
680 0 : nrg_band[i] = 0;
681 0 : move16();
682 : }
683 :
684 0 : nrgQ31 = 0;
685 0 : move16();
686 0 : FOR( i = 2; i < 9; i++ )
687 : {
688 0 : nrgQ31 = L_add( nrgQ31, Mult_32_16( nrg_band[i], 4681 ) );
689 : }
690 :
691 0 : tempQ31 = L_shr( nrgQ31, 9 );
692 :
693 0 : st->avg_nrg_LT = L_add( Mult_32_16( st->avg_nrg_LT, 32440 ), Mult_32_16( tempQ31, 327 ) ); /*0.99*avg_nrg_LT + 0.01*tempQ31*/
694 0 : move32();
695 0 : update_perc = 1;
696 0 : move16();
697 0 : test();
698 0 : if ( GE_16( st->ini_frame, 25 ) && LT_32( tempQ31, Mult_32_16( st->avg_nrg_LT, 164 ) ) )
699 : {
700 0 : update_perc = 0;
701 0 : move16();
702 : }
703 :
704 0 : flag = 1;
705 0 : move16();
706 0 : if ( GE_32( max_nrg, tempQ31 ) )
707 : {
708 0 : flag = 0;
709 0 : move16();
710 : }
711 :
712 0 : FOR( i = 0; i < ( WBcnt - 1 ); i++ )
713 : {
714 0 : st->flag_buffer[i] = st->flag_buffer[i + 1];
715 0 : move16();
716 : }
717 0 : st->flag_buffer[WBcnt - 1] = flag;
718 0 : move16();
719 :
720 : /*long term percentage*/
721 0 : IF( EQ_16( update_perc, 1 ) )
722 : {
723 0 : IF( flag != 0 )
724 : {
725 0 : tmp1 = sub( 16384, st->perc_bwddec ); /*Q14*/
726 0 : move16();
727 :
728 0 : tmp = norm_s( st->active_frame_cnt_bwddec );
729 0 : tmp3 = shl( st->active_frame_cnt_bwddec, tmp ); /*Qtmp*/
730 :
731 0 : tmp2 = div_s( 16384, tmp3 ); /* 1/active_frames in Q15 + Q14 - Qtmp = Q29 - Qtmp */
732 0 : tmp2 = mult_r( tmp2, tmp1 ); /*(1-perc)*(1/active_frames) in Q14 + Q29 - Qtmp - Q15 = Q28 - Qtmp*/
733 0 : st->perc_bwddec = add( st->perc_bwddec, shl( tmp2, sub( tmp, 14 ) ) ); /* Q14 */
734 0 : move16();
735 : }
736 : ELSE
737 : {
738 0 : tmp1 = ( st->perc_bwddec ); /*Q14*/
739 0 : move16();
740 :
741 0 : tmp = norm_s( st->active_frame_cnt_bwddec );
742 0 : tmp3 = shl( st->active_frame_cnt_bwddec, tmp ); /*Qtmp*/
743 :
744 0 : tmp2 = div_s( 16384, tmp3 ); /* 1/active_frames in Q15 + Q14 - Qtmp = Q29 - Qtmp */
745 0 : tmp2 = mult_r( tmp2, tmp1 ); /*(perc)*(1/active_frames) in Q14 + Q29 - Qtmp - Q15 = Q28 - Qtmp*/
746 0 : st->perc_bwddec = sub( st->perc_bwddec, shl( tmp2, sub( tmp, 14 ) ) ); /* Q14 */
747 0 : move16();
748 : }
749 : }
750 0 : test();
751 0 : IF( GT_16( st->total_frame_cnt_bwddec, offset ) && GT_16( st->active_frame_cnt_bwddec, 50 ) )
752 : {
753 0 : test();
754 0 : test();
755 0 : test();
756 0 : IF( ( GE_16( st->perc_bwddec, perc_detect ) || ( GE_16( st->perc_bwddec, perc_miss ) && st->last_flag_filter_NB ) ) && ( sum16_fx( st->flag_buffer, WBcnt ) != 0 ) ) /*decision hysterysis*/
757 : {
758 0 : st->cldfbSyn->bandsToZero = sub( st->cldfbSyn->no_channels, 10 );
759 0 : move16();
760 0 : st->last_flag_filter_NB = 1;
761 0 : move16(); /*VAD processing must be dependent on hysterysis, as if hysterysis fails, but threshold passes, we dont want next vad frames to have NB only*/
762 : }
763 : ELSE
764 : {
765 0 : st->last_flag_filter_NB = 0;
766 0 : move16();
767 : }
768 : }
769 : ELSE
770 : {
771 0 : st->last_flag_filter_NB = 0;
772 0 : move16();
773 : }
774 0 : IF( sum16_fx( st->flag_buffer, WBcnt ) == 0 )
775 : {
776 0 : st->perc_bwddec = 0;
777 0 : move16();
778 0 : st->active_frame_cnt_bwddec = 0;
779 0 : move16();
780 0 : st->total_frame_cnt_bwddec = 0;
781 0 : move16();
782 0 : st->last_flag_filter_NB = 0;
783 0 : move16();
784 : }
785 : }
786 : ELSE
787 : {
788 0 : if ( EQ_16( st->last_flag_filter_NB, 1 ) )
789 : {
790 0 : st->cldfbSyn->bandsToZero = st->last_active_bandsToZero_bwdec;
791 0 : move16();
792 : }
793 0 : st->total_frame_cnt_bwddec = add( st->total_frame_cnt_bwddec, 1 );
794 0 : move16();
795 0 : if ( GT_16( st->total_frame_cnt_bwddec, 500 ) )
796 : {
797 0 : st->total_frame_cnt_bwddec = 500;
798 0 : move16();
799 : }
800 : }
801 :
802 0 : st->last_active_bandsToZero_bwdec = st->cldfbSyn->bandsToZero;
803 0 : move16();
804 :
805 0 : return;
806 : }
|
