efr-experiments: src/cod

annotate src/cod_12k2.c @ 8:8b17df8f6340 default tip

add README

author	Mychaela Falconia <falcon@freecalypso.org>
date	Wed, 17 Apr 2024 17:30:25 +0000
parents	6119d2c1e7d9
children

rev	line source
0 56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /***************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 * FILE NAME: cod_12k2.c
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * FUNCTIONS DEFINED IN THIS FILE:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * Coder_12k2 and Init_Coder_12k2
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 * Init_Coder_12k2(void):
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 * Initialization of variables for the coder section.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 * Coder_12k2(Word16 ana[], Word16 synth[]):
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 * Speech encoder routine operating on a frame basis.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 ***************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 #include "typedef.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 #include "basic_op.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 #include "sig_proc.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 #include "count.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 #include "codec.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 #include "cnst.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 #include "window2.tab"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 #include "vad.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 #include "dtx.h"
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 /-----------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 * Coder constant parameters (defined in "cnst.h") *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 -----------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 * L_WINDOW : LPC analysis window size *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 * L_FRAME : Frame size *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 * L_FRAME_BY2 : Half the frame size *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 * L_SUBFR : Sub-frame size *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 * M : LPC order *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 * MP1 : LPC order+1 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 * L_TOTAL : Total size of speech buffer *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 * PIT_MIN : Minimum pitch lag *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 * PIT_MAX : Maximum pitch lag *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 * L_INTERPOL : Length of filter for interpolation *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 -----------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 /--------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 * Static memory allocation. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 --------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 /* Speech vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 static Word16 old_speech[L_TOTAL];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 static Word16 speech, p_window, *p_window_mid;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 Word16 new_speech; / Global variable */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 /* Weight speech vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 static Word16 old_wsp[L_FRAME + PIT_MAX];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 static Word16 *wsp;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60 /* Excitation vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 static Word16 old_exc[L_FRAME + PIT_MAX + L_INTERPOL];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 static Word16 *exc;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 /* Zero vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 static Word16 ai_zero[L_SUBFR + MP1];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 static Word16 *zero;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 /* Impulse response vector */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 static Word16 *h1;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 static Word16 hvec[L_SUBFR * 2];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 /* Spectral expansion factors */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 static const Word16 F_gamma1[M] =
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 29491, 26542, 23888, 21499, 19349,
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 17414, 15672, 14105, 12694, 11425
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 };
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 static const Word16 F_gamma2[M] =
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 19661, 11797, 7078, 4247, 2548,
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 1529, 917, 550, 330, 198
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 };
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 /* Lsp (Line spectral pairs) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 static Word16 lsp_old[M];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 static Word16 lsp_old_q[M];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 /* Filter's memory */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 static Word16 mem_syn[M], mem_w0[M], mem_w[M];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 static Word16 mem_err[M + L_SUBFR], *error;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 /***************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 * FUNCTION: Init_Coder_12k2
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 * PURPOSE: Initialization of variables for the coder section.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 * DESCRIPTION:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 * - initilize pointers to speech buffer
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 * - initialize static pointers
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 * - set static vectors to zero
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 ***************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 void Init_Coder_12k2 (void)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 /--------------------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 * Initialize pointers to speech vector. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115 --------------------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 new_speech = old_speech + L_TOTAL - L_FRAME;/* New speech */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 speech = new_speech; /* Present frame */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 p_window = old_speech + L_TOTAL - L_WINDOW; /* For LPC window */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 p_window_mid = p_window; /* For LPC window */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121
6 6119d2c1e7d9 EFR2 encoder: mimic 5 ms delay of AMR Mychaela Falconia <falcon@freecalypso.org> parents: 0 diff changeset	122 #ifdef EFR2_VARIANT
6119d2c1e7d9 EFR2 encoder: mimic 5 ms delay of AMR Mychaela Falconia <falcon@freecalypso.org> parents: 0 diff changeset	123 /* 5 ms artificial delay like in AMR */
6119d2c1e7d9 EFR2 encoder: mimic 5 ms delay of AMR Mychaela Falconia <falcon@freecalypso.org> parents: 0 diff changeset	124 speech -= L_SUBFR;
6119d2c1e7d9 EFR2 encoder: mimic 5 ms delay of AMR Mychaela Falconia <falcon@freecalypso.org> parents: 0 diff changeset	125 p_window -= L_SUBFR;
6119d2c1e7d9 EFR2 encoder: mimic 5 ms delay of AMR Mychaela Falconia <falcon@freecalypso.org> parents: 0 diff changeset	126 p_window_mid -= L_SUBFR;
6119d2c1e7d9 EFR2 encoder: mimic 5 ms delay of AMR Mychaela Falconia <falcon@freecalypso.org> parents: 0 diff changeset	127 #endif
6119d2c1e7d9 EFR2 encoder: mimic 5 ms delay of AMR Mychaela Falconia <falcon@freecalypso.org> parents: 0 diff changeset	128
0 56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 /* Initialize static pointers */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 wsp = old_wsp + PIT_MAX;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 exc = old_exc + PIT_MAX + L_INTERPOL;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 zero = ai_zero + MP1;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 error = mem_err + M;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 h1 = &hvec[L_SUBFR];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 /* Static vectors to zero */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 Set_zero (old_speech, L_TOTAL);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 Set_zero (old_exc, PIT_MAX + L_INTERPOL);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 Set_zero (old_wsp, PIT_MAX);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 Set_zero (mem_syn, M);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 Set_zero (mem_w, M);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 Set_zero (mem_w0, M);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 Set_zero (mem_err, M);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 Set_zero (zero, L_SUBFR);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 Set_zero (hvec, L_SUBFR); /* set to zero "h1[-L_SUBFR..-1]" */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 /* Initialize lsp_old [] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 lsp_old[0] = 30000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 lsp_old[1] = 26000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 lsp_old[2] = 21000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 lsp_old[3] = 15000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 lsp_old[4] = 8000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 lsp_old[5] = 0;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 lsp_old[6] = -8000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 lsp_old[7] = -15000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 lsp_old[8] = -21000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 lsp_old[9] = -26000;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 /* Initialize lsp_old_q[] */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 Copy (lsp_old, lsp_old_q, M);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 return;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 /***************************************************************************
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 * FUNCTION: Coder_12k2
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 * PURPOSE: Principle encoder routine.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 * DESCRIPTION: This function is called every 20 ms speech frame,
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 * operating on the newly read 160 speech samples. It performs the
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 * principle encoding functions to produce the set of encoded parameters
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 * which include the LSP, adaptive codebook, and fixed codebook
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 * quantization indices (addresses and gains).
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 * INPUTS:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 * No input arguments are passed to this function. However, before
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 * calling this function, 160 new speech data samples should be copied to
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 * the vector new_speech[]. This is a global pointer which is declared in
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 * this file (it points to the end of speech buffer minus 160).
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 * OUTPUTS:
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 * ana[]: vector of analysis parameters.
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 * synth[]: Local synthesis speech (for debugging purposes)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 ***************************************************************************/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 void Coder_12k2 (
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 Word16 ana[], /* output : Analysis parameters */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 Word16 synth[] /* output : Local synthesis */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 )
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 /* LPC coefficients */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 Word16 r_l[MP1], r_h[MP1]; /* Autocorrelations lo and hi */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 Word16 A_t[(MP1) * 4]; /* A(z) unquantized for the 4 subframes */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 Word16 Aq_t[(MP1) * 4]; /* A(z) quantized for the 4 subframes */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 Word16 Ap1[MP1]; /* A(z) with spectral expansion */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 Word16 Ap2[MP1]; /* A(z) with spectral expansion */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 Word16 A, Aq; /* Pointer on A_t and Aq_t */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 Word16 lsp_new[M], lsp_new_q[M];/* LSPs at 4th subframe */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 Word16 lsp_mid[M], lsp_mid_q[M];/* LSPs at 2nd subframe */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 /* Other vectors */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 Word16 xn[L_SUBFR]; /* Target vector for pitch search */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 Word16 xn2[L_SUBFR]; /* Target vector for codebook search */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 Word16 res2[L_SUBFR]; /* Long term prediction residual */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 Word16 code[L_SUBFR]; /* Fixed codebook excitation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 Word16 y1[L_SUBFR]; /* Filtered adaptive excitation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 Word16 y2[L_SUBFR]; /* Filtered fixed codebook excitation */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 /* Scalars */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 Word16 i, j, k, i_subfr;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 Word16 T_op, T0, T0_min, T0_max, T0_frac;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 Word16 gain_pit, gain_code, pit_flag, pit_sharp;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 Word16 temp;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 Word32 L_temp;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226 Word16 scal_acf, VAD_flag, lags[2], rc[4];
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 extern Word16 ptch;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 extern Word16 txdtx_ctrl, CN_excitation_gain;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230 extern Word32 L_pn_seed_tx;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 extern Word16 dtx_mode;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 /----------------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 * - Perform LPC analysis: (twice per frame) *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 * * autocorrelation + lag windowing *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 * * Levinson-Durbin algorithm to find a[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 * * convert a[] to lsp[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 * * quantize and code the LSPs *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 * * find the interpolated LSPs and convert to a[] for all *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 * subframes (both quantized and unquantized) *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 ----------------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 /* LP analysis centered at 2nd subframe */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 scal_acf = Autocorr (p_window_mid, M, r_h, r_l, window_160_80);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 /* Autocorrelations */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 Lag_window (M, r_h, r_l); /* Lag windowing */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 Levinson (r_h, r_l, &A_t[MP1], rc); /* Levinson-Durbin */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 Az_lsp (&A_t[MP1], lsp_mid, lsp_old); /* From A(z) to lsp */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 /* LP analysis centered at 4th subframe */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 /* Autocorrelations */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 scal_acf = Autocorr (p_window, M, r_h, r_l, window_232_8);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 Lag_window (M, r_h, r_l); /* Lag windowing */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 Levinson (r_h, r_l, &A_t[MP1 * 3], rc); /* Levinson-Durbin */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 Az_lsp (&A_t[MP1 * 3], lsp_new, lsp_mid); /* From A(z) to lsp */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 if (dtx_mode == 1)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 /* DTX enabled, make voice activity decision */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 VAD_flag = vad_computation (r_h, r_l, scal_acf, rc, ptch);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 tx_dtx (VAD_flag, &txdtx_ctrl); /* TX DTX handler */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 /* DTX disabled, active speech in every frame */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 VAD_flag = 1;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 txdtx_ctrl = TX_VAD_FLAG \| TX_SP_FLAG;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 /* LSP quantization (lsp_mid[] and lsp_new[] jointly quantized) */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 Q_plsf_5 (lsp_mid, lsp_new, lsp_mid_q, lsp_new_q, ana, txdtx_ctrl);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 ana += 5; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 /--------------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 * Find interpolated LPC parameters in all subframes (both quantized *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 * and unquantized). *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 * The interpolated parameters are in array A_t[] of size (M+1)4
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 * and the quantized interpolated parameters are in array Aq_t[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 --------------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 Int_lpc2 (lsp_old, lsp_mid, lsp_new, A_t);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 if ((txdtx_ctrl & TX_SP_FLAG) != 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 Int_lpc (lsp_old_q, lsp_mid_q, lsp_new_q, Aq_t);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 /* update the LSPs for the next frame */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 for (i = 0; i < M; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 lsp_old[i] = lsp_new[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 lsp_old_q[i] = lsp_new_q[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 /* Use unquantized LPC parameters in case of no speech activity */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 for (i = 0; i < MP1; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 Aq_t[i] = A_t[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 Aq_t[i + MP1] = A_t[i + MP1]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 Aq_t[i + MP1 * 2] = A_t[i + MP1 * 2]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 Aq_t[i + MP1 * 3] = A_t[i + MP1 * 3]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 /* update the LSPs for the next frame */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 for (i = 0; i < M; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 lsp_old[i] = lsp_new[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 lsp_old_q[i] = lsp_new[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 /----------------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 * - Find the weighted input speech wsp[] for the whole speech frame *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 * - Find the open-loop pitch delay for first 2 subframes *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 * - Set the range for searching closed-loop pitch in 1st subframe *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 * - Find the open-loop pitch delay for last 2 subframes *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 ----------------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 A = A_t; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 for (i = 0; i < L_FRAME; i += L_SUBFR)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 Weight_Ai (A, F_gamma1, Ap1);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 Weight_Ai (A, F_gamma2, Ap2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 Residu (Ap1, &speech[i], &wsp[i], L_SUBFR);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 Syn_filt (Ap2, &wsp[i], &wsp[i], L_SUBFR, mem_w, 1);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 A += MP1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 /* Find open loop pitch lag for first two subframes */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 T_op = Pitch_ol (wsp, PIT_MIN, PIT_MAX, L_FRAME_BY2); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 lags[0] = T_op; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 if ((txdtx_ctrl & TX_SP_FLAG) != 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 /* Range for closed loop pitch search in 1st subframe */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 T0_min = sub (T_op, 3);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 if (sub (T0_min, PIT_MIN) < 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 T0_min = PIT_MIN; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 T0_max = add (T0_min, 6);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 if (sub (T0_max, PIT_MAX) > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 T0_max = PIT_MAX; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 T0_min = sub (T0_max, 6);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 /* Find open loop pitch lag for last two subframes */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 T_op = Pitch_ol (&wsp[L_FRAME_BY2], PIT_MIN, PIT_MAX, L_FRAME_BY2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 if (dtx_mode == 1)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 lags[1] = T_op; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 periodicity_update (lags, &ptch);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 /----------------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 * Loop for every subframe in the analysis frame *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 ----------------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 * To find the pitch and innovation parameters. The subframe size is *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 * L_SUBFR and the loop is repeated L_FRAME/L_SUBFR times. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 * - find the weighted LPC coefficients *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 * - find the LPC residual signal res[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 * - compute the target signal for pitch search *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 * - compute impulse response of weighted synthesis filter (h1[]) *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 * - find the closed-loop pitch parameters *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 * - encode the pitch delay *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 * - update the impulse response h1[] by including pitch *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 * - find target vector for codebook search *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 * - codebook search *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 * - encode codebook address *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 * - VQ of pitch and codebook gains *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 * - find synthesis speech *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 * - update states of weighting filter *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 ----------------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 /* pointer to interpolated LPC parameters */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 A = A_t; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 /* pointer to interpolated quantized LPC parameters */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 Aq = Aq_t; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 for (i_subfr = 0; i_subfr < L_FRAME; i_subfr += L_SUBFR)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 if ((txdtx_ctrl & TX_SP_FLAG) != 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 /---------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 * Find the weighted LPC coefficients for the weighting filter. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 ---------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 Weight_Ai (A, F_gamma1, Ap1);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 Weight_Ai (A, F_gamma2, Ap2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	501 /---------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	502 * Compute impulse response, h1[], of weighted synthesis filter *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	503 ---------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	504
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	505 for (i = 0; i <= M; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	506 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	507 ai_zero[i] = Ap1[i]; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	508 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	509
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	510 Syn_filt (Aq, ai_zero, h1, L_SUBFR, zero, 0);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	511
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	512 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	513 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	514 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	515
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	516 Syn_filt (Ap2, h1, h1, L_SUBFR, zero, 0);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	517
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	518 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	519 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	520 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	521
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	522 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	523 /---------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	524 * Find the target vector for pitch search: *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	525 ---------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	526
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	527 Residu (Aq, &speech[i_subfr], res2, L_SUBFR); /* LPC residual */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	528
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	529 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	530 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	531 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	532
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	533 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	534 if ((txdtx_ctrl & TX_SP_FLAG) == 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	535 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	536 /* Compute comfort noise excitation gain based on
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	537 LP residual energy */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	538
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	539 CN_excitation_gain = compute_CN_excitation_gain (res2);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	540 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	541 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	542 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	543 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	544 Copy (res2, &exc[i_subfr], L_SUBFR);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	545
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	546 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	547 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	548 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	549
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	550 Syn_filt (Aq, &exc[i_subfr], error, L_SUBFR, mem_err, 0);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	551
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	552 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	553 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	554 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	555
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	556 Residu (Ap1, error, xn, L_SUBFR);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	557
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	558 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	559 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	560 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	561
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	562 Syn_filt (Ap2, xn, xn, L_SUBFR, mem_w0, 0); /* target signal xn[]*/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	563
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	564 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	565 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	566 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	567
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	568 /--------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	569 * Closed-loop fractional pitch search *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	570 --------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	571
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	572 /* flag for first and 3th subframe */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	573 pit_flag = i_subfr; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	574 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	575 /* set t0_min and t0_max for 3th subf.*/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	576 if (sub (i_subfr, L_FRAME_BY2) == 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	577 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	578 T0_min = sub (T_op, 3);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	579
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	580 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	581 if (sub (T0_min, PIT_MIN) < 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	582 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	583 T0_min = PIT_MIN; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	584 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	585 T0_max = add (T0_min, 6);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	586 test ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	587 if (sub (T0_max, PIT_MAX) > 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	588 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	589 T0_max = PIT_MAX; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	590 T0_min = sub (T0_max, 6);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	591 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	592 pit_flag = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	593 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	594 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	595 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	596 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	597
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	598 T0 = Pitch_fr6 (&exc[i_subfr], xn, h1, L_SUBFR, T0_min, T0_max,
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	599 pit_flag, &T0_frac); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	600
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	601 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	602 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	603 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	604
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	605 *ana = Enc_lag6 (T0, &T0_frac, &T0_min, &T0_max, PIT_MIN,
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	606 PIT_MAX, pit_flag);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	607 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	608
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	609 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	610 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	611 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	612 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	613 ana++;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	614 /* Incrementation of ana is done here to work also
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	615 when no speech activity is present */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	616
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	617 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	618
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	619 if ((txdtx_ctrl & TX_SP_FLAG) != 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	620 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	621
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	622 /---------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	623 * - find unity gain pitch excitation (adaptive codebook entry) *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	624 * with fractional interpolation. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	625 * - find filtered pitch exc. y1[]=exc[] convolved with h1[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	626 * - compute pitch gain and limit between 0 and 1.2 *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	627 * - update target vector for codebook search *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	628 * - find LTP residual. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	629 ---------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	630
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	631 Pred_lt_6 (&exc[i_subfr], T0, T0_frac, L_SUBFR);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	632
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	633 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	634 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	635 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	636
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	637 Convolve (&exc[i_subfr], h1, y1, L_SUBFR);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	638
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	639 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	640 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	641 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	642
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	643 gain_pit = G_pitch (xn, y1, L_SUBFR); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	644
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	645 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	646 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	647 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	648
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	649 *ana = q_gain_pitch (&gain_pit); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	650
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	651 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	652 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	653 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	654
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	655 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	656 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	657 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	658 gain_pit = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	659 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	660
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	661 ana++; /* Incrementation of ana is done here to work
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	662 also when no speech activity is present */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	663
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	664 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	665
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	666 if ((txdtx_ctrl & TX_SP_FLAG) != 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	667 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	668 /* xn2[i] = xn[i] - y1[i] * gain_pit */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	669 /* res2[i] -= exc[i+i_subfr] * gain_pit */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	670
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	671 for (i = 0; i < L_SUBFR; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	672 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	673 L_temp = L_mult (y1[i], gain_pit);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	674 L_temp = L_shl (L_temp, 3);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	675 xn2[i] = sub (xn[i], extract_h (L_temp)); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	676
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	677 L_temp = L_mult (exc[i + i_subfr], gain_pit);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	678 L_temp = L_shl (L_temp, 3);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	679 res2[i] = sub (res2[i], extract_h (L_temp)); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	680 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	681
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	682 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	683 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	684 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	685
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	686 /-------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	687 * - include pitch contribution into impulse resp. h1[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	688 -------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	689
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	690 /* pit_sharp = gain_pit; */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	691 /* if (pit_sharp > 1.0) pit_sharp = 1.0; */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	692
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	693 pit_sharp = shl (gain_pit, 3);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	694
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	695 for (i = T0; i < L_SUBFR; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	696 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	697 temp = mult (h1[i - T0], pit_sharp);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	698 h1[i] = add (h1[i], temp); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	699 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	700
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	701 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	702 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	703 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	704
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	705 /--------------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	706 * - Innovative codebook search (find index and gain) *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	707 --------------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	708
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	709 code_10i40_35bits (xn2, res2, h1, code, y2, ana);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	710
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	711 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	712 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	713 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	714
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	715 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	716 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	717 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	718 build_CN_code (code, &L_pn_seed_tx);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	719 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	720 ana += 10; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	721
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	722 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	723 if ((txdtx_ctrl & TX_SP_FLAG) != 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	724 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	725
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	726 /-------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	727 * - Add the pitch contribution to code[]. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	728 -------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	729
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	730 for (i = T0; i < L_SUBFR; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	731 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	732 temp = mult (code[i - T0], pit_sharp);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	733 code[i] = add (code[i], temp); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	734 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	735
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	736 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	737 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	738 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	739
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	740 /------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	741 * - Quantization of fixed codebook gain. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	742 ------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	743
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	744 gain_code = G_code (xn2, y2); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	745
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	746 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	747 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	748 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	749
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	750 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	751 *ana++ = q_gain_code (code, L_SUBFR, &gain_code, txdtx_ctrl, i_subfr);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	752 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	753
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	754 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	755 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	756 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	757
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	758 /------------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	759 * - Find the total excitation *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	760 * - find synthesis speech corresponding to exc[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	761 * - update filter memories for finding the target *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	762 * vector in the next subframe *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	763 * (update mem_err[] and mem_w0[]) *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	764 ------------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	765
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	766 for (i = 0; i < L_SUBFR; i++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	767 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	768 /* exc[i] = gain_pitexc[i] + gain_codecode[i]; */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	769
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	770 L_temp = L_mult (exc[i + i_subfr], gain_pit);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	771 L_temp = L_mac (L_temp, code[i], gain_code);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	772 L_temp = L_shl (L_temp, 3);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	773 exc[i + i_subfr] = round (L_temp); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	774 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	775
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	776 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	777 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	778 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	779
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	780 Syn_filt (Aq, &exc[i_subfr], &synth[i_subfr], L_SUBFR, mem_syn, 1);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	781
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	782 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	783 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	784 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	785
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	786 test (); logic16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	787 if ((txdtx_ctrl & TX_SP_FLAG) != 0)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	788 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	789
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	790 for (i = L_SUBFR - M, j = 0; i < L_SUBFR; i++, j++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	791 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	792 mem_err[j] = sub (speech[i_subfr + i], synth[i_subfr + i]);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	793 move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	794 temp = extract_h (L_shl (L_mult (y1[i], gain_pit), 3));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	795 k = extract_h (L_shl (L_mult (y2[i], gain_code), 5));
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	796 mem_w0[j] = sub (xn[i], add (temp, k)); move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	797 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	798 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	799 else
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	800 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	801 for (j = 0; j < M; j++)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	802 {
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	803 mem_err[j] = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	804 mem_w0[j] = 0; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	805 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	806 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	807
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	808 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	809 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	810 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	811 /* interpolated LPC parameters for next subframe */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	812 A += MP1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	813 Aq += MP1; move16 ();
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	814 }
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	815
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	816 /--------------------------------------------------
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	817 * Update signal for next frame. *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	818 * -> shift to the left by L_FRAME: *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	819 * speech[], wsp[] and exc[] *
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	820 --------------------------------------------------/
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	821
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	822 Copy (&old_speech[L_FRAME], &old_speech[0], L_TOTAL - L_FRAME);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	823
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	824 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	825 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	826 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	827
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	828 Copy (&old_wsp[L_FRAME], &old_wsp[0], PIT_MAX);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	829
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	830 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	831 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	832 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	833
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	834 Copy (&old_exc[L_FRAME], &old_exc[0], PIT_MAX + L_INTERPOL);
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	835
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	836 #if (WMOPS)
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	837 fwc (); /* function worst case */
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	838 #endif
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	839
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	840 return;
56410792419a src: original EFR source from ETSI Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	841 }

FreeCalypso > hg > efr-experiments

annotate src/cod_12k2.c @ 8:8b17df8f6340 default tip