void vad(float rc,
float * lsf,
float * rxx,
float * sigpp,
int frm_count,
int prev_marker, int pprev_marker, int *marker, float * Energy_db)
{
float tmp[M];
float SD;
float E_low;
float dtemp;
float dSE;
float dSLE;
float ZC;
float COEF;
float COEFZC;
float COEFSD;
float dSZC;
float norm_energy;
int i;
/* compute the frame energy */
norm_energy =
(float) 10.0 *(float) log10((float) (rxx[0] / (float) 240.0 + EPSI));
*Energy_db = norm_energy;
/* compute the low band energy */
E_low = (float) 0.0;
for (i = 1; i <= NP; i++)
E_low = E_low + rxx[i] * lbf_corr[i];
E_low = rxx[0] * lbf_corr[0] + (float) 2.0 *E_low;
if (E_low < (float) 0.0)
E_low = (float) 0.0;
E_low = (float) 10.0 *(float) log10((float) (E_low / (float) 240.0 + EPSI));
/* compute SD */
/* Normalize lsfs */
for (i = 0; i < M; i++)
lsf[i] /= (float) 2. *PI;
dvsub(lsf, MeanLSF, tmp, M);
SD = dvdot(tmp, tmp, M);
/* compute # zero crossing */
ZC = (float) 0.0f;
dtemp = sigpp[ZC_START];
for (i = ZC_START + 1; i <= ZC_END; i++) {
if (dtemp * sigpp[i] < (float) 0.0) {
ZC = ZC + (float) 1.0;
}
dtemp = sigpp[i];
}
ZC = ZC / (float) 80.0;
/* Initialize and update Mins */
if (frm_count < 129) {
if (norm_energy < Min) {
Min = norm_energy;
Prev_Min = norm_energy;
}
if ((frm_count % 8) == 0) {
Min_buffer[(int)frm_count / 8 - 1] = Min;
Min = FLT_MAX_G729;
}
}
if ((frm_count % 8) == 0) {
Prev_Min = Min_buffer[0];
for (i = 1; i < 15; i++) {
if (Min_buffer[i] < Prev_Min)
Prev_Min = Min_buffer[i];
}
}
if (frm_count >= 129) {
if ((frm_count % 8) == 1) {
Min = Prev_Min;
Next_Min = FLT_MAX_G729;
}
if (norm_energy < Min)
Min = norm_energy;
if (norm_energy < Next_Min)
Next_Min = norm_energy;
if ((frm_count % 8) == 0) {
for (i = 0; i < 15; i++)
Min_buffer[i] = Min_buffer[i + 1];
Min_buffer[15] = Next_Min;
Prev_Min = Min_buffer[0];
for (i = 1; i < 16; i++) {
if (Min_buffer[i] < Prev_Min)
Prev_Min = Min_buffer[i];
}
}
}
if (frm_count <= INIT_FRAME) {
if (norm_energy < (float) 21.0) {
less_count++;
*marker = NOISE;
} else {
*marker = VOICE;
MeanE =
(MeanE * ((float) (frm_count - less_count - 1)) +
norm_energy) / (float) (frm_count - less_count);
MeanSZC =
(MeanSZC * ((float) (frm_count - less_count - 1)) +
ZC) / (float) (frm_count - less_count);
dvwadd(MeanLSF, (float) (frm_count - less_count - 1),
lsf, (float) 1.0, MeanLSF, M);
dvsmul(MeanLSF,
(float) 1.0 / (float) (frm_count - less_count),
MeanLSF, M);
}
}
if (frm_count >= INIT_FRAME) {
if (frm_count == INIT_FRAME) {
MeanSE = MeanE - (float) 10.0;
MeanSLE = MeanE - (float) 12.0;
}
dSE = MeanSE - norm_energy;
dSLE = MeanSLE - E_low;
dSZC = MeanSZC - ZC;
if (norm_energy < (float) 21.0) {
*marker = NOISE;
} else {
*marker = MakeDec(dSLE, dSE, SD, dSZC);
}
v_flag = 0;
if ((prev_marker == VOICE) && (*marker == NOISE) &&
(norm_energy > MeanSE + (float) 2.0)
&& (norm_energy > (float) 21.0)) {
*marker = VOICE;
v_flag = 1;
}
if (flag == 1) {
if ((pprev_marker == VOICE) && (prev_marker == VOICE) &&
(*marker == NOISE)
&& (fabs(prev_energy - norm_energy) <= (float) 3.0)) {
count_ext++;
*marker = VOICE;
v_flag = 1;
if (count_ext <= 4)
flag = 1;
else {
flag = 0;
count_ext = 0;
}
}
} else
flag = 1;
if (*marker == NOISE)
count_sil++;
if ((*marker == VOICE) && (count_sil > 10) &&
((norm_energy - prev_energy) <= (float) 3.0)) {
*marker = NOISE;
count_sil = 0;
}
if (*marker == VOICE)
count_sil = 0;
if ((norm_energy < MeanSE + (float) 3.0) && (frm_count > 128)
&& (!v_flag) && (rc < (float) 0.6))
*marker = NOISE;
if ((norm_energy < MeanSE + (float) 3.0) && (rc < (float) 0.75)
&& (SD < (float) 0.002532959)) {
count_update++;
if (count_update < INIT_COUNT) {
COEF = (float) 0.75;
COEFZC = (float) 0.8;
COEFSD = (float) 0.6;
} else if (count_update < INIT_COUNT + 10) {
COEF = (float) 0.95;
COEFZC = (float) 0.92;
COEFSD = (float) 0.65;
} else if (count_update < INIT_COUNT + 20) {
COEF = (float) 0.97;
COEFZC = (float) 0.94;
COEFSD = (float) 0.70;
} else if (count_update < INIT_COUNT + 30) {
COEF = (float) 0.99;
COEFZC = (float) 0.96;
COEFSD = (float) 0.75;
} else if (count_update < INIT_COUNT + 40) {
COEF = (float) 0.995;
COEFZC = (float) 0.99;
COEFSD = (float) 0.75;
} else {
COEF = (float) 0.995;
COEFZC = (float) 0.998;
COEFSD = (float) 0.75;
}
dvwadd(MeanLSF, COEFSD, lsf, (float) 1.0 - COEFSD, MeanLSF,
M);
MeanSE = COEF * MeanSE + ((float) 1.0 - COEF) * norm_energy;
MeanSLE = COEF * MeanSLE + ((float) 1.0 - COEF) * E_low;
MeanSZC = COEFZC * MeanSZC + ((float) 1.0 - COEFZC) * ZC;
}
if (((frm_count > 128)
&& ((MeanSE < Min) && (SD < (float) 0.002532959)))
|| (MeanSE > Min + (float) 10.0)) {
MeanSE = Min;
count_update = 0;
}
}
prev_energy = norm_energy;
return;
}
/*-----------------------------------------------------------------*
* Functions vad *
* ~~~ *
* Input: *
* rc : reflection coefficient *
* lsf[] : unquantized lsf vector *
* r_h[] : upper 16-bits of the autocorrelation vector *
* r_l[] : lower 16-bits of the autocorrelation vector *
* exp_R0 : exponent of the autocorrelation vector *
* sigpp[] : preprocessed input signal *
* frm_count : frame counter *
* prev_marker : VAD decision of the last frame *
* pprev_marker : VAD decision of the frame before last frame *
* *
* Output: *
* *
* marker : VAD decision of the current frame *
* *
*-----------------------------------------------------------------*/
void vadg(
Word16 rc,
Word16 *lsf,
Word16 *r_h,
Word16 *r_l,
Word16 exp_R0,
Word16 *sigpp,
Word16 frm_count,
Word16 prev_marker,
Word16 pprev_marker,
Word16 *marker,
Word16 *ENERGY_db)
{
/* scalar */
Word32 acc0;
Word16 i, j, exp, frac;
Word16 ENERGY, ENERGY_low, SD, ZC, dSE, dSLE, dSZC;
Word16 COEF, C_COEF, COEFZC, C_COEFZC, COEFSD, C_COEFSD;
/* compute the frame energy */
acc0 = L_Comp(r_h[0], r_l[0]);
Log2(acc0, &exp, &frac);
acc0 = Mpy_32_16(exp, frac, 9864);
i = sub(exp_R0, 1);
i = sub(i, 1);
acc0 = L_mac(acc0, 9864, i);
acc0 = L_shl(acc0, 11);
ENERGY = extract_h(acc0);
ENERGY = sub(ENERGY, 4875);
*ENERGY_db = ENERGY;
/* compute the low band energy */
acc0 = 0;
for (i=1; i<=NP; i++)
acc0 = L_mac(acc0, r_h[i], lbf_corr[i]);
acc0 = L_shl(acc0, 1);
acc0 = L_mac(acc0, r_h[0], lbf_corr[0]);
Log2(acc0, &exp, &frac);
acc0 = Mpy_32_16(exp, frac, 9864);
i = sub(exp_R0, 1);
i = sub(i, 1);
acc0 = L_mac(acc0, 9864, i);
acc0 = L_shl(acc0, 11);
ENERGY_low = extract_h(acc0);
ENERGY_low = sub(ENERGY_low, 4875);
/* compute SD */
acc0 = 0;
for (i=0; i<M; i++){
j = sub(lsf[i], MeanLSF[i]);
acc0 = L_mac(acc0, j, j);
}
SD = extract_h(acc0); /* Q15 */
/* compute # zero crossing */
ZC = 0;
for (i=ZC_START+1; i<=ZC_END; i++)
if (mult(sigpp[i-1], sigpp[i]) < 0){
ZC = add(ZC, 410); /* Q15 */
}
/* Initialize and update Mins */
if(sub(frm_count, 129) < 0){
if (sub(ENERGY, Min) < 0){
Min = ENERGY;
Prev_Min = ENERGY;
}
if((frm_count & 0x0007) == 0){
i = sub(shr(frm_count,3),1);
Min_buffer[i] = Min;
Min = MAX_16;
}
}
if((frm_count & 0x0007) == 0){
Prev_Min = Min_buffer[0];
for (i=1; i<16; i++){
if (sub(Min_buffer[i], Prev_Min) < 0){
Prev_Min = Min_buffer[i];
}
}
}
if(sub(frm_count, 129) >= 0){
if(((frm_count & 0x0007) ^ (0x0001)) == 0){
Min = Prev_Min;
Next_Min = MAX_16;
}
if (sub(ENERGY, Min) < 0){
Min = ENERGY;
}
if (sub(ENERGY, Next_Min) < 0){
Next_Min = ENERGY;
}
if((frm_count & 0x0007) == 0){
for (i=0; i<15; i++)
Min_buffer[i] = Min_buffer[i+1];
Min_buffer[15] = Next_Min;
Prev_Min = Min_buffer[0];
for (i=1; i<16; i++)
if (sub(Min_buffer[i], Prev_Min) < 0){
Prev_Min = Min_buffer[i];
}
}
}
if (sub(frm_count, INIT_FRAME) <= 0){
if(sub(ENERGY, 3072) < 0){
*marker = NOISE;
less_count++;
}
else{
*marker = VOICE;
acc0 = L_deposit_h(MeanE);
acc0 = L_mac(acc0, ENERGY, 1024);
MeanE = extract_h(acc0);
acc0 = L_deposit_h(MeanSZC);
acc0 = L_mac(acc0, ZC, 1024);
MeanSZC = extract_h(acc0);
for (i=0; i<M; i++){
acc0 = L_deposit_h(MeanLSF[i]);
acc0 = L_mac(acc0, lsf[i], 1024);
MeanLSF[i] = extract_h(acc0);
}
}
}
if (sub(frm_count, INIT_FRAME) >= 0){
if (sub(frm_count, INIT_FRAME) == 0){
acc0 = L_mult(MeanE, factor_fx[less_count]);
acc0 = L_shl(acc0, shift_fx[less_count]);
MeanE = extract_h(acc0);
acc0 = L_mult(MeanSZC, factor_fx[less_count]);
acc0 = L_shl(acc0, shift_fx[less_count]);
MeanSZC = extract_h(acc0);
for (i=0; i<M; i++){
acc0 = L_mult(MeanLSF[i], factor_fx[less_count]);
acc0 = L_shl(acc0, shift_fx[less_count]);
MeanLSF[i] = extract_h(acc0);
}
MeanSE = sub(MeanE, 2048); /* Q11 */
MeanSLE = sub(MeanE, 2458); /* Q11 */
}
dSE = sub(MeanSE, ENERGY);
dSLE = sub(MeanSLE, ENERGY_low);
dSZC = sub(MeanSZC, ZC);
if(sub(ENERGY, 3072) < 0){
*marker = NOISE;
}
else {
*marker = MakeDec(dSLE, dSE, SD, dSZC);
}
v_flag = 0;
if((prev_marker==VOICE) && (*marker==NOISE) && (add(dSE,410)<0)
&& (sub(ENERGY, 3072)>0)){
*marker = VOICE;
v_flag = 1;
}
if(flag == 1){
if((pprev_marker == VOICE) &&
(prev_marker == VOICE) &&
(*marker == NOISE) &&
(sub(abs_s(sub(prev_energy,ENERGY)), 614) <= 0)){
count_ext++;
*marker = VOICE;
v_flag = 1;
if(sub(count_ext, 4) <= 0){
flag=1;
}
else{
count_ext=0;
flag=0;
}
}
}
else{
flag=1;
}
if(*marker == NOISE){
count_sil++;
}
if((*marker == VOICE) && (sub(count_sil, 10) > 0) &&
(sub(sub(ENERGY,prev_energy), 614) <= 0)){
*marker = NOISE;
count_sil=0;
}
if(*marker == VOICE){
count_sil=0;
}
if ((sub(sub(ENERGY, 614), MeanSE)<0) && (sub(frm_count, 128) > 0)
&& (!v_flag) && (sub(rc, 19661) < 0)){
*marker = NOISE;
}
if ((sub(sub(ENERGY,614),MeanSE) < 0) && (sub(rc, 24576) < 0)
&& (sub(SD, 83) < 0)){
count_update++;
if (sub(count_update, INIT_COUNT) < 0){
COEF = 24576;
C_COEF = 8192;
COEFZC = 26214;
C_COEFZC = 6554;
COEFSD = 19661;
C_COEFSD = 13017;
}
else
if (sub(count_update, INIT_COUNT+10) < 0){
COEF = 31130;
C_COEF = 1638;
COEFZC = 30147;
C_COEFZC = 2621;
COEFSD = 21299;
C_COEFSD = 11469;
}
else
if (sub(count_update, INIT_COUNT+20) < 0){
COEF = 31785;
C_COEF = 983;
COEFZC = 30802;
C_COEFZC = 1966;
COEFSD = 22938;
C_COEFSD = 9830;
}
else
if (sub(count_update, INIT_COUNT+30) < 0){
COEF = 32440;
C_COEF = 328;
COEFZC = 31457;
C_COEFZC = 1311;
COEFSD = 24576;
C_COEFSD = 8192;
}
else
if (sub(count_update, INIT_COUNT+40) < 0){
COEF = 32604;
C_COEF = 164;
COEFZC = 32440;
C_COEFZC = 328;
COEFSD = 24576;
C_COEFSD = 8192;
}
else{
COEF = 32604;
C_COEF = 164;
COEFZC = 32702;
C_COEFZC = 66;
COEFSD = 24576;
C_COEFSD = 8192;
}
/* compute MeanSE */
acc0 = L_mult(COEF, MeanSE);
acc0 = L_mac(acc0, C_COEF, ENERGY);
MeanSE = extract_h(acc0);
/* compute MeanSLE */
acc0 = L_mult(COEF, MeanSLE);
acc0 = L_mac(acc0, C_COEF, ENERGY_low);
MeanSLE = extract_h(acc0);
/* compute MeanSZC */
acc0 = L_mult(COEFZC, MeanSZC);
acc0 = L_mac(acc0, C_COEFZC, ZC);
MeanSZC = extract_h(acc0);
/* compute MeanLSF */
for (i=0; i<M; i++){
acc0 = L_mult(COEFSD, MeanLSF[i]);
acc0 = L_mac(acc0, C_COEFSD, lsf[i]);
MeanLSF[i] = extract_h(acc0);
}
}
if((sub(frm_count, 128) > 0) && (((sub(MeanSE,Min) < 0) && (sub(SD, 83) < 0)
) || (sub(MeanSE,Min) > 2048))){
MeanSE = Min;
count_update = 0;
}
}
prev_energy = ENERGY;
}
