Line data Source code
1 : /*====================================================================================
2 : EVS Codec 3GPP TS26.452 Aug 12, 2021. Version 16.3.0
3 : ====================================================================================*/
4 :
5 : #include <stdint.h>
6 : #include "options.h" /* Compilation switches */
7 : #include "cnst.h" /* Compilation switches */
8 : #include "rom_com.h" /* Static table prototypes */
9 : #include "prot_fx.h" /* Function prototypes */
10 : #include "prot_fx_enc.h" /* Function prototypes */
11 :
12 :
13 : /*=================================================================================*/
14 : /* FUNCTION : void encod_tran_fx () */
15 : /*---------------------------------------------------------------------------------*/
16 : /* PURPOSE : */
17 : /*---------------------------------------------------------------------------------*/
18 : /* INPUT ARGUMENTS : */
19 : /* (Word16) L_frame_fx : length of the frame Q0 */
20 : /* (Word16[]) speech_fx : input speech Q0 */
21 : /* (Word16[]) Aq_fx : 12k8 Lp coefficient Q12 */
22 : /* (Word16[]) A_fx : unquantized A(z) filter with bandwidth expansion Q12 */
23 : /* (Word16) coder_type : coding type Q0 */
24 : /* (Word16) Es_pred_fx : predicted scaled innov. energy Q8 */
25 : /* (Word16[]) T_op_fx : open loop pitch Q0 */
26 : /* (Word16[]) voicing_fx : voicing Q15 */
27 : /* (Word16*) res_fx : residual signal Q_new*/
28 : /* (Word16) gsc_attack_flag : Flag to indicate when an audio attack is deal with TM*/
29 : /* (Word16) shift : shift factor */
30 : /* (Word16[]) Q_new : input scaling */
31 : /*---------------------------------------------------------------------------------*/
32 : /* OUTPUT ARGUMENTS : */
33 : /* (Word16*) voice_factors : voicing factors Q15 */
34 : /*---------------------------------------------------------------------------------*/
35 : /* INPUT/OUTPUT ARGUMENTS : */
36 : /* Encoder_State *st_fx :Encoder state structure */
37 : /* (Word16*) syn_fx :core synthesis Qnew */
38 : /* (Word16*) exc_fx :current non-enhanced excitation Q0 */
39 : /* (Word16*) exc2_fx :current enhanced excitation Q0 */
40 : /* (Word16*) pitch_buf_fx :floating pitch values for each subframe Q6 */
41 : /* (Word16*) bwe_exc_fx :excitation for SWB TBE Q0 */
42 : /*---------------------------------------------------------------------------------*/
43 : /* RETURN ARGUMENTS : */
44 : /* _ None */
45 : /*---------------------------------------------------------------------------------*/
46 :
47 124 : Word16 encod_tran_fx(
48 : Encoder_State *st_fx, /* i/o: state structure */
49 : const Word16 speech_fx[], /* i : input speech Q0*/
50 : const Word16 Aw_fx[], /* i : weighted A(z) unquantized for subframes Q12*/
51 : const Word16 Aq_fx[], /* i : 12k8 Lp coefficient Q12*/
52 : const Word16 Es_pred_fx, /* i : predicted scaled innov. energy Q8*/
53 : const Word16 *res_fx, /* i : residual signal Q_new*/
54 : Word16 *syn_fx, /* i/o: core synthesis Q_new*/
55 : Word16 *exc_fx, /* i/o: current non-enhanced excitation Q0*/
56 : Word16 *exc2_fx, /* i/o: current enhanced excitation Q0*/
57 : Word16 *pitch_buf_fx, /* i/o: floating pitch values for each subframe Q6*/
58 : Word16 *voice_factors, /* o : voicing factors Q15*/
59 : Word16 *bwe_exc_fx, /* i/o: excitation for SWB TBE Q0*/
60 : Word16 tc_subfr, /* i/o: TC subframe classification Q0*/
61 : Word16 position, /* i : maximum of residual signal index Q0*/
62 : Word16 *unbits, /* i/o: number of unused bits Q0*/
63 : const Word16 shift, /* i : Scaling to get 12 bits */
64 : const Word16 Q_new /* i : Input scaling */
65 : )
66 : {
67 : Word16 xn[L_SUBFR]; /* Target vector for pitch search */
68 : Word16 xn2[L_SUBFR]; /* Target vector for codebook search */
69 : Word16 cn[L_SUBFR]; /* Target vector in residual domain */
70 : Word16 h1[L_SUBFR + ( M + 1 )]; /* Impulse response vector */
71 : Word16 h2_fx[L_SUBFR + ( M + 1 )]; /* Impulse response vector */
72 : Word16 code[L_SUBFR]; /* Fixed codebook excitation */
73 : Word16 y1[L_SUBFR]; /* Filtered adaptive excitation */
74 : Word16 y2[L_SUBFR]; /* Filtered algebraic excitation */
75 124 : Word16 gain_pit = 0, Gain_pitX2, gcode16; /* Pitch gain */
76 : Word16 voice_fac; /* Voicing factor */
77 124 : Word32 gain_code = 0; /* Gain of code */
78 : Word32 Lgcode;
79 124 : Word16 gain_inov = 0; /* inovation gain */
80 : Word16 i, i_subfr, tmp1_fx, tmp_fx; /* tmp variables */
81 : Word16 unbits_ACELP;
82 : Word16 T0_min, T0_max; /* pitch and TC variables */
83 : Word16 T0, T0_frac; /* close loop integer pitch and fractional part */
84 : Word16 *pt_pitch; /* pointer to floating pitch buffer */
85 : Word16 g_corr[10]; /* ACELP correlation values and gain pitch */
86 : Word16 clip_gain; /* LSF clip gain */
87 : const Word16 *p_Aw, *p_Aq; /* pointer to LP filter coefficient vector */
88 124 : Word16 gain_preQ = 0; /* Gain of prequantizer excitation */
89 : Word16 code_preQ[L_SUBFR]; /* Prequantizer excitation */
90 : Word16 Jopt_flag; /* joint optimization flag */
91 124 : Word16 unbits_PI = 0; /* saved bits for PI */
92 124 : Word32 norm_gain_code = 0;
93 : Word16 L_frame_fx;
94 : Word16 shift_wsp;
95 : Word32 L_tmp;
96 124 : BSTR_ENC_HANDLE hBstr = st_fx->hBstr;
97 124 : SC_VBR_ENC_HANDLE hSC_VBR = st_fx->hSC_VBR;
98 124 : LPD_state_HANDLE hLPDmem = st_fx->hLPDmem;
99 :
100 124 : L_frame_fx = st_fx->L_frame;
101 124 : move16();
102 :
103 : /*------------------------------------------------------------------*
104 : * Initializations
105 : *------------------------------------------------------------------*/
106 :
107 124 : gain_pit = 0;
108 124 : move16();
109 124 : gain_code = L_deposit_l( 0 );
110 124 : gain_preQ = 0;
111 124 : move16();
112 124 : unbits_PI = 0;
113 124 : move16();
114 124 : IF( EQ_16( L_frame_fx, L_FRAME ) )
115 : {
116 74 : T0_max = PIT_MAX;
117 74 : move16();
118 74 : T0_min = PIT_MIN;
119 74 : move16();
120 : }
121 : ELSE /* L_frame == L_FRAME16k */
122 : {
123 50 : T0_max = PIT16k_MAX;
124 50 : move16();
125 50 : T0_min = PIT16k_MIN;
126 50 : move16();
127 : }
128 :
129 : /**unbits = 0;move16();*/
130 124 : Jopt_flag = 0;
131 124 : move16();
132 124 : unbits_ACELP = *unbits; /* Q0 */
133 124 : move16();
134 124 : *unbits = 0;
135 124 : move16();
136 :
137 124 : p_Aw = Aw_fx; /* Q12 */
138 124 : p_Aq = Aq_fx; /* Q12 */
139 124 : pt_pitch = pitch_buf_fx; /* Q6 */
140 124 : gain_preQ = 0;
141 124 : move16();
142 124 : set16_fx( code_preQ, 0, L_SUBFR );
143 124 : shift_wsp = add( Q_new, shift );
144 :
145 : /*----------------------------------------------------------------*
146 : * ACELP subframe loop
147 : *----------------------------------------------------------------*/
148 :
149 670 : FOR( i_subfr = 0; i_subfr < L_frame_fx; i_subfr += L_SUBFR )
150 : {
151 : /*----------------------------------------------------------------*
152 : * Find the the excitation search target "xn" and innovation
153 : * target in residual domain "cn"
154 : * Compute impulse response, h1[], of weighted synthesis filter
155 : *----------------------------------------------------------------*/
156 :
157 546 : Copy( &res_fx[i_subfr], &exc_fx[i_subfr], L_SUBFR ); /* Q_new */
158 :
159 546 : find_targets_fx( speech_fx, hLPDmem->mem_syn, i_subfr, &hLPDmem->mem_w0, p_Aq,
160 546 : res_fx, L_SUBFR, p_Aw, st_fx->preemph_fac, xn, cn, h1 );
161 :
162 546 : Copy_Scale_sig( h1, h2_fx, L_SUBFR, -2 );
163 546 : Scale_sig( h1, L_SUBFR, add( 1, shift ) ); /* set h1[] in Q14 with scaling for convolution */
164 :
165 : /* scaling of xn[] to limit dynamic at 12 bits */
166 546 : Scale_sig( xn, L_SUBFR, shift );
167 :
168 : /*-----------------------------------------------------------------*
169 : * TC: subframe determination &
170 : * adaptive/glottal part of excitation construction
171 : *-----------------------------------------------------------------*/
172 :
173 546 : transition_enc_fx( st_fx, i_subfr, &tc_subfr, &Jopt_flag, &position, &T0, &T0_frac, &T0_min, &T0_max, exc_fx, y1,
174 546 : h1, xn, xn2, st_fx->clip_var_fx, &gain_pit, g_corr, &clip_gain, &pt_pitch, bwe_exc_fx, &unbits_ACELP, Q_new, shift );
175 :
176 : /*-----------------------------------------------------------------*
177 : * Transform domain contribution encoding - active frames
178 : *-----------------------------------------------------------------*/
179 :
180 546 : IF( GE_32( st_fx->core_brate, MIN_BRATE_AVQ_EXC ) )
181 : {
182 250 : transf_cdbk_enc_fx( st_fx, 0, i_subfr, cn, exc_fx, p_Aq, Aw_fx, h1, xn, xn2, y1, y2, Es_pred_fx,
183 : &gain_pit, gain_code, g_corr, clip_gain, &gain_preQ, code_preQ, unbits, Q_new, shift );
184 : }
185 :
186 : /*-----------------------------------------------------------------*
187 : * ACELP codebook search + pitch sharpening
188 : *-----------------------------------------------------------------*/
189 :
190 546 : inov_encode_fx( st_fx, st_fx->core_brate, 0, L_frame_fx, st_fx->last_L_frame, st_fx->coder_type, st_fx->bwidth, st_fx->sharpFlag,
191 546 : i_subfr, tc_subfr, p_Aq, gain_pit, cn, exc_fx, h2_fx, hLPDmem->tilt_code, *pt_pitch, xn2, code, y2, &unbits_PI, L_SUBFR, shift );
192 :
193 546 : test();
194 546 : test();
195 546 : test();
196 546 : if ( ( EQ_16( st_fx->L_frame, L_FRAME16k ) ) && ( tc_subfr == 0 ) && ( EQ_16( i_subfr, L_SUBFR ) ) && ( EQ_16( T0, 2 * L_SUBFR ) ) )
197 : {
198 7 : Jopt_flag = 1;
199 7 : move16();
200 : }
201 :
202 : /*-----------------------------------------------------------------*
203 : * Quantize the gains
204 : * Test quantized gain of pitch for pitch clipping algorithm
205 : * Update tilt of code: 0.0 (unvoiced) to 0.5 (voiced)
206 : *-----------------------------------------------------------------*/
207 :
208 546 : IF( Jopt_flag == 0 )
209 : {
210 : /* SQ gain_code */
211 90 : gain_enc_tc_fx( hBstr, st_fx->acelp_cfg.gains_mode, i_subfr, xn, y2, code, Es_pred_fx,
212 : &gain_pit, &gain_code, &gain_inov, &norm_gain_code, shift_wsp );
213 : }
214 : ELSE
215 : {
216 456 : IF( GT_32( st_fx->core_brate, ACELP_32k ) )
217 : {
218 : /* SQ gain_pit and gain_code */
219 238 : gain_enc_SQ_fx( hBstr, st_fx->acelp_cfg.gains_mode, i_subfr, xn, y1, y2, code, Es_pred_fx,
220 : &gain_pit, &gain_code, &gain_inov, &norm_gain_code, g_corr, clip_gain, shift_wsp );
221 : }
222 : ELSE
223 : {
224 : /* VQ gain_pit and gain_code */
225 218 : gain_enc_mless_fx( hBstr, st_fx->acelp_cfg.gains_mode, st_fx->element_mode, L_frame_fx, i_subfr, tc_subfr, xn, y1, shift_wsp, y2, code, Es_pred_fx,
226 : &gain_pit, &gain_code, &gain_inov, &norm_gain_code, g_corr, clip_gain );
227 : }
228 : }
229 546 : gp_clip_test_gain_pit_fx( st_fx->element_mode, st_fx->core_brate, gain_pit, st_fx->clip_var_fx );
230 :
231 546 : Lgcode = L_shl_sat( gain_code, Q_new ); /* scaled gain_code with Qnew -> Q16*/
232 546 : gcode16 = round_fx_sat( Lgcode );
233 546 : hLPDmem->tilt_code = Est_tilt2( &exc_fx[i_subfr], gain_pit, code, Lgcode, &voice_fac, shift ); /* Q15 */
234 :
235 : /*-----------------------------------------------------------------*
236 : * Update memory of the weighting filter
237 : *-----------------------------------------------------------------*/
238 :
239 : /*st->mem_w0 = xn[L_SUBFR-1] - (gain_pit*y1[L_SUBFR-1]) - (gain_code*y2[L_SUBFR-1]);*/
240 546 : L_tmp = L_mult( gcode16, y2[L_SUBFR - 1] ); /* Q10 + Q_new */
241 546 : L_tmp = L_shl( L_tmp, add( 5, shift ) ); /* Q15 + Q_new + shift */
242 546 : L_tmp = L_negate( L_tmp );
243 546 : L_tmp = L_mac( L_tmp, xn[L_SUBFR - 1], 16384 );
244 546 : L_tmp = L_msu( L_tmp, y1[L_SUBFR - 1], gain_pit );
245 546 : L_tmp = L_shl_sat( L_tmp, sub( 1, shift ) ); /* Q_new + 15 */
246 546 : hLPDmem->mem_w0 = round_fx_sat( L_tmp ); /*Q_new-1*/
247 :
248 : /*-----------------------------------------------------------------*
249 : * Construct adaptive part of the excitation
250 : * Save the non-enhanced excitation for FEC_exc
251 : *-----------------------------------------------------------------*/
252 :
253 : /* Here, all these conditions have one purpose: to use */
254 : /* the most efficient loop (the one with the least ops) */
255 : /* This is done by upscaling gain_pit_fx and/or gain_code16 */
256 : /* when they don't use all 16 bits of precision */
257 :
258 : /* exc Q_exc, gpit Q14, code Q12, gcode Q0 */
259 546 : IF( norm_s( gain_pit ) == 0 )
260 : {
261 12350 : FOR( i = 0; i < L_SUBFR; i++ )
262 : {
263 12160 : exc2_fx[i + i_subfr] = round_fx_sat( L_shl_sat( L_mult_sat( gain_pit, exc_fx[i + i_subfr] ), 1 ) ); /* Q_new */
264 : }
265 : }
266 : ELSE
267 : {
268 356 : Gain_pitX2 = shl( gain_pit, 1 ); /* Q15 */
269 23140 : FOR( i = 0; i < L_SUBFR; i++ )
270 : {
271 22784 : exc2_fx[i + i_subfr] = mult_r( Gain_pitX2, exc_fx[i + i_subfr] ); /* Q_new */
272 : }
273 : }
274 :
275 : /*-----------------------------------------------------------------*
276 : * Construct adaptive part of the excitation
277 : * Save the non-enhanced excitation for FEC_exc
278 : *-----------------------------------------------------------------*/
279 35490 : FOR( i = 0; i < L_SUBFR; i++ )
280 : {
281 : /* code in Q9, gain_pit in Q14 */
282 34944 : L_tmp = L_mult( gcode16, code[i] ); /* Q10 + Q_new */
283 34944 : L_tmp = L_shl_sat( L_tmp, 5 ); /* Q15 + Q_new */
284 34944 : L_tmp = L_mac_sat( L_tmp, exc_fx[i + i_subfr], gain_pit ); /* Q15 + Q_new */
285 34944 : L_tmp = L_shl_sat( L_tmp, 1 ); /* saturation can occur here Q16 + Q_new */
286 34944 : exc_fx[i + i_subfr] = round_fx_sat( L_tmp ); /* Q_new */
287 : }
288 :
289 : /*-----------------------------------------------------------------*
290 : * Add the ACELP pre-quantizer contribution
291 : *-----------------------------------------------------------------*/
292 :
293 546 : IF( GE_32( st_fx->core_brate, MIN_BRATE_AVQ_EXC ) )
294 : {
295 250 : tmp1_fx = add( 16 - ( 2 + Q_AVQ_OUT_DEC + 1 ), Q_new );
296 16250 : FOR( i = 0; i < L_SUBFR; i++ )
297 : {
298 16000 : L_tmp = L_mult( gain_preQ, code_preQ[i] ); /* Q2 + Q10 -> Q13*/
299 16000 : L_tmp = L_shl_sat( L_tmp, tmp1_fx ); /* Q16 + Q_exc */
300 16000 : tmp_fx = round_fx_sat( L_tmp );
301 16000 : exc2_fx[i + i_subfr] = add_sat( exc2_fx[i + i_subfr], tmp_fx ); /* Q_exc */
302 16000 : move16();
303 16000 : exc_fx[i + i_subfr] = add_sat( exc_fx[i + i_subfr], tmp_fx ); /* Q_exc */
304 16000 : move16();
305 : }
306 : }
307 :
308 : /*-----------------------------------------------------------------*
309 : * Prepare TBE excitation
310 : *-----------------------------------------------------------------*/
311 :
312 546 : prep_tbe_exc_fx( L_frame_fx, L_SUBFR, i_subfr, gain_pit, gain_code, code, voice_fac, &voice_factors[i_subfr / L_SUBFR],
313 546 : bwe_exc_fx, gain_preQ, code_preQ, Q10, Q_new, T0, T0_frac, st_fx->coder_type, st_fx->core_brate, st_fx->element_mode, st_fx->idchan, st_fx->hBWE_TD != NULL, st_fx->tdm_LRTD_flag );
314 :
315 : /*-----------------------------------------------------------------*
316 : * Synthesize speech to update mem_syn[].
317 : * Update A(z) filters
318 : *-----------------------------------------------------------------*/
319 :
320 546 : Syn_filt_s( 1, p_Aq, M, &exc_fx[i_subfr], &syn_fx[i_subfr], L_SUBFR, hLPDmem->mem_syn, 1 );
321 :
322 546 : p_Aw += ( M + 1 );
323 546 : p_Aq += ( M + 1 );
324 546 : pt_pitch++;
325 : }
326 :
327 : /* write reserved bits */
328 124 : WHILE( unbits_PI > 0 )
329 : {
330 0 : i = s_min( unbits_PI, 16 );
331 0 : push_indice( hBstr, IND_UNUSED, 0, i );
332 0 : unbits_PI -= i;
333 : }
334 :
335 : /* write TC configuration */
336 124 : IF( EQ_16( L_frame_fx, L_FRAME ) )
337 : {
338 74 : IF( EQ_16( tc_subfr, TC_0_0 ) )
339 : {
340 31 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
341 : }
342 43 : ELSE IF( EQ_16( tc_subfr, TC_0_64 ) )
343 : {
344 9 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
345 9 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
346 9 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
347 9 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
348 : }
349 34 : ELSE IF( EQ_16( tc_subfr, TC_0_128 ) )
350 : {
351 5 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
352 5 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
353 5 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
354 5 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
355 : }
356 29 : ELSE IF( EQ_16( tc_subfr, TC_0_192 ) )
357 : {
358 3 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
359 3 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
360 3 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
361 : }
362 26 : ELSE IF( EQ_16( tc_subfr, L_SUBFR ) )
363 : {
364 5 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
365 5 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
366 5 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
367 : }
368 21 : ELSE IF( EQ_16( tc_subfr, 2 * L_SUBFR ) )
369 : {
370 1 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
371 1 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
372 1 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
373 1 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
374 : }
375 20 : ELSE IF( EQ_16( tc_subfr, 3 * L_SUBFR ) )
376 : {
377 20 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
378 20 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
379 20 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
380 20 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
381 : }
382 : }
383 : ELSE /* L_frame == L_FRAME16k */
384 : {
385 50 : IF( tc_subfr == 0 )
386 : {
387 39 : push_indice( hBstr, IND_TC_SUBFR, 0, 2 );
388 : }
389 11 : ELSE IF( EQ_16( tc_subfr, L_SUBFR ) )
390 : {
391 10 : push_indice( hBstr, IND_TC_SUBFR, 1, 2 );
392 : }
393 1 : ELSE IF( EQ_16( tc_subfr, 2 * L_SUBFR ) )
394 : {
395 1 : push_indice( hBstr, IND_TC_SUBFR, 2, 2 );
396 : }
397 0 : ELSE IF( EQ_16( tc_subfr, 3 * L_SUBFR ) )
398 : {
399 0 : push_indice( hBstr, IND_TC_SUBFR, 3, 2 );
400 0 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
401 : }
402 0 : ELSE IF( EQ_16( tc_subfr, 4 * L_SUBFR ) )
403 : {
404 0 : push_indice( hBstr, IND_TC_SUBFR, 3, 2 );
405 0 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
406 : }
407 : }
408 :
409 124 : IF( st_fx->Opt_SC_VBR )
410 : {
411 : /* SC-VBR */
412 0 : hSC_VBR->prev_ppp_gain_pit_fx = gain_pit; /* Q14 */
413 0 : move16();
414 0 : hSC_VBR->prev_tilt_code_fx = hLPDmem->tilt_code; /* Q15 */
415 0 : move16();
416 : }
417 :
418 124 : return tc_subfr;
419 : }
420 :
421 :
422 19052 : Word16 encod_tran_ivas_fx(
423 : Encoder_State *st_fx, /* i/o: state structure */
424 : const Word16 speech_fx[], /* i : input speech Q0*/
425 : const Word16 Aw_fx[], /* i : weighted A(z) unquantized for subframes Q12*/
426 : const Word16 Aq_fx[], /* i : 12k8 Lp coefficient Q12*/
427 : const Word16 Es_pred_fx, /* i : predicted scaled innov. energy Q8*/
428 : const Word16 *res_fx, /* i : residual signal Q_new*/
429 : Word16 *syn_fx, /* i/o: core synthesis Q_new*/
430 : Word16 *exc_fx, /* i/o: current non-enhanced excitation Q0*/
431 : Word16 *exc2_fx, /* i/o: current enhanced excitation Q0*/
432 : Word16 *pitch_buf_fx, /* i/o: floating pitch values for each subframe Q6*/
433 : Word16 *voice_factors, /* o : voicing factors Q15*/
434 : Word16 *bwe_exc_fx, /* i/o: excitation for SWB TBE Q0*/
435 : Word16 tc_subfr, /* i/o: TC subframe classification Q0*/
436 : Word16 position, /* i : maximum of residual signal index Q0*/
437 : Word16 *unbits, /* i/o: number of unused bits Q0*/
438 : const Word16 shift_r, /* i : Scaling to get 12 bits */
439 : const Word16 Q_new /* i : Input scaling */
440 : )
441 : {
442 : Word16 xn[L_SUBFR]; /* Target vector for pitch search */
443 : Word16 xn2[L_SUBFR]; /* Target vector for codebook search */
444 : Word16 cn[L_SUBFR]; /* Target vector in residual domain */
445 : Word16 h1[L_SUBFR + ( M + 1 )]; /* Impulse response vector */
446 : Word16 h2_fx[L_SUBFR + ( M + 1 )]; /* Impulse response vector */
447 : Word16 code[L_SUBFR]; /* Fixed codebook excitation */
448 : Word16 y1[L_SUBFR]; /* Filtered adaptive excitation */
449 : Word16 y2[L_SUBFR]; /* Filtered algebraic excitation */
450 19052 : Word16 gain_pit = 0, Gain_pitX2, gcode16; /* Pitch gain */
451 : Word16 voice_fac; /* Voicing factor */
452 19052 : Word32 gain_code = 0; /* Gain of code */
453 : Word32 Lgcode;
454 19052 : Word16 gain_inov = 0; /* inovation gain */
455 : Word16 i, i_subfr, tmp1_fx, tmp_fx; /* tmp variables */
456 : Word16 unbits_ACELP;
457 : Word16 T0_min, T0_max; /* pitch and TC variables */
458 : Word16 T0, T0_frac; /* close loop integer pitch and fractional part */
459 : Word16 *pt_pitch; /* pointer to floating pitch buffer */
460 : Word16 g_corr[10]; /* ACELP correlation values and gain pitch */
461 : Word16 clip_gain; /* LSF clip gain */
462 : const Word16 *p_Aw, *p_Aq; /* pointer to LP filter coefficient vector */
463 19052 : Word16 gain_preQ = 0; /* Gain of prequantizer excitation */
464 : Word16 code_preQ[L_SUBFR]; /* Prequantizer excitation */
465 : Word16 Jopt_flag; /* joint optimization flag */
466 19052 : Word16 unbits_PI = 0; /* saved bits for PI */
467 19052 : Word32 norm_gain_code = 0;
468 : Word16 L_frame_fx;
469 : Word16 shift_wsp;
470 : Word32 L_tmp;
471 : Word16 q_h1;
472 : Word16 shift, tmp;
473 19052 : BSTR_ENC_HANDLE hBstr = st_fx->hBstr;
474 19052 : SC_VBR_ENC_HANDLE hSC_VBR = st_fx->hSC_VBR;
475 19052 : LPD_state_HANDLE hLPDmem = st_fx->hLPDmem;
476 :
477 19052 : shift = shift_r; /* for IVAS, shift_r is always 0 */
478 : /* will be reusing the EVS shift strategy later on to allow of H1 overshoot */
479 19052 : move16();
480 19052 : L_frame_fx = st_fx->L_frame;
481 19052 : move16();
482 :
483 19052 : set16_fx( h1, 0, L_SUBFR + ( M + 1 ) );
484 :
485 : /*------------------------------------------------------------------*
486 : * Initializations
487 : *------------------------------------------------------------------*/
488 :
489 19052 : gain_pit = 0;
490 19052 : move16();
491 19052 : gain_code = L_deposit_l( 0 );
492 19052 : gain_preQ = 0;
493 19052 : move16();
494 19052 : unbits_PI = 0;
495 19052 : move16();
496 19052 : IF( EQ_16( L_frame_fx, L_FRAME ) )
497 : {
498 9808 : T0_max = PIT_MAX;
499 9808 : move16();
500 9808 : T0_min = PIT_MIN;
501 9808 : move16();
502 : }
503 : ELSE /* L_frame == L_FRAME16k */
504 : {
505 9244 : T0_max = PIT16k_MAX;
506 9244 : move16();
507 9244 : T0_min = PIT16k_MIN;
508 9244 : move16();
509 : }
510 :
511 : /**unbits = 0;move16();*/
512 19052 : Jopt_flag = 0;
513 19052 : move16();
514 19052 : unbits_ACELP = *unbits; /* Q0 */
515 19052 : move16();
516 19052 : *unbits = 0;
517 19052 : move16();
518 :
519 19052 : p_Aw = Aw_fx; /* Q12 */
520 19052 : p_Aq = Aq_fx; /* Q12 */
521 19052 : pt_pitch = pitch_buf_fx;
522 19052 : gain_preQ = 0;
523 19052 : move16();
524 19052 : set16_fx( code_preQ, 0, L_SUBFR );
525 19052 : shift_wsp = add( Q_new, shift );
526 19052 : if ( LT_32( st_fx->core_brate, MIN_BRATE_AVQ_EXC ) )
527 : {
528 16974 : shift_wsp = sub( shift_wsp, 1 );
529 : }
530 :
531 : /*----------------------------------------------------------------*
532 : * ACELP subframe loop
533 : *----------------------------------------------------------------*/
534 :
535 104504 : FOR( i_subfr = 0; i_subfr < L_frame_fx; i_subfr += L_SUBFR )
536 : {
537 : /*----------------------------------------------------------------*
538 : * Find the the excitation search target "xn" and innovation
539 : * target in residual domain "cn"
540 : * Compute impulse response, h1[], of weighted synthesis filter
541 : *----------------------------------------------------------------*/
542 :
543 85452 : Copy( &res_fx[i_subfr], &exc_fx[i_subfr], L_SUBFR ); /* Q_new */
544 :
545 :
546 85452 : find_targets_ivas_fx( speech_fx, hLPDmem->mem_syn, i_subfr, &hLPDmem->mem_w0, p_Aq,
547 85452 : res_fx, L_SUBFR, p_Aw, st_fx->preemph_fac, xn, cn, h1 );
548 :
549 85452 : q_h1 = sub( 14, norm_s( h1[0] ) );
550 85452 : tmp = sub( 14, norm_arr( h1, L_SUBFR ) );
551 85452 : shift = sub( q_h1, tmp ); /* shift is initialized to shift_r ( to 0) at the beginning of the scope, re-compute shift_wsp in case it has changed */
552 85452 : shift_wsp = add( Q_new, shift );
553 85452 : if ( LT_32( st_fx->core_brate, MIN_BRATE_AVQ_EXC ) )
554 : {
555 75062 : shift_wsp = sub( shift_wsp, 1 );
556 : }
557 85452 : Copy_Scale_sig( h1, h2_fx, L_SUBFR, sub( 11, q_h1 ) ); /*Q11*/
558 85452 : Scale_sig( h1, L_SUBFR, add( sub( 14, q_h1 ), shift ) );
559 : /* scaling of xn[] to limit dynamic at 12 bits */
560 85452 : Scale_sig( xn, L_SUBFR, shift );
561 :
562 : /*-----------------------------------------------------------------*
563 : * TC: subframe determination &
564 : * adaptive/glottal part of excitation construction
565 : *-----------------------------------------------------------------*/
566 :
567 85452 : transition_enc_ivas_fx( st_fx, i_subfr, &tc_subfr, &Jopt_flag, &position, &T0, &T0_frac, &T0_min, &T0_max, exc_fx, y1,
568 85452 : h1, xn, xn2, st_fx->clip_var_fx, &gain_pit, g_corr, &clip_gain, &pt_pitch, bwe_exc_fx, &unbits_ACELP, Q_new, shift );
569 :
570 : /*-----------------------------------------------------------------*
571 : * Transform domain contribution encoding - active frames
572 : *-----------------------------------------------------------------*/
573 :
574 85452 : IF( GE_32( st_fx->core_brate, MIN_BRATE_AVQ_EXC ) )
575 : {
576 10390 : transf_cdbk_enc_ivas_fx( st_fx, 0, i_subfr, cn, exc_fx, p_Aq, Aw_fx, h1, xn, xn2, y1, y2, Es_pred_fx,
577 : &gain_pit, gain_code, g_corr, clip_gain, &gain_preQ, code_preQ, unbits, Q_new, shift );
578 : }
579 :
580 : /*-----------------------------------------------------------------*
581 : * ACELP codebook search + pitch sharpening
582 : *-----------------------------------------------------------------*/
583 :
584 85452 : inov_encode_ivas_fx( st_fx, st_fx->core_brate, 0, L_frame_fx, st_fx->last_L_frame, st_fx->coder_type, st_fx->bwidth, st_fx->sharpFlag,
585 85452 : i_subfr, tc_subfr, p_Aq, gain_pit, cn, exc_fx, h2_fx, hLPDmem->tilt_code, *pt_pitch, xn2, code, y2, &unbits_PI, L_SUBFR, shift, Q_new );
586 :
587 85452 : test();
588 85452 : test();
589 85452 : test();
590 85452 : if ( ( EQ_16( st_fx->L_frame, L_FRAME16k ) ) && ( tc_subfr == 0 ) && ( EQ_16( i_subfr, L_SUBFR ) ) && ( EQ_16( T0, 2 * L_SUBFR ) ) )
591 : {
592 672 : Jopt_flag = 1;
593 672 : move16();
594 : }
595 :
596 : /*-----------------------------------------------------------------*
597 : * Quantize the gains
598 : * Test quantized gain of pitch for pitch clipping algorithm
599 : * Update tilt of code: 0.0 (unvoiced) to 0.5 (voiced)
600 : *-----------------------------------------------------------------*/
601 :
602 85452 : IF( Jopt_flag == 0 )
603 : {
604 : /* SQ gain_code */
605 26641 : gain_enc_tc_fx( hBstr, st_fx->acelp_cfg.gains_mode, i_subfr, xn, y2, code, Es_pred_fx,
606 : &gain_pit, &gain_code, &gain_inov, &norm_gain_code, shift_wsp );
607 : }
608 : ELSE
609 : {
610 58811 : IF( GT_32( st_fx->core_brate, ACELP_32k ) )
611 : {
612 : /* SQ gain_pit and gain_code */
613 4622 : gain_enc_SQ_fx( hBstr, st_fx->acelp_cfg.gains_mode, i_subfr, xn, y1, y2, code, Es_pred_fx,
614 : &gain_pit, &gain_code, &gain_inov, &norm_gain_code, g_corr, clip_gain, shift_wsp );
615 : }
616 : ELSE
617 : {
618 : /* VQ gain_pit and gain_code */
619 54189 : gain_enc_mless_fx( hBstr, st_fx->acelp_cfg.gains_mode, st_fx->element_mode, L_frame_fx, i_subfr, tc_subfr, xn, y1, shift_wsp, y2, code, Es_pred_fx,
620 : &gain_pit, &gain_code, &gain_inov, &norm_gain_code, g_corr, clip_gain );
621 : }
622 : }
623 85452 : gp_clip_test_gain_pit_fx( st_fx->element_mode, st_fx->core_brate, gain_pit, st_fx->clip_var_fx );
624 :
625 85452 : Lgcode = L_shl_sat( gain_code, Q_new ); /* scaled gain_code with Qnew -> Q16*/
626 85452 : gcode16 = round_fx_sat( Lgcode );
627 85452 : hLPDmem->tilt_code = est_tilt_ivas_fx( &exc_fx[i_subfr], gain_pit, code, gain_code, &voice_fac, Q_new, L_SUBFR, 0 ); // Q15
628 :
629 : /*-----------------------------------------------------------------*
630 : * Update memory of the weighting filter
631 : *-----------------------------------------------------------------*/
632 :
633 : /*st->mem_w0 = xn[L_SUBFR-1] - (gain_pit*y1[L_SUBFR-1]) - (gain_code*y2[L_SUBFR-1]);*/
634 85452 : L_tmp = L_mult0( gcode16, y2[L_SUBFR - 1] );
635 85452 : L_tmp = L_shl( L_tmp, add( 5, shift ) ); // Q_new+14+shift
636 85452 : L_tmp = L_negate( L_tmp );
637 85452 : L_tmp = L_mac( L_tmp, xn[L_SUBFR - 1], 16384 ); // Q_new-1+15+shift
638 85452 : L_tmp = L_msu( L_tmp, y1[L_SUBFR - 1], gain_pit ); // Q_new-1+15+shift
639 85452 : L_tmp = L_shl_sat( L_tmp, sub( 1, shift ) ); // Q_new+15
640 85452 : hLPDmem->mem_w0 = round_fx_sat( L_tmp ); /*Q_new-1*/
641 :
642 : /*-----------------------------------------------------------------*
643 : * Construct adaptive part of the excitation
644 : * Save the non-enhanced excitation for FEC_exc
645 : *-----------------------------------------------------------------*/
646 :
647 : /* Here, all these conditions have one purpose: to use */
648 : /* the most efficient loop (the one with the least ops) */
649 : /* This is done by upscaling gain_pit_fx and/or gain_code16 */
650 : /* when they don't use all 16 bits of precision */
651 :
652 : /* exc Q_exc, gpit Q14, code Q12, gcode Q0 */
653 85452 : IF( norm_s( gain_pit ) == 0 )
654 : {
655 2350920 : FOR( i = 0; i < L_SUBFR; i++ )
656 : {
657 2314752 : exc2_fx[i + i_subfr] = round_fx_sat( L_shl_sat( L_mult_sat( gain_pit, exc_fx[i + i_subfr] ), 1 ) ); /* Q_exc */
658 : }
659 : }
660 : ELSE
661 : {
662 49284 : Gain_pitX2 = shl( gain_pit, 1 );
663 3203460 : FOR( i = 0; i < L_SUBFR; i++ )
664 : {
665 3154176 : exc2_fx[i + i_subfr] = mult_r( Gain_pitX2, exc_fx[i + i_subfr] ); /* Q_exc */
666 : }
667 : }
668 :
669 : /*-----------------------------------------------------------------*
670 : * Construct adaptive part of the excitation
671 : * Save the non-enhanced excitation for FEC_exc
672 : *-----------------------------------------------------------------*/
673 :
674 5554380 : FOR( i = 0; i < L_SUBFR; i++ )
675 : {
676 : /* code in Q9, gain_pit in Q14 */
677 5468928 : L_tmp = L_mult( gcode16, code[i] ); /* Q10 + Q_new */
678 5468928 : L_tmp = L_shl_sat( L_tmp, 5 ); /* Q15 + Q_new */
679 5468928 : L_tmp = L_mac_sat( L_tmp, exc_fx[i + i_subfr], gain_pit ); /* Q15 + Q_new */
680 5468928 : L_tmp = L_shl_sat( L_tmp, 1 ); /* saturation can occur here Q16 + Q_new */
681 5468928 : exc_fx[i + i_subfr] = round_fx_sat( L_tmp ); /* Q_new */
682 : }
683 :
684 : /*-----------------------------------------------------------------*
685 : * Add the ACELP pre-quantizer contribution
686 : *-----------------------------------------------------------------*/
687 :
688 85452 : IF( GE_32( st_fx->core_brate, MIN_BRATE_AVQ_EXC ) )
689 : {
690 10390 : tmp1_fx = add( 16 - ( 2 + Q_AVQ_OUT_DEC + 1 ), Q_new );
691 675350 : FOR( i = 0; i < L_SUBFR; i++ )
692 : {
693 664960 : L_tmp = L_mult( gain_preQ, code_preQ[i] ); /* Q2 + Q10 -> Q13*/
694 664960 : L_tmp = L_shl_sat( L_tmp, tmp1_fx ); /* Q16 + Q_exc */
695 664960 : tmp_fx = round_fx_sat( L_tmp );
696 :
697 664960 : exc2_fx[i + i_subfr] = add_sat( exc2_fx[i + i_subfr], tmp_fx ); /* Q_exc */
698 664960 : move16();
699 664960 : exc_fx[i + i_subfr] = add_sat( exc_fx[i + i_subfr], tmp_fx ); /* Q_exc */
700 664960 : move16();
701 : }
702 : }
703 :
704 : /*-----------------------------------------------------------------*
705 : * Prepare TBE excitation
706 : *-----------------------------------------------------------------*/
707 :
708 85452 : prep_tbe_exc_fx( L_frame_fx, L_SUBFR, i_subfr, gain_pit, gain_code, code, voice_fac, &voice_factors[i_subfr / L_SUBFR],
709 85452 : bwe_exc_fx, gain_preQ, code_preQ, Q10, Q_new, T0, T0_frac, st_fx->coder_type, st_fx->core_brate,
710 85452 : st_fx->element_mode, st_fx->idchan, st_fx->hBWE_TD != NULL, st_fx->tdm_LRTD_flag );
711 :
712 : /*-----------------------------------------------------------------*
713 : * Synthesize speech to update mem_syn[].
714 : * Update A(z) filters
715 : *-----------------------------------------------------------------*/
716 :
717 85452 : Syn_filt_s( 1, p_Aq, M, &exc_fx[i_subfr], &syn_fx[i_subfr], L_SUBFR, hLPDmem->mem_syn, 1 );
718 :
719 85452 : p_Aw += ( M + 1 );
720 85452 : p_Aq += ( M + 1 );
721 85452 : pt_pitch++;
722 : }
723 :
724 : /* write reserved bits */
725 19052 : WHILE( unbits_PI > 0 )
726 : {
727 0 : i = s_min( unbits_PI, 16 );
728 0 : push_indice( hBstr, IND_UNUSED, 0, i );
729 0 : unbits_PI -= i;
730 : }
731 :
732 : /* write TC configuration */
733 19052 : IF( EQ_16( L_frame_fx, L_FRAME ) )
734 : {
735 9808 : IF( EQ_16( tc_subfr, TC_0_0 ) )
736 : {
737 2617 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
738 : }
739 7191 : ELSE IF( EQ_16( tc_subfr, TC_0_64 ) )
740 : {
741 1477 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
742 1477 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
743 1477 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
744 1477 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
745 : }
746 5714 : ELSE IF( EQ_16( tc_subfr, TC_0_128 ) )
747 : {
748 810 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
749 810 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
750 810 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
751 810 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
752 : }
753 4904 : ELSE IF( EQ_16( tc_subfr, TC_0_192 ) )
754 : {
755 319 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
756 319 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
757 319 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
758 : }
759 4585 : ELSE IF( EQ_16( tc_subfr, L_SUBFR ) )
760 : {
761 1430 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
762 1430 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
763 1430 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
764 : }
765 3155 : ELSE IF( EQ_16( tc_subfr, 2 * L_SUBFR ) )
766 : {
767 742 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
768 742 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
769 742 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
770 742 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
771 : }
772 2413 : ELSE IF( EQ_16( tc_subfr, 3 * L_SUBFR ) )
773 : {
774 2413 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
775 2413 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
776 2413 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
777 2413 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
778 : }
779 : }
780 : ELSE /* L_frame == L_FRAME16k */
781 : {
782 9244 : IF( tc_subfr == 0 )
783 : {
784 3980 : push_indice( hBstr, IND_TC_SUBFR, 0, 2 );
785 : }
786 5264 : ELSE IF( EQ_16( tc_subfr, L_SUBFR ) )
787 : {
788 1164 : push_indice( hBstr, IND_TC_SUBFR, 1, 2 );
789 : }
790 4100 : ELSE IF( EQ_16( tc_subfr, 2 * L_SUBFR ) )
791 : {
792 1100 : push_indice( hBstr, IND_TC_SUBFR, 2, 2 );
793 : }
794 3000 : ELSE IF( EQ_16( tc_subfr, 3 * L_SUBFR ) )
795 : {
796 324 : push_indice( hBstr, IND_TC_SUBFR, 3, 2 );
797 324 : push_indice( hBstr, IND_TC_SUBFR, 0, 1 );
798 : }
799 2676 : ELSE IF( EQ_16( tc_subfr, 4 * L_SUBFR ) )
800 : {
801 2676 : push_indice( hBstr, IND_TC_SUBFR, 3, 2 );
802 2676 : push_indice( hBstr, IND_TC_SUBFR, 1, 1 );
803 : }
804 : }
805 :
806 19052 : IF( st_fx->Opt_SC_VBR )
807 : {
808 : /* SC-VBR */
809 0 : hSC_VBR->prev_ppp_gain_pit_fx = gain_pit; /* Q14 */
810 0 : move16();
811 0 : hSC_VBR->prev_tilt_code_fx = hLPDmem->tilt_code; /* Q15 */
812 0 : move16();
813 : }
814 :
815 19052 : return tc_subfr;
816 : }
|
