gsm-codec-lib: libtwamr/vad2.c annotate

author	Mychaela Falconia <falcon@freecalypso.org>
date	Tue, 07 May 2024 01:14:14 +0000
parents
children

rev	line source
410 0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	1 /*
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	2 *****************************************************************************
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	3 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	4 * GSM AMR-NB speech codec R98 Version 7.6.0 December 12, 2001
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	5 * R99 Version 3.3.0
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	6 * REL-4 Version 4.1.0
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	7 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	8 *****************************************************************************
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	9 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	10 * File : vad2.c
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	11 * Purpose : Voice Activity Detection (VAD) for AMR (option 2)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	12 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	13 *****************************************************************************
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	14 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	15
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	16 /***************************************************************************
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	17 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	18 * FUNCTION NAME: vad2()
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	19 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	20 * PURPOSE:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	21 * This function provides the Voice Activity Detection function option 2
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	22 * for the Adaptive Multi-rate (AMR) codec.
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	23 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	24 * INPUTS:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	25 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	26 * farray_ptr
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	27 * pointer to Word16[80] input array
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	28 * vadState2
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	29 * pointer to vadState2 state structure
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	30 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	31 * OUTPUTS:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	32 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	33 * state variables are updated
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	34 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	35 * RETURN VALUE:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	36 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	37 * Word16
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	38 * VAD(m) - two successive calls to vad2() yield
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	39 * the VAD decision for the 20 ms frame:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	40 * VAD_flag = VAD(m-1) \|\| VAD(m)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	41 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	42 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	43 *************************************************************************/
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	44
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	45 /* Includes */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	46
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	47 #include <stdint.h>
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	48 #include <string.h>
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	49 #include "tw_amr.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	50 #include "namespace.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	51 #include "typedef.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	52 #include "cnst.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	53 #include "basic_op.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	54 #include "oper_32b.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	55 #include "no_count.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	56 #include "log2.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	57 #include "pow2.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	58 #include "vad2.h"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	59
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	60
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	61 /* Local functions */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	62
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	63 /***************************************************************************
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	64 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	65 * FUNCTION NAME: fn10Log10
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	66 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	67 * PURPOSE:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	68 * The purpose of this function is to take the 10*log base 10 of input and
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	69 * divide by 128 and return; i.e. output = 10*log10(input)/128 (scaled as 7,8)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	70 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	71 * INPUTS:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	72 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	73 * L_Input
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	74 * input (scaled as 31-fbits,fbits)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	75 * fbits
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	76 * number of fractional bits on input
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	77 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	78 * OUTPUTS:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	79 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	80 * none
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	81 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	82 * RETURN VALUE:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	83 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	84 * Word16
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	85 * output (scaled as 7,8)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	86 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	87 * DESCRIPTION:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	88 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	89 * 10log10(x)/128 = 10(log10(2) * (log2(x<<fbits)-log2(1<<fbits)) >> 7
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	90 * = 3.0103 * (log2(x<<fbits) - fbits) >> 7
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	91 * = ((3.0103/4.0 * (log2(x<<fbits) - fbits) << 2) >> 7
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	92 * = (3.0103/4.0 * (log2(x<<fbits) - fbits) >> 5
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	93 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	94 *************************************************************************/
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	95
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	96 static Word16 fn10Log10 (Word32 L_Input, Word16 fbits)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	97 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	98
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	99 Word16 integer; /* Integer part of Log2. (range: 0<=val<=30) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	100 Word16 fraction; /* Fractional part of Log2. (range: 0<=val<1) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	101
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	102 Word32 Ltmp;
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	103 Word16 tmp;
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	104
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	105 Log2(L_Input, &integer, &fraction);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	106
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	107 integer = sub(integer, fbits);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	108 Ltmp = Mpy_32_16 (integer, fraction, 24660); /* 24660 = 10log10(2)/4 scaled 0,15 /
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	109 Ltmp = L_shr_r(Ltmp, 5+1); /* extra shift for 30,1 => 15,0 extract correction */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	110 tmp = extract_l(Ltmp);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	111
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	112 return (tmp);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	113 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	114
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	115
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	116 /***************************************************************************
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	117 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	118 * FUNCTION NAME: block_norm
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	119 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	120 * PURPOSE:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	121 * The purpose of this function is block normalise the input data sequence
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	122 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	123 * INPUTS:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	124 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	125 * &in[0]
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	126 * pointer to data sequence to be normalised
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	127 * length
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	128 * number of elements in data sequence
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	129 * headroom
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	130 * number of headroom bits (i.e.,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	131 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	132 * OUTPUTS:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	133 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	134 * &out[0]
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	135 * normalised output data sequence pointed to by &out[0]
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	136 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	137 * RETURN VALUE:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	138 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	139 * Word16
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	140 * number of bits sequence was left shifted
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	141 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	142 * DESCRIPTION:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	143 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	144 * 1) Search for maximum absolute valued data element
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	145 * 2) Normalise the max element with "headroom"
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	146 * 3) Transfer/shift the input sequence to the output buffer
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	147 * 4) Return the number of left shifts
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	148 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	149 * CAVEATS:
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	150 * An input sequence of all zeros will return the maximum
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	151 * number of left shifts allowed, NOT the value returned
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	152 * by a norm_s(0) call, since it desired to associate an
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	153 * all zeros sequence with low energy.
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	154 *
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	155 *************************************************************************/
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	156
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	157 static
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	158 Word16 block_norm (Word16 * in, Word16 * out, Word16 length, Word16 headroom)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	159 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	160
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	161 Word16 i, max, scnt, adata;
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	162
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	163 max = abs_s(in[0]);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	164 for (i = 1; i < length; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	165 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	166 adata = abs_s(in[i]); test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	167 if (sub(adata, max) > 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	168 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	169 max = adata; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	170 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	171 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	172 test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	173 if (max != 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	174 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	175 scnt = sub(norm_s(max), headroom);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	176 for (i = 0; i < length; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	177 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	178 out[i] = shl(in[i], scnt); move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	179 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	180 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	181 else
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	182 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	183 scnt = sub(16, headroom);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	184 for (i = 0; i < length; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	185 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	186 out[i] = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	187 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	188 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	189 return (scnt);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	190 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	191
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	192
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	193 /******************************************* The VAD function *************************************************/
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	194
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	195 Word16 vad2 (Word16 * farray_ptr, vadState2 * st)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	196 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	197
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	198 /*
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	199 * The channel table is defined below. In this table, the
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	200 * lower and higher frequency coefficients for each of the 16
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	201 * channels are specified. The table excludes the coefficients
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	202 * with numbers 0 (DC), 1, and 64 (Foldover frequency).
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	203 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	204
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	205 static const Word16 ch_tbl[NUM_CHAN][2] =
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	206 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	207
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	208 {2, 3},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	209 {4, 5},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	210 {6, 7},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	211 {8, 9},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	212 {10, 11},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	213 {12, 13},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	214 {14, 16},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	215 {17, 19},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	216 {20, 22},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	217 {23, 26},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	218 {27, 30},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	219 {31, 35},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	220 {36, 41},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	221 {42, 48},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	222 {49, 55},
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	223 {56, 63}
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	224
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	225 };
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	226
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	227 /* channel energy scaling table - allows efficient division by number
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	228 * of DFT bins in the channel: 1/2, 1/3, 1/4, etc.
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	229 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	230
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	231 static const Word16 ch_tbl_sh[NUM_CHAN] =
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	232 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	233 16384, 16384, 16384, 16384, 16384, 16384, 10923, 10923,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	234 10923, 8192, 8192, 6554, 5461, 4681, 4681, 4096
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	235 };
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	236
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	237 /*
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	238 * The voice metric table is defined below. It is a non-
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	239 * linear table with a deadband near zero. It maps the SNR
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	240 * index (quantized SNR value) to a number that is a measure
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	241 * of voice quality.
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	242 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	243
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	244 static const Word16 vm_tbl[90] =
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	245 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	246 2, 2, 2, 2, 2, 2, 2, 2, 2, 2, 2,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	247 3, 3, 3, 3, 3, 4, 4, 4, 5, 5, 5, 6, 6, 7, 7, 7,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	248 8, 8, 9, 9, 10, 10, 11, 12, 12, 13, 13, 14, 15,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	249 15, 16, 17, 17, 18, 19, 20, 20, 21, 22, 23, 24,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	250 24, 25, 26, 27, 28, 28, 29, 30, 31, 32, 33, 34,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	251 35, 36, 37, 37, 38, 39, 40, 41, 42, 43, 44, 45,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	252 46, 47, 48, 49, 50, 50, 50, 50, 50, 50, 50, 50,
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	253 50, 50
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	254 };
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	255
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	256 /* hangover as a function of peak SNR (3 dB steps) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	257 static const Word16 hangover_table[20] =
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	258 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	259 30, 30, 30, 30, 30, 30, 28, 26, 24, 22, 20, 18, 16, 14, 12, 10, 8, 8, 8, 8
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	260 };
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	261
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	262 /* burst sensitivity as a function of peak SNR (3 dB steps) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	263 static const Word16 burstcount_table[20] =
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	264 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	265 8, 8, 8, 8, 8, 8, 8, 8, 7, 6, 5, 4, 4, 4, 4, 4, 4, 4, 4, 4
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	266 };
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	267
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	268 /* voice metric sensitivity as a function of peak SNR (3 dB steps) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	269 static const Word16 vm_threshold_table[20] =
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	270 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	271 34, 34, 34, 34, 34, 34, 34, 34, 34, 34, 34, 40, 51, 71, 100, 139, 191, 257, 337, 432
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	272 };
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	273
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	274
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	275 /* State tables that use 22,9 or 27,4 scaling for ch_enrg[] */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	276
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	277 static const Word16 noise_floor_chan[2] = {NOISE_FLOOR_CHAN_0, NOISE_FLOOR_CHAN_1};
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	278 static const Word16 min_chan_enrg[2] = {MIN_CHAN_ENRG_0, MIN_CHAN_ENRG_1};
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	279 static const Word16 ine_noise[2] = {INE_NOISE_0, INE_NOISE_1};
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	280 static const Word16 fbits[2] = {FRACTIONAL_BITS_0, FRACTIONAL_BITS_1};
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	281 static const Word16 state_change_shift_r[2] = {STATE_1_TO_0_SHIFT_R, STATE_0_TO_1_SHIFT_R};
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	282
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	283 /* Energy scale table given 30,1 input scaling (also account for -6 dB shift on input) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	284 static const Word16 enrg_norm_shift[2] = {(FRACTIONAL_BITS_0-1+2), (FRACTIONAL_BITS_1-1+2)};
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	285
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	286
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	287 /* Automatic variables */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	288
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	289 Word32 Lenrg; /* scaled as 30,1 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	290 Word32 Ltne; /* scaled as 22,9 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	291 Word32 Ltce; /* scaled as 22,9 or 27,4 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	292
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	293 Word16 tne_db; /* scaled as 7,8 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	294 Word16 tce_db; /* scaled as 7,8 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	295
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	296 Word16 input_buffer[FRM_LEN]; /* used for block normalising input data */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	297 Word16 data_buffer[FFT_LEN]; /* used for in-place FFT */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	298
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	299 Word16 ch_snr[NUM_CHAN]; /* scaled as 7,8 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	300 Word16 ch_snrq; /* scaled as 15,0 (in 0.375 dB steps) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	301 Word16 vm_sum; /* scaled as 15,0 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	302 Word16 ch_enrg_dev; /* scaled as 7,8 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	303
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	304 Word32 Lpeak; /* maximum channel energy */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	305 Word16 p2a_flag; /* flag to indicate spectral peak-to-average ratio > 10 dB */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	306
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	307 Word16 ch_enrg_db[NUM_CHAN]; /* scaled as 7,8 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	308 Word16 ch_noise_db; /* scaled as 7,8 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	309
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	310 Word16 alpha; /* scaled as 0,15 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	311 Word16 one_m_alpha; /* scaled as 0,15 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	312 Word16 update_flag; /* set to indicate a background noise estimate update */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	313
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	314 Word16 i, j, j1, j2; /* Scratch variables */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	315 Word16 hi1, lo1;
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	316
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	317 Word32 Ltmp, Ltmp1, Ltmp2;
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	318 Word16 tmp;
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	319
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	320 Word16 normb_shift; /* block norm shift count */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	321
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	322 Word16 ivad; /* intermediate VAD decision (return value) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	323 Word16 tsnrq; /* total signal-to-noise ratio (quantized 3 dB steps) scaled as 15,0 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	324 Word16 xt; /* instantaneous frame SNR in dB, scaled as 7,8 */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	325
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	326 Word16 state_change;
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	327
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	328
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	329 /* Increment frame counter */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	330 st->Lframe_cnt = L_add(st->Lframe_cnt, 1);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	331
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	332 /* Block normalize the input */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	333 normb_shift = block_norm(farray_ptr, input_buffer, FRM_LEN, FFT_HEADROOM);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	334
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	335 /* Pre-emphasize the input data and store in the data buffer with the appropriate offset */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	336 for (i = 0; i < DELAY; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	337 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	338 data_buffer[i] = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	339 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	340
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	341 st->pre_emp_mem = shr_r(st->pre_emp_mem, sub(st->last_normb_shift, normb_shift));
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	342 st->last_normb_shift = normb_shift; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	343
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	344 data_buffer[DELAY] = add(input_buffer[0], mult(PRE_EMP_FAC, st->pre_emp_mem)); move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	345
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	346 for (i = DELAY + 1, j = 1; i < DELAY + FRM_LEN; i++, j++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	347 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	348 data_buffer[i] = add(input_buffer[j], mult(PRE_EMP_FAC, input_buffer[j-1])); move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	349 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	350 st->pre_emp_mem = input_buffer[FRM_LEN-1]; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	351
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	352 for (i = DELAY + FRM_LEN; i < FFT_LEN; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	353 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	354 data_buffer[i] = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	355 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	356
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	357
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	358 /* Perform FFT on the data buffer */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	359 r_fft(data_buffer);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	360
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	361
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	362 /* Use normb_shift factor to determine the scaling of the energy estimates */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	363 state_change = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	364 test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	365 if (st->shift_state == 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	366 { test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	367 if (sub(normb_shift, -FFT_HEADROOM+2) <= 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	368 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	369 state_change = 1; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	370 st->shift_state = 1; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	371 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	372 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	373 else
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	374 { test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	375 if (sub(normb_shift, -FFT_HEADROOM+5) >= 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	376 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	377 state_change = 1; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	378 st->shift_state = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	379 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	380 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	381
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	382 /* Scale channel energy estimate */ test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	383 if (state_change)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	384 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	385 for (i = LO_CHAN; i <= HI_CHAN; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	386 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	387 st->Lch_enrg[i] = L_shr(st->Lch_enrg[i], state_change_shift_r[st->shift_state]); move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	388 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	389 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	390
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	391
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	392 /* Estimate the energy in each channel */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	393 test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	394 if (L_sub(st->Lframe_cnt, 1) == 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	395 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	396 alpha = 32767; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	397 one_m_alpha = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	398 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	399 else
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	400 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	401 alpha = CEE_SM_FAC; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	402 one_m_alpha = ONE_MINUS_CEE_SM_FAC; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	403 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	404
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	405 for (i = LO_CHAN; i <= HI_CHAN; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	406 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	407 Lenrg = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	408 j1 = ch_tbl[i][0]; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	409 j2 = ch_tbl[i][1]; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	410
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	411 for (j = j1; j <= j2; j++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	412 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	413 Lenrg = L_mac(Lenrg, data_buffer[2 * j], data_buffer[2 * j]);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	414 Lenrg = L_mac(Lenrg, data_buffer[2 * j + 1], data_buffer[2 * j + 1]);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	415 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	416
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	417 /* Denorm energy & scale 30,1 according to the state */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	418 Lenrg = L_shr_r(Lenrg, sub(shl(normb_shift, 1), enrg_norm_shift[st->shift_state]));
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	419
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	420 /* integrate over time: e[i] = (1-alpha)e[i] + alphaenrg/num_bins_in_chan */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	421 tmp = mult(alpha, ch_tbl_sh[i]);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	422 L_Extract (Lenrg, &hi1, &lo1);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	423 Ltmp = Mpy_32_16(hi1, lo1, tmp);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	424
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	425 L_Extract (st->Lch_enrg[i], &hi1, &lo1);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	426 st->Lch_enrg[i] = L_add(Ltmp, Mpy_32_16(hi1, lo1, one_m_alpha)); move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	427 test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	428 if (L_sub(st->Lch_enrg[i], min_chan_enrg[st->shift_state]) < 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	429 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	430 st->Lch_enrg[i] = min_chan_enrg[st->shift_state]; move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	431 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	432
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	433 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	434
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	435
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	436 /* Compute the total channel energy estimate (Ltce) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	437 Ltce = 0; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	438 for (i = LO_CHAN; i <= HI_CHAN; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	439 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	440 Ltce = L_add(Ltce, st->Lch_enrg[i]);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	441 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	442
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	443
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	444 /* Calculate spectral peak-to-average ratio, set flag if p2a > 10 dB */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	445 Lpeak = 0; move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	446 for (i = LO_CHAN+2; i <= HI_CHAN; i++) /* Sine waves not valid for low frequencies */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	447 { test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	448 if (L_sub(st->Lch_enrg [i], Lpeak) > 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	449 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	450 Lpeak = st->Lch_enrg [i]; move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	451 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	452 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	453
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	454 /* Set p2a_flag if peak (dB) > average channel energy (dB) + 10 dB */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	455 /* Lpeak > Ltce/num_channels * 10^(10/10) */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	456 /* Lpeak > (10/16)Ltce /
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	457
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	458 L_Extract (Ltce, &hi1, &lo1);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	459 Ltmp = Mpy_32_16(hi1, lo1, 20480);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	460 test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	461 if (L_sub(Lpeak, Ltmp) > 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	462 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	463 p2a_flag = TRUE; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	464 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	465 else
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	466 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	467 p2a_flag = FALSE; move16();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	468 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	469
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	470
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	471 /* Initialize channel noise estimate to either the channel energy or fixed level */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	472 /* Scale the energy appropriately to yield state 0 (22,9) scaling for noise */
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	473 test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	474 if (L_sub(st->Lframe_cnt, 4) <= 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	475 { test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	476 if (p2a_flag == TRUE)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	477 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	478 for (i = LO_CHAN; i <= HI_CHAN; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	479 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	480 st->Lch_noise[i] = INE_NOISE_0; move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	481 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	482 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	483 else
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	484 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	485 for (i = LO_CHAN; i <= HI_CHAN; i++)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	486 { test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	487 if (L_sub(st->Lch_enrg[i], ine_noise[st->shift_state]) < 0)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	488 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	489 st->Lch_noise[i] = INE_NOISE_0; move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	490 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	491 else
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	492 { test();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	493 if (st->shift_state == 1)
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	494 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	495 st->Lch_noise[i] = L_shr(st->Lch_enrg[i], state_change_shift_r[0]);
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	496 move32();
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	497 }
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	498 else
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	499 {
0152c069d01f libtwamr: integrate VAD2 main body Mychaela Falconia <falcon@freecalypso.org> parents: diff changeset	500 st->Lch_noise[i] = st->Lch_enrg[i]; move32();

410

0152c069d01f libtwamr: integrate VAD2 main body