Line data Source code
1 : /*====================================================================================
2 : EVS Codec 3GPP TS26.452 Aug 12, 2021. Version 16.3.0
3 : ====================================================================================*/
4 : #include <stdint.h>
5 : #include "options.h" /* Compilation switches */
6 : #include "cnst.h" /* Common constants */
7 : //#include "prot_fx.h" /* Function prototypes */
8 : #include "rom_com.h" /* Common constants */
9 : #include "prot_fx.h" /* Function prototypes */
10 : #include "prot_fx_enc.h" /* Function prototypes */
11 : #include "basop_util.h" /* Function prototypes */
12 :
13 : /*Temporary location to be move in prot* when merge is done */
14 : void E_LPC_f_lsp_a_conversion( const Word16 *lsp, Word16 *a, const Word16 m );
15 :
16 : /*=======================================================================================*/
17 : /* FUNCTION : encod_ppp_fx() */
18 : /*---------------------------------------------------------------------------------------*/
19 : /* PURPOSE : */
20 : /*---------------------------------------------------------------------------------------*/
21 : /* INPUT ARGUMENTS : */
22 : /* _ (Word16) speech_fx[], i : input speech Q_new */
23 : /* _ (Word16) Aq_fx[], i : 12k8 Lp coefficient Q12 */
24 : /* _ (Word16) A_fx[], i : unquantized A(z) filter with bandwidth expansion Q12*/
25 : /* _ (Word16) coder_type, i : coding type */
26 : /* _ (Word16) T_op_fx[], i : open loop pitch */
27 : /* _ (Word16) voicing_fx[], i : voicing Q15 */
28 : /* _ (Word16) *res_fx, i : residual signal Q_new */
29 : /* _ (Word16) Q_new i : Q factor for res */
30 : /* _ (Word16) vadsnr_fx i : SNR for current frame Q7 */
31 : /*---------------------------------------------------------------------------------------*/
32 : /* OUTPUT ARGUMENTS : */
33 : /* _ (Word16) *exc2_fx, o : current enhanced excitation Q0 */
34 : /* _ (Word16) *pitch_buf_fx, o : floating pitch values for each subframe Q6 */
35 : /* _ (Word16) *synth_fx, o : core synthesis Q-1 */
36 : /* _ Encoder_State *st_fx: */
37 : /* _ lastLgainE_fx - Q11 */
38 : /* _ lastHgainE_fx - Q11 */
39 : /* _ lasterbE_fx - Q13 */
40 : /*---------------------------------------------------------------------------------------*/
41 : /* INPUT/OUTPUT ARGUMENTS : */
42 : /* _ Encoder_State *st_fx: */
43 : /* _ st_fx->dtfs_enc_xxxx */
44 : /* _ a nd b in st_fx->dtfs_enc_Q */
45 : /* rest all in Q0 */
46 : /* - bump_up_fx - Q0 */
47 : /* _ (Word16) *exc_fx, o : current enhanced excitation Q0 */
48 : /*---------------------------------------------------------------------------------------*/
49 : /* RETURN ARGUMENTS : */
50 : /* _ None. */
51 : /*---------------------------------------------------------------------------------------*/
52 : /* CALLED FROM : TX */
53 : /*=======================================================================================*/
54 0 : ivas_error encod_ppp_fx(
55 : Encoder_State *st_fx, /* i/o: state structure */
56 : const Word16 speech_fx[], /* i : input speech Q_new*/
57 : const Word16 Aw_fx[], /* i : weighted A(z) unquantized for subframes Q12*/
58 : const Word16 Aq_fx[], /* i : 12k8 Lp coefficient Q14*/
59 : Word16 *res_fx, /* i : residual signal Q_new*/
60 : Word16 *synth_fx, /* o : core synthesis Q-1*/
61 : Word16 *exc_fx, /* i/o: current non-enhanced excitation Q_new*/
62 : Word16 *exc2_fx, /* o : current enhanced excitation Q0*/
63 : Word16 *pitch_buf_fx, /* o : floating pitch values for each subframe Q6*/
64 : Word16 *voice_factors, /* o : voicing factors Q15*/
65 : Word16 *bwe_exc, /* o : excitation for SWB TBE Q_new*/
66 : Word16 Q_new,
67 : Word16 shift )
68 : {
69 : Word16 xn_fx[L_SUBFR]; /* Target vector for pitch search */
70 : Word16 h1_fx[L_SUBFR + ( M + 1 )]; /* Impulse response vector */
71 : Word16 i_subfr; /* tmp variables */
72 : const Word16 *p_Aw_fx, *p_Aq_fx; /* pointer to LP filter coeff. vector*/
73 :
74 : Word16 k;
75 : Word16 p_Aq_old_fx[M + 1], excQ_ppp_fx[L_FRAME], p_Aq_curr_fx[M], pitch_fx[NB_SUBFR];
76 : Word16 LPC_de_old_fx[M + 1], LPC_de_curr_fx[M + 1];
77 0 : Word16 shift_wsp = add( Q_new, shift );
78 : Word16 rate_ctrl_fx;
79 0 : Word16 saved_Q_new = Q_new;
80 0 : move16();
81 0 : LPD_state_HANDLE hLPDmem = st_fx->hLPDmem;
82 0 : SC_VBR_ENC_HANDLE hSC_VBR = st_fx->hSC_VBR;
83 0 : BSTR_ENC_HANDLE hBstr = st_fx->hBstr;
84 : ivas_error error;
85 :
86 0 : error = IVAS_ERR_OK;
87 0 : move16();
88 0 : rate_ctrl_fx = hSC_VBR->rate_control;
89 0 : move16();
90 :
91 : /*------------------------------------------------------------------*
92 : * ACELP subframe loop
93 : *------------------------------------------------------------------*/
94 0 : p_Aw_fx = Aw_fx;
95 0 : p_Aq_fx = Aq_fx;
96 0 : FOR( i_subfr = 0; i_subfr < L_FRAME; i_subfr += L_SUBFR )
97 : {
98 : /*----------------------------------------------------------------*
99 : * Bandwidth expansion of A(z) filter coefficients
100 : * Find the the excitation search target "xn" and innovation
101 : * target in residual domain "cn"
102 : * Compute impulse response, h1[], of weighted synthesis filter
103 : *----------------------------------------------------------------*/
104 :
105 0 : Copy( &res_fx[i_subfr], &exc_fx[i_subfr], L_SUBFR ); /* Q_new */
106 :
107 0 : find_targets_fx( speech_fx, hLPDmem->mem_syn, i_subfr, &hLPDmem->mem_w0, p_Aq_fx,
108 : res_fx, L_SUBFR, p_Aw_fx, TILT_FAC_FX, xn_fx, NULL, h1_fx );
109 :
110 : /* scale xn[] and h1[] to avoid overflow in dot_product12() */
111 0 : Scale_sig( xn_fx, L_SUBFR, shift ); /* scaling of xn[] to limit dynamic at 12 bits */
112 :
113 : /* call voiced encoder at this point */
114 0 : IF( i_subfr == 0 ) /* generate the L_FRAME exc */
115 : {
116 0 : FOR( k = 0; k < M; k++ )
117 : {
118 0 : p_Aq_curr_fx[k] = p_Aq_fx[k + ( 3 * ( M + 1 ) ) + 1];
119 0 : move16();
120 : }
121 :
122 0 : E_LPC_f_lsp_a_conversion( st_fx->lsp_old_fx, p_Aq_old_fx, M );
123 0 : deemph_lpc_fx( p_Aq_curr_fx, p_Aq_old_fx, LPC_de_curr_fx, LPC_de_old_fx, 1 );
124 : /* both outputs LPC_de_curr_fx and LPC_de_old_fx are in Q12 */
125 :
126 :
127 : /* last frame-end lpc and curr frame-end lpc */
128 0 : IF( ( error = ppp_voiced_encoder_fx( hBstr, hSC_VBR, st_fx->bwidth, st_fx->last_coder_type_raw, st_fx->old_pitch_buf_fx, res_fx,
129 : excQ_ppp_fx, st_fx->pitch[1], LPC_de_old_fx, LPC_de_curr_fx, exc_fx, pitch_fx, Q_new ) ) != IVAS_ERR_OK )
130 : {
131 0 : return error;
132 : }
133 :
134 0 : Scale_sig( exc_fx, L_FRAME, ( saved_Q_new - Q_new ) ); /* saved_Q_new */
135 0 : if ( EQ_16( hSC_VBR->bump_up, 1 ) )
136 : {
137 0 : i_subfr = L_FRAME;
138 0 : move16();
139 : }
140 : }
141 :
142 0 : IF( NE_16( hSC_VBR->bump_up, 1 ) )
143 : {
144 : /*-----------------------------------------------------------------*
145 : * Gain clipping test to avoid unstable synthesis on frame erasure
146 : * or in case of floating point encoder & fixed p. decoder
147 : *-----------------------------------------------------------------*/
148 0 : gp_clip_fx( st_fx->element_mode, st_fx->core_brate, st_fx->voicing_fx, i_subfr, st_fx->coder_type, xn_fx, st_fx->clip_var_fx, sub( shift_wsp, 1 ) );
149 :
150 :
151 : /* run the above to maintain gain clipping memories */
152 0 : gp_clip_test_gain_pit_fx( st_fx->element_mode, st_fx->core_brate, hSC_VBR->prev_ppp_gain_pit_fx, st_fx->clip_var_fx );
153 :
154 :
155 : /*-----------------------------------------------------------------*
156 : * Synthesize speech to update mem_syn[].
157 : * Update A(z) filters
158 : *-----------------------------------------------------------------*/
159 :
160 0 : Syn_filt_s( 1, p_Aq_fx, M, &excQ_ppp_fx[i_subfr], &synth_fx[i_subfr], L_SUBFR, hLPDmem->mem_syn, 1 );
161 :
162 :
163 0 : p_Aw_fx += ( M + 1 );
164 0 : p_Aq_fx += ( M + 1 );
165 : }
166 :
167 : } /* end of subframe loop */
168 :
169 0 : IF( hSC_VBR->bump_up )
170 : {
171 : /* PPP failed, bump up */
172 0 : hSC_VBR->ppp_mode = 0;
173 0 : move16();
174 0 : st_fx->core_brate = ACELP_7k20;
175 0 : move16();
176 0 : hSC_VBR->pppcountE = 0;
177 0 : move16();
178 :
179 0 : IF( hSC_VBR->set_ppp_generic )
180 : {
181 0 : st_fx->coder_type = GENERIC;
182 0 : move16();
183 : }
184 : ELSE
185 : {
186 0 : st_fx->coder_type = VOICED;
187 0 : move16();
188 : }
189 :
190 : /* We write signalling indices again only in case of bump_up */
191 : /* delete previous indices */
192 0 : reset_indices_enc_fx( hBstr, hBstr->nb_ind_tot );
193 : /* signalling matrix (writing of signalling bits) */
194 0 : signalling_enc_fx( st_fx );
195 : }
196 : ELSE
197 : {
198 0 : Copy( excQ_ppp_fx, exc_fx, L_FRAME ); /* Q_new */
199 :
200 : /*-----------------------------------------------------------------*
201 : * Updates: last value of new target is stored in mem_w0
202 : *-----------------------------------------------------------------*/
203 :
204 0 : hLPDmem->mem_w0 = sub( shr( xn_fx[L_SUBFR - 1], shift ), shr( exc_fx[L_FRAME - 1], 1 ) ); /*Q_new-1 */
205 0 : move16();
206 :
207 0 : Copy( exc_fx, exc2_fx, L_FRAME ); /* Q_new */
208 :
209 0 : hLPDmem->dm_fx.prev_state = 2;
210 0 : move16(); /*Q0 dispMem index 0 */
211 0 : hLPDmem->dm_fx.prev_gain_pit[0] = hSC_VBR->prev_ppp_gain_pit_fx; /* Q14 */
212 0 : move16(); /*Q14 dispMem index 2 */
213 :
214 0 : FOR( k = 1; k < 5; k++ )
215 : {
216 0 : hLPDmem->dm_fx.prev_gain_pit[k] = hLPDmem->dm_fx.prev_gain_pit[k - 1]; /* Q14 */
217 0 : move16();
218 : }
219 :
220 0 : hLPDmem->tilt_code = hSC_VBR->prev_tilt_code_fx; /* Q15 */
221 0 : move16();
222 0 : Copy( pitch_fx, pitch_buf_fx, NB_SUBFR ); /* Q6 */
223 0 : pitch_buf_fx[NB_SUBFR16k - 1] = pitch_fx[NB_SUBFR - 1]; /* Q6 */
224 :
225 0 : interp_code_5over2_fx( exc2_fx, bwe_exc, L_FRAME );
226 0 : set16_fx( voice_factors, 0, NB_SUBFR16k );
227 : }
228 :
229 0 : hSC_VBR->rate_control = rate_ctrl_fx; /* Q0 */
230 0 : move16();
231 :
232 0 : set16_fx( hSC_VBR->nelp_lp_fit_mem, 0, NELP_LP_ORDER * 2 );
233 :
234 0 : return error;
235 : }
236 :
237 0 : ivas_error encod_ppp_ivas_fx(
238 : Encoder_State *st_fx, /* i/o: state structure */
239 : const Word16 speech_fx[], /* i : input speech Q_new*/
240 : const Word16 Aw_fx[], /* i : weighted A(z) unquantized for subframes Q12*/
241 : const Word16 Aq_fx[], /* i : 12k8 Lp coefficient Q12*/
242 : Word16 *res_fx, /* i : residual signal Q_new*/
243 : Word16 *synth_fx, /* o : core synthesis Q-1*/
244 : Word16 *exc_fx, /* i/o: current non-enhanced excitation Q_new*/
245 : Word16 *exc2_fx, /* o : current enhanced excitation Q0*/
246 : Word16 *pitch_buf_fx, /* o : floating pitch values for each subframe Q6*/
247 : Word16 *voice_factors, /* o : voicing factors Q15*/
248 : Word16 *bwe_exc, /* o : excitation for SWB TBE Q_new*/
249 : Word16 Q_new,
250 : Word16 shift )
251 : {
252 : Word16 xn_fx[L_SUBFR]; /* Target vector for pitch search */
253 : Word16 h1_fx[L_SUBFR + ( M + 1 )]; /* Impulse response vector */
254 : Word16 i_subfr; /* tmp variables */
255 : const Word16 *p_Aw_fx, *p_Aq_fx; /* pointer to LP filter coeff. vector*/
256 :
257 : Word16 k;
258 : Word16 p_Aq_old_fx[M + 1], excQ_ppp_fx[L_FRAME], p_Aq_curr_fx[M], pitch_fx[NB_SUBFR];
259 : Word16 LPC_de_old_fx[M + 1], LPC_de_curr_fx[M + 1];
260 0 : Word16 shift_wsp = add( Q_new, shift );
261 : Word16 rate_ctrl_fx;
262 0 : Word16 saved_Q_new = Q_new;
263 0 : move16();
264 0 : LPD_state_HANDLE hLPDmem = st_fx->hLPDmem;
265 0 : SC_VBR_ENC_HANDLE hSC_VBR = st_fx->hSC_VBR;
266 0 : BSTR_ENC_HANDLE hBstr = st_fx->hBstr;
267 : ivas_error error;
268 :
269 0 : error = IVAS_ERR_OK;
270 0 : move16();
271 0 : rate_ctrl_fx = hSC_VBR->rate_control;
272 0 : move16();
273 :
274 : /*------------------------------------------------------------------*
275 : * ACELP subframe loop
276 : *------------------------------------------------------------------*/
277 0 : p_Aw_fx = Aw_fx;
278 0 : p_Aq_fx = Aq_fx;
279 0 : FOR( i_subfr = 0; i_subfr < L_FRAME; i_subfr += L_SUBFR )
280 : {
281 : /*----------------------------------------------------------------*
282 : * Bandwidth expansion of A(z) filter coefficients
283 : * Find the the excitation search target "xn" and innovation
284 : * target in residual domain "cn"
285 : * Compute impulse response, h1[], of weighted synthesis filter
286 : *----------------------------------------------------------------*/
287 :
288 0 : Copy( &res_fx[i_subfr], &exc_fx[i_subfr], L_SUBFR ); /* Q_new */
289 :
290 0 : find_targets_ivas_fx( speech_fx, hLPDmem->mem_syn, i_subfr, &hLPDmem->mem_w0, p_Aq_fx,
291 : res_fx, L_SUBFR, p_Aw_fx, TILT_FAC_FX, xn_fx, NULL, h1_fx );
292 :
293 : /* scale xn[] and h1[] to avoid overflow in dot_product12() */
294 0 : Scale_sig( xn_fx, L_SUBFR, shift ); /* scaling of xn[] to limit dynamic at 12 bits */
295 :
296 : /* call voiced encoder at this point */
297 0 : IF( i_subfr == 0 ) /* generate the L_FRAME exc */
298 : {
299 0 : FOR( k = 0; k < M; k++ )
300 : {
301 0 : p_Aq_curr_fx[k] = p_Aq_fx[k + ( 3 * ( M + 1 ) ) + 1]; /* Q12 */
302 0 : move16();
303 : }
304 :
305 0 : E_LPC_f_lsp_a_conversion( st_fx->lsp_old_fx, p_Aq_old_fx, M );
306 0 : deemph_lpc_fx( p_Aq_curr_fx, p_Aq_old_fx, LPC_de_curr_fx, LPC_de_old_fx, 1 );
307 : /* both outputs LPC_de_curr_fx and LPC_de_old_fx are in Q12 */
308 :
309 :
310 : /* last frame-end lpc and curr frame-end lpc */
311 0 : IF( ( error = ppp_voiced_encoder_fx( hBstr, hSC_VBR, st_fx->bwidth, st_fx->last_coder_type_raw, st_fx->old_pitch_buf_fx, res_fx,
312 : excQ_ppp_fx, st_fx->pitch[1], LPC_de_old_fx, LPC_de_curr_fx, exc_fx, pitch_fx, Q_new ) ) != IVAS_ERR_OK )
313 : {
314 0 : return error;
315 : }
316 :
317 0 : Scale_sig( exc_fx, L_FRAME, sub( saved_Q_new, Q_new ) ); /* saved_Q_new */
318 0 : if ( EQ_16( hSC_VBR->bump_up, 1 ) )
319 : {
320 0 : i_subfr = L_FRAME;
321 0 : move16();
322 : }
323 : }
324 :
325 0 : IF( NE_16( hSC_VBR->bump_up, 1 ) )
326 : {
327 : /*-----------------------------------------------------------------*
328 : * Gain clipping test to avoid unstable synthesis on frame erasure
329 : * or in case of floating point encoder & fixed p. decoder
330 : *-----------------------------------------------------------------*/
331 0 : gp_clip_fx( st_fx->element_mode, st_fx->core_brate, st_fx->voicing_fx, i_subfr, st_fx->coder_type, xn_fx, st_fx->clip_var_fx, sub( shift_wsp, 1 ) );
332 :
333 :
334 : /* run the above to maintain gain clipping memories */
335 0 : gp_clip_test_gain_pit_fx( st_fx->element_mode, st_fx->core_brate, hSC_VBR->prev_ppp_gain_pit_fx, st_fx->clip_var_fx );
336 :
337 :
338 : /*-----------------------------------------------------------------*
339 : * Synthesize speech to update mem_syn[].
340 : * Update A(z) filters
341 : *-----------------------------------------------------------------*/
342 :
343 0 : Syn_filt_s( 1, p_Aq_fx, M, &excQ_ppp_fx[i_subfr], &synth_fx[i_subfr], L_SUBFR, hLPDmem->mem_syn, 1 );
344 :
345 :
346 0 : p_Aw_fx += ( M + 1 );
347 0 : p_Aq_fx += ( M + 1 );
348 : }
349 :
350 : } /* end of subframe loop */
351 :
352 0 : IF( hSC_VBR->bump_up )
353 : {
354 : /* PPP failed, bump up */
355 0 : hSC_VBR->ppp_mode = 0;
356 0 : move16();
357 0 : st_fx->core_brate = ACELP_7k20;
358 0 : move16();
359 0 : hSC_VBR->pppcountE = 0;
360 0 : move16();
361 :
362 0 : IF( hSC_VBR->set_ppp_generic )
363 : {
364 0 : st_fx->coder_type = GENERIC;
365 0 : move16();
366 : }
367 : ELSE
368 : {
369 0 : st_fx->coder_type = VOICED;
370 0 : move16();
371 : }
372 :
373 : /* We write signalling indices again only in case of bump_up */
374 : /* delete previous indices */
375 0 : reset_indices_enc_fx( hBstr, hBstr->nb_ind_tot );
376 : /* signalling matrix (writing of signalling bits) */
377 0 : signalling_enc_fx( st_fx );
378 : }
379 : ELSE
380 : {
381 0 : Copy( excQ_ppp_fx, exc_fx, L_FRAME ); /* Q_new */
382 :
383 : /*-----------------------------------------------------------------*
384 : * Updates: last value of new target is stored in mem_w0
385 : *-----------------------------------------------------------------*/
386 :
387 0 : hLPDmem->mem_w0 = sub( shr( xn_fx[L_SUBFR - 1], shift ), shr( exc_fx[L_FRAME - 1], 1 ) ); /*Q_new-1 */
388 :
389 0 : Copy( exc_fx, exc2_fx, L_FRAME ); /* Q_new */
390 :
391 0 : hLPDmem->dm_fx.prev_state = 2;
392 0 : move16(); /*Q0 dispMem index 0 */
393 0 : hLPDmem->dm_fx.prev_gain_pit[0] = hSC_VBR->prev_ppp_gain_pit_fx;
394 0 : move16(); /*Q14 dispMem index 2 */
395 :
396 0 : FOR( k = 1; k < 5; k++ )
397 : {
398 0 : hLPDmem->dm_fx.prev_gain_pit[k] = hLPDmem->dm_fx.prev_gain_pit[k - 1]; /* Q14 */
399 0 : move16();
400 : }
401 :
402 0 : hLPDmem->tilt_code = hSC_VBR->prev_tilt_code_fx; /* Q15 */
403 0 : move16();
404 0 : Copy( pitch_fx, pitch_buf_fx, NB_SUBFR );
405 0 : pitch_buf_fx[NB_SUBFR16k - 1] = pitch_fx[NB_SUBFR - 1];
406 :
407 0 : interp_code_5over2_fx( exc2_fx, bwe_exc, L_FRAME );
408 0 : set16_fx( voice_factors, 0, NB_SUBFR16k );
409 : }
410 :
411 0 : hSC_VBR->rate_control = rate_ctrl_fx; /* Q0 */
412 0 : move16();
413 :
414 0 : set16_fx( hSC_VBR->nelp_lp_fit_mem, 0, NELP_LP_ORDER * 2 );
415 :
416 0 : return error;
417 : }
|
