gsm-codec-lib: libgsmefr/vad.c annotate

author	Mychaela Falconia <falcon@freecalypso.org>
date	Tue, 29 Nov 2022 03:01:38 +0000
parents
children	756605c4850f

rev	line source
110 913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /***************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 * File Name: vad.c
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * Purpose: Contains all functions for voice activity detection, as
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * described in the high level specification of VAD.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 * Below is a listing of all the functions appearing in the file.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 * The functions are arranged according to their purpose. Under
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 * each heading, the ordering is hierarchical.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 * Resetting of static variables of VAD:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 * reset_vad()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15 * Main routine of VAD (called by the speech encoder):
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 * vad_computation()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 * Adaptive filtering and energy computation:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 * energy_computation()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 * Averaging of autocorrelation function values:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 * acf_averaging()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 * Computation of predictor values:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 * predictor_values()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 * schur_recursion()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 * step_up()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 * compute_rav1()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 * Spectral comparison:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 * spectral_comparison()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 * Information tone detection:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 * tone_detection()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 * step_up()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 * Threshold adaptation:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 * threshold_adaptation()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 * VAD decision:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 * vad_decision()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 * VAD hangover addition:
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 * vad_hangover()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 * Periodicity detection routine (called by the speech encoder):
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 * periodicity_detection()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 **************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 #include "typedef.h"
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44 #include "cnst.h"
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 #include "basic_op.h"
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46 #include "oper_32b.h"
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #include "count.h"
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include "vad.h"
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 /* Constants of VAD hangover addition */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #define HANGCONST 10
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #define BURSTCONST 3
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 /* Constant of spectral comparison */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 #define STAT_THRESH 3670L /* 0.056 */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59 /* Constants of periodicity detection */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 #define LTHRESH 2
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62 #define NTHRESH 4
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 /* Pseudo floating point representations of constants
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 for threshold adaptation */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 #define M_PTH 32500 /* 130000.0 */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 #define E_PTH 17
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 #define M_PLEV 21667 /* 346666.7 */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 #define E_PLEV 19
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 #define M_MARGIN 16927 /* 69333340 */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 #define E_MARGIN 27
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 #define FAC 17203 /* 2.1 */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 /* Constants of tone detection */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 #define FREQTH 3189
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 #define PREDTH 1464
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 /* Static variables of VAD */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 static Word16 rvad[9], scal_rvad;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 static Pfloat thvad;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 static Word32 L_sacf[27];
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 static Word32 L_sav0[36];
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 static Word16 pt_sacf, pt_sav0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 static Word32 L_lastdm;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 static Word16 adaptcount;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 static Word16 burstcount, hangcount;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 static Word16 oldlagcount, veryoldlagcount, oldlag;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 Word16 ptch;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95 /*************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 * FUNCTION NAME: vad_reset
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 * PURPOSE: Resets the static variables of the VAD to their
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 * initial values
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 *************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104 void vad_reset ()
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106 Word16 i;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 /* Initialize rvad variables */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 rvad[0] = 0x6000;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 for (i = 1; i < 9; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 rvad[i] = 0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114 scal_rvad = 7;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 /* Initialize threshold level */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 thvad.e = 20; /* exponent */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 thvad.m = 27083; /* mantissa */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 /* Initialize ACF averaging variables */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 for (i = 0; i < 27; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 L_sacf[i] = 0L;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 for (i = 0; i < 36; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 L_sav0[i] = 0L;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 pt_sacf = 0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 pt_sav0 = 0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 /* Initialize spectral comparison variable */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 L_lastdm = 0L;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 /* Initialize threshold adaptation variable */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 adaptcount = 0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 /* Initialize VAD hangover addition variables */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 burstcount = 0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 hangcount = -1;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 /* Initialize periodicity detection variables */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 oldlagcount = 0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 veryoldlagcount = 0;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 oldlag = 18;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 ptch = 1;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 /****************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 * FUNCTION: vad_computation
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156 * PURPOSE: Returns a decision as to whether the current frame being
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 * processed by the speech encoder contains speech or not.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 * INPUTS: r_h[0..8] autocorrelation of input signal frame (msb)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160 * r_l[0..8] autocorrelation of input signal frame (lsb)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 * scal_acf scaling factor for the autocorrelations
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162 * rc[0..3] speech encoder reflection coefficients
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 * ptch flag to indicate a periodic signal component
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 * OUTPUTS: none
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 * RETURN VALUE: vad decision
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 ***************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 Word16 vad_computation (
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 Word16 r_h[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 Word16 r_l[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 Word16 scal_acf,
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 Word16 rc[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 Word16 ptch
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 )
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 Word32 L_av0[9], L_av1[9];
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 Word16 vad, vvad, rav1[9], scal_rav1, stat, tone;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 Pfloat acf0, pvad;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 energy_computation (r_h, scal_acf, rvad, scal_rvad, &acf0, &pvad);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 acf_averaging (r_h, r_l, scal_acf, L_av0, L_av1);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 predictor_values (L_av1, rav1, &scal_rav1);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 stat = spectral_comparison (rav1, scal_rav1, L_av0); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 tone_detection (rc, &tone);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 threshold_adaptation (stat, ptch, tone, rav1, scal_rav1, pvad, acf0,
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 rvad, &scal_rvad, &thvad);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 vvad = vad_decision (pvad, thvad); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191 vad = vad_hangover (vvad); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 return vad;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 /****************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 * FUNCTION: energy_computation
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 * PURPOSE: Computes the input and residual energies of the adaptive
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 * filter in a floating point representation.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 * INPUTS: r_h[0..8] autocorrelation of input signal frame (msb)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204 * scal_acf scaling factor for the autocorrelations
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 * rvad[0..8] autocorrelated adaptive filter coefficients
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 * scal_rvad scaling factor for rvad[]
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 * OUTPUTS: *acf0 signal frame energy (mantissa+exponent)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 * *pvad filtered signal energy (mantissa+exponent)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 * RETURN VALUE: none
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 ***************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 void energy_computation (
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 Word16 r_h[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 Word16 scal_acf,
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 Word16 rvad[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 Word16 scal_rvad,
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 Pfloat * acf0,
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 Pfloat * pvad
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 )
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224 Word16 i, temp, norm_prod;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 Word32 L_temp;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 /* r[0] is always greater than zero (no need to test for r[0] == 0) */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 /* Computation of acf0 (exponent and mantissa) */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 acf0->e = sub (32, scal_acf); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 acf0->m = r_h[0] & 0x7ff8; move16 (); logic16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 /* Computation of pvad (exponent and mantissa) */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236 pvad->e = add (acf0->e, 14); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 pvad->e = sub (pvad->e, scal_rvad); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 L_temp = 0L; move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 for (i = 1; i <= 8; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243 temp = shr (r_h[i], 3);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 L_temp = L_mac (L_temp, temp, rvad[i]);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 temp = shr (r_h[0], 3);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 L_temp = L_add (L_temp, L_shr (L_mult (temp, rvad[0]), 1));
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 test ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 if (L_temp <= 0L)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 L_temp = 1L; move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255 norm_prod = norm_l (L_temp);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 pvad->e = sub (pvad->e, norm_prod); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 pvad->m = extract_h (L_shl (L_temp, norm_prod));
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 /****************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 * FUNCTION: acf_averaging
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267 * PURPOSE: Computes the arrays L_av0[0..8] and L_av1[0..8].
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 * INPUTS: r_h[0..8] autocorrelation of input signal frame (msb)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 * r_l[0..8] autocorrelation of input signal frame (lsb)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 * scal_acf scaling factor for the autocorrelations
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273 * OUTPUTS: L_av0[0..8] ACF averaged over last four frames
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274 * L_av1[0..8] ACF averaged over previous four frames
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276 * RETURN VALUE: none
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 ***************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 void acf_averaging (
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 Word16 r_h[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282 Word16 r_l[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 Word16 scal_acf,
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 Word32 L_av0[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285 Word32 L_av1[]
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286 )
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288 Word32 L_temp;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 Word16 scale;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 Word16 i;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292 scale = add (9, scal_acf);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 for (i = 0; i <= 8; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 L_temp = L_shr (L_Comp (r_h[i], r_l[i]), scale);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 L_av0[i] = L_add (L_sacf[i], L_temp); move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298 L_av0[i] = L_add (L_sacf[i + 9], L_av0[i]); move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 L_av0[i] = L_add (L_sacf[i + 18], L_av0[i]); move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 L_sacf[pt_sacf + i] = L_temp; move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 L_av1[i] = L_sav0[pt_sav0 + i]; move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 L_sav0[pt_sav0 + i] = L_av0[i]; move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 /* Update the array pointers */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 test ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 if (sub (pt_sacf, 18) == 0)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 pt_sacf = 0; move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 else
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 pt_sacf = add (pt_sacf, 9);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 test ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 if (sub (pt_sav0, 27) == 0)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 pt_sav0 = 0; move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 else
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 pt_sav0 = add (pt_sav0, 9);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 /****************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 * FUNCTION: predictor_values
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334 * PURPOSE: Computes the array rav[0..8] needed for the spectral
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 * comparison and the threshold adaptation.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 * INPUTS: L_av1[0..8] ACF averaged over previous four frames
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 * OUTPUTS: rav1[0..8] ACF obtained from L_av1
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340 * *scal_rav1 rav1[] scaling factor
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 * RETURN VALUE: none
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 ***************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 void predictor_values (
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 Word32 L_av1[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 Word16 rav1[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 Word16 *scal_rav1
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 )
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 Word16 vpar[8], aav1[9];
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 schur_recursion (L_av1, vpar);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 step_up (8, vpar, aav1);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356 compute_rav1 (aav1, rav1, scal_rav1);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361 /****************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 * FUNCTION: schur_recursion
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 * PURPOSE: Uses the Schur recursion to compute adaptive filter
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 * reflection coefficients from an autorrelation function.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 * INPUTS: L_av1[0..8] autocorrelation function
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 * OUTPUTS: vpar[0..7] reflection coefficients
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 * RETURN VALUE: none
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 ***************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 void schur_recursion (
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 Word32 L_av1[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 Word16 vpar[]
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 )
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381 Word16 acf[9], pp[9], kk[9], temp;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 Word16 i, k, m, n;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 /* Schur recursion with 16-bit arithmetic */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 test (); move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 if (L_av1[0] == 0)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 for (i = 0; i < 8; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391 vpar[i] = 0; move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 temp = norm_l (L_av1[0]);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 for (k = 0; k <= 8; k++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 acf[k] = extract_h (L_shl (L_av1[k], temp)); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 /* Initialize arrays pp[..] and kk[..] for the recursion: */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404 for (i = 1; i <= 7; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 kk[9 - i] = acf[i]; move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 for (i = 0; i <= 8; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 pp[i] = acf[i]; move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 /* Compute Parcor coefficients: */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416 for (n = 0; n < 8; n++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 test ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419 if ((pp[0] == 0) \|\|
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 (sub (pp[0], abs_s (pp[1])) < 0))
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 for (i = n; i < 8; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424 vpar[i] = 0; move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 vpar[n] = div_s (abs_s (pp[1]), pp[0]); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 test (); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 if (pp[1] > 0)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 vpar[n] = negate (vpar[n]); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435 test ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 if (sub (n, 7) == 0)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 /* Schur recursion: */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442 pp[0] = add (pp[0], mult_r (pp[1], vpar[n])); move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 for (m = 1; m <= 7 - n; m++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 pp[m] = add (pp[1 + m], mult_r (kk[9 - m], vpar[n]));
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 kk[9 - m] = add (kk[9 - m], mult_r (pp[1 + m], vpar[n]));
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 move16 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453 return;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 /****************************************************************************
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 * FUNCTION: step_up
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 * PURPOSE: Computes the transversal filter coefficients from the
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 * reflection coefficients.
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 * INPUTS: np filter order (2..8)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 * vpar[0..np-1] reflection coefficients
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 * OUTPUTS: aav1[0..np] transversal filter coefficients
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 * RETURN VALUE: none
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469 *
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470 ***************************************************************************/
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 void step_up (
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 Word16 np,
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 Word16 vpar[],
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 Word16 aav1[]
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 )
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 Word32 L_coef[9], L_work[9];
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 Word16 temp;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 Word16 i, m;
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 /* Initialization of the step-up recursion */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 L_coef[0] = 0x20000000L; move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 L_coef[1] = L_shl (L_deposit_l (vpar[0]), 14); move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 /* Loop on the LPC analysis order: */
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 for (m = 2; m <= np; m++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 for (i = 1; i < m; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 temp = extract_h (L_coef[m - i]);
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 L_work[i] = L_mac (L_coef[i], vpar[m - 1], temp); move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 }
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 for (i = 1; i < m; i++)
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 {
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 L_coef[i] = L_work[i]; move32 ();
913fe3c11890 libgsmefr/vad.c: initial import from ETSI code Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 }

110

913fe3c11890 libgsmefr/vad.c: initial import from ETSI code