www.pudn.com > source.rar > ACELP_CO.C
/* ITU-T G.729 Software Package Release 2 (November 2006) */
/*
ITU-T G.729 Annex C - Reference C code for floating point
implementation of G.729
Version 1.01 of 15.September.98
*/
/*
----------------------------------------------------------------------
COPYRIGHT NOTICE
----------------------------------------------------------------------
ITU-T G.729 Annex C ANSI C source code
Copyright (C) 1998, AT&T, France Telecom, NTT, University of
Sherbrooke. All rights reserved.
----------------------------------------------------------------------
*/
/*
File : ACELP_CO.C
Used for the floating point version of G.729 main body
(not for G.729A)
*/
/*****************************************************************************/
/* fixed codebook encoding routines */
/*****************************************************************************/
#include "typedef.h"
#include "ld8k.h"
/* prototypes of local functions */
static void cor_h(
FLOAT *H, /* (i) :Impulse response of filters */
FLOAT *rr /* (o) :Correlations of H[] */
);
static int d4i40_17( /* (o) : Index of pulses positions. */
FLOAT Dn[], /* (i) : Correlations between h[] and Xn[]. */
FLOAT rr[], /* (i) : Correlations of impulse response h[]. */
FLOAT h[], /* (i) : Impulse response of filters. */
FLOAT cod[], /* (o) : Selected algebraic codeword. */
FLOAT y[], /* (o) : Filtered algebraic codeword. */
int *sign, /* (o) : Signs of 4 pulses. */
int i_subfr /* (i) : subframe flag */
);
int ACELP_codebook( /* (o) :index of pulses positions */
FLOAT x[], /* (i) :Target vector */
FLOAT h[], /* (i) :Impulse response of filters */
int t0, /* (i) :Pitch lag */
FLOAT pitch_sharp, /* (i) :Last quantized pitch gain */
int i_subfr, /* (i) :Indicator of 1st subframe, */
FLOAT code[], /* (o) :Innovative codebook */
FLOAT y[], /* (o) :Filtered innovative codebook */
int *sign /* (o) :Signs of 4 pulses */
)
{
int i, index;
FLOAT dn[L_SUBFR];
FLOAT rr[DIM_RR];
/*----------------------------------------------------------------*
* Include fixed-gain pitch contribution into impulse resp. h[] *
* Find correlations of h[] needed for the codebook search. *
*-----------------------------------------------------------------*/
if(t0 < L_SUBFR)
for (i = t0; i < L_SUBFR; i++)
h[i] += pitch_sharp * h[i-t0];
cor_h(h, rr);
/*----------------------------------------------------------------*
* Compute correlation of target vector with impulse response. *
*-----------------------------------------------------------------*/
cor_h_x(h, x, dn); /* backward filtered target vector dn */
/*----------------------------------------------------------------*
* Find innovative codebook. *
*-----------------------------------------------------------------*/
index = d4i40_17(dn, rr, h, code, y, sign, i_subfr);
/*------------------------------------------------------*
* - Add the fixed-gain pitch contribution to code[]. *
*-------------------------------------------------------*/
if(t0 < L_SUBFR)
for (i = t0; i < L_SUBFR; i++)
code[i] += pitch_sharp * code[i-t0];
return index;
}
/*--------------------------------------------------------------------------*
* Function cor_h() *
* ~~~~~~~~~~~~~~~~~ *
* Compute correlations of h[] needed for the codebook search. *
*--------------------------------------------------------------------------*/
static void cor_h(
FLOAT *h, /* (i) :Impulse response of filters */
FLOAT *rr /* (o) :Correlations of H[] */
)
{
FLOAT *rri0i0, *rri1i1, *rri2i2, *rri3i3, *rri4i4;
FLOAT *rri0i1, *rri0i2, *rri0i3, *rri0i4;
FLOAT *rri1i2, *rri1i3, *rri1i4;
FLOAT *rri2i3, *rri2i4;
FLOAT *p0, *p1, *p2, *p3, *p4;
FLOAT *ptr_hd, *ptr_hf, *ptr_h1, *ptr_h2;
FLOAT cor;
int i, k, ldec, l_fin_sup, l_fin_inf;
/* Init pointers */
rri0i0 = rr;
rri1i1 = rri0i0 + NB_POS;
rri2i2 = rri1i1 + NB_POS;
rri3i3 = rri2i2 + NB_POS;
rri4i4 = rri3i3 + NB_POS;
rri0i1 = rri4i4 + NB_POS;
rri0i2 = rri0i1 + MSIZE;
rri0i3 = rri0i2 + MSIZE;
rri0i4 = rri0i3 + MSIZE;
rri1i2 = rri0i4 + MSIZE;
rri1i3 = rri1i2 + MSIZE;
rri1i4 = rri1i3 + MSIZE;
rri2i3 = rri1i4 + MSIZE;
rri2i4 = rri2i3 + MSIZE;
/*------------------------------------------------------------*
* Compute rri0i0[], rri1i1[], rri2i2[], rri3i3 and rri4i4[] *
*------------------------------------------------------------*/
p0 = rri0i0 + NB_POS-1; /* Init pointers to last position of rrixix[] */
p1 = rri1i1 + NB_POS-1;
p2 = rri2i2 + NB_POS-1;
p3 = rri3i3 + NB_POS-1;
p4 = rri4i4 + NB_POS-1;
ptr_h1 = h;
cor = (F)0.0;
for(i=0; i= (F)0.0)
{
p_sign[i] = (F)1.0;
}
else {
p_sign[i] = (F)-1.0;
dn[i] = -dn[i];
}
}
/*-------------------------------------------------------------------*
* - Compute the search threshold after three pulses *
*-------------------------------------------------------------------*/
average = dn[0] + dn[1] + dn[2];
max0 = dn[0];
max1 = dn[1];
max2 = dn[2];
for (i = 5; i < L_SUBFR; i+=STEP)
{
average += dn[i] + dn[i+1]+ dn[i+2];
if (dn[i] > max0) max0 = dn[i];
if (dn[i+1] > max1) max1 = dn[i+1];
if (dn[i+2] > max2) max2 = dn[i+2];
}
max0 += max1+max2;
average *= (F)0.125; /* 1/8 */
thres = average + (max0-average)*THRESHFCB;
/*-------------------------------------------------------------------*
* Modification of rrixiy to take into account signs. *
*-------------------------------------------------------------------*/
ptr_ri0i1 = rri0i1;
ptr_ri0i2 = rri0i2;
ptr_ri0i3 = rri0i3;
ptr_ri0i4 = rri0i4;
for(i0=0; i0 thres)
{
ptr_ri3i3 = rri3i3; /* Init. pointers that depend on 4th loop */
for (i3 = 3; i3 < L_SUBFR; i3 += STEP)
{
ps3 = ps2 + dn[i3];
alp3 = alp2 + *ptr_ri3i3++ + (F)2.0*(*ptr_ri1i3++ + *ptr_ri0i3++ + *ptr_ri2i3++);
ps3c = ps3*ps3;
if( (ps3c*alpha) > (psc * alp3) )
{
psc = ps3c;
alpha = alp3;
ip0 = i0;
ip1 = i1;
ip2 = i2;
ip3 = i3;
}
} /* end of for i3 = */
ptr_ri0i3 -= NB_POS;
ptr_ri1i3 -= NB_POS;
ptr_ri4i4 = rri4i4; /* Init. pointers that depend on 4th loop */
for (i3 = 4; i3 < L_SUBFR; i3 += STEP)
{
ps3 = ps2 + dn[i3];
alp3 = alp2 + *ptr_ri4i4++ + (F)2.0*(*ptr_ri1i4++ + *ptr_ri0i4++ + *ptr_ri2i4++);
ps3c = ps3*ps3;
if( (ps3c*alpha) > (psc * alp3) )
{
psc = ps3c;
alpha = alp3;
ip0 = i0;
ip1 = i1;
ip2 = i2;
ip3 = i3;
}
} /* end of for i3 = */
ptr_ri0i4 -= NB_POS;
ptr_ri1i4 -= NB_POS;
time --;
if(time <= 0 ) goto end_search; /* Maximum time finish */
} /* end of if >thres */
else {
ptr_ri2i3 += NB_POS;
ptr_ri2i4 += NB_POS;
}
} /* end of for i2 = */
ptr_ri0i2 -= NB_POS;
ptr_ri1i3 += NB_POS;
ptr_ri1i4 += NB_POS;
} /* end of for i1 = */
ptr_ri0i2 += NB_POS;
ptr_ri0i3 += NB_POS;
ptr_ri0i4 += NB_POS;
} /* end of for i0 = */
end_search:
extra = time;
/* Find the codeword corresponding to the selected positions */
for(i=0; i (F)0.0)
for(i=ip0, j=0; i (F)0.0)
for(i=ip1, j=0; i (F)0.0)
for(i=ip2, j=0; i (F)0.0)
for(i=ip3, j=0; i (F)0.0) i+=1;
if(p_sign[ip1] > (F)0.0) i+=2;
if(p_sign[ip2] > (F)0.0) i+=4;
if(p_sign[ip3] > (F)0.0) i+=8;
*signs = i;
ip0 = ip0 / 5;
ip1 = ip1 / 5;
ip2 = ip2 / 5;
j = (ip3 % 5) - 3;
ip3 = ( (ip3 / 5) << 1 ) + j;
i = (ip0) + (ip1<<3) + (ip2<<6) + (ip3<<9);
return i;
}