📄 g7231_exc_lbc.c
字号:
p1 -= ldec;
p0 -= ldec;
}
cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
*p3 = G7231extract_h(cor);
l_fin_sup -= G7231NB_POS;
l_fin_inf--;
ptr_hf += G7231STEP;
}
return;
}
void G7231Cor_h_X(Word16 h[], Word16 X[], Word16 D[])
{
Word16 i, j;
Word32 s, max;
Word32 y32[G7231SubFrLen];
/* first keep the result on 32 bits and find absolute maximum */
max = 0;
for (i = 0; i < G7231SubFrLen; i++) {
s = 0;
for (j = i; j < G7231SubFrLen; j++)
s = G7231L_mac(s, X[j], h[j-i]);
y32[i] = s;
s = G7231L_abs(s);
if(s > max) max = s;
}
/*
* Find the number of right shifts to do on y32[]
* so that maximum is on 13 bits
*/
j = G7231norm_l(max);
if( G7231sub(j,16) > 0) j = 16;
j = G7231sub(18, j);
for(i=0; i<G7231SubFrLen; i++)
D[i] = G7231extract_l( G7231L_shr(y32[i], j) );
return;
}
static Word16 G7231extra;
void G7231reset_max_time(void)
{
G7231extra = 120;
return;
}
Word16 G7231D4i64_LBC(Word16 Dn[], Word16 rr[], Word16 h[], Word16 cod[],
Word16 y[], Word16 *code_shift, Word16 *sign)
{
Word16 i0, i1, i2, i3, ip0, ip1, ip2, ip3;
Word16 i, j, time;
Word16 shif, shift;
Word16 ps0, ps1, ps2, ps3, alp, alp0;
Word32 alp1, alp2, alp3, L32;
Word16 ps0a, ps1a, ps2a;
Word16 ps3c, psc, alpha;
Word16 means, max0, max1, max2, thres;
Word16 *rri0i0, *rri1i1, *rri2i2, *rri3i3;
Word16 *rri0i1, *rri0i2, *rri0i3;
Word16 *rri1i2, *rri1i3, *rri2i3;
Word16 *ptr_ri0i0, *ptr_ri1i1, *ptr_ri2i2, *ptr_ri3i3;
Word16 *ptr_ri0i1, *ptr_ri0i2, *ptr_ri0i3;
Word16 *ptr_ri1i2, *ptr_ri1i3, *ptr_ri2i3;
Word16 *ptr1_ri0i1, *ptr1_ri0i2, *ptr1_ri0i3;
Word16 *ptr1_ri1i2, *ptr1_ri1i3, *ptr1_ri2i3;
Word16 p_sign[G7231SubFrLen2/2];
/* Init pointers */
rri0i0 = rr;
rri1i1 = rri0i0 + G7231NB_POS;
rri2i2 = rri1i1 + G7231NB_POS;
rri3i3 = rri2i2 + G7231NB_POS;
rri0i1 = rri3i3 + G7231NB_POS;
rri0i2 = rri0i1 + G7231MSIZE;
rri0i3 = rri0i2 + G7231MSIZE;
rri1i2 = rri0i3 + G7231MSIZE;
rri1i3 = rri1i2 + G7231MSIZE;
rri2i3 = rri1i3 + G7231MSIZE;
/*
* Extend the backward filtered target vector by zeros
*/
for (i = G7231SubFrLen; i < G7231SubFrLen2; i++) Dn[i] = 0;
/*
* Chose the sign of the impulse.
*/
for (i=0; i<G7231SubFrLen; i+=2) {
if( G7231add(Dn[i],Dn[i+1]) >= 0) {
p_sign[i/2] = 1;
}
else {
p_sign[i/2] = -1;
Dn[i] = -Dn[i];
Dn[i+1] = -Dn[i+1];
}
}
p_sign[30] = p_sign[31] = 1;
/*
* Compute the search threshold after three pulses
*/
/* odd positions */
/* Find maximum of Dn[i0]+Dn[i1]+Dn[i2] */
max0 = Dn[0];
max1 = Dn[2];
max2 = Dn[4];
for (i = 8; i < G7231SubFrLen; i+=G7231STEP) {
if (Dn[i] > max0) max0 = Dn[i];
if (Dn[i+2] > max1) max1 = Dn[i+2];
if (Dn[i+4] > max2) max2 = Dn[i+4];
}
max0 = G7231add(max0, max1);
max0 = G7231add(max0, max2);
/* Find means of Dn[i0]+Dn[i1]+Dn[i2] */
L32 = 0;
for (i = 0; i < G7231SubFrLen; i+=G7231STEP) {
L32 = G7231L_mac(L32, Dn[i], 1);
L32 = G7231L_mac(L32, Dn[i+2], 1);
L32 = G7231L_mac(L32, Dn[i+4], 1);
}
means = G7231extract_l( G7231L_shr(L32, 4));
/* thres = means + (max0-means)*threshold; */
thres = G7231sub(max0, means);
thres = G7231mult(thres, G7231threshold);
thres = G7231add(thres, means);
/* even positions */
/* Find maximum of Dn[i0]+Dn[i1]+Dn[i2] */
max0 = Dn[1];
max1 = Dn[3];
max2 = Dn[5];
for (i = 9; i < G7231SubFrLen; i+=G7231STEP) {
if (Dn[i] > max0) max0 = Dn[i];
if (Dn[i+2] > max1) max1 = Dn[i+2];
if (Dn[i+4] > max2) max2 = Dn[i+4];
}
max0 = G7231add(max0, max1);
max0 = G7231add(max0, max2);
/* Find means of Dn[i0]+Dn[i1]+Dn[i2] */
L32 = 0;
for (i = 1; i < G7231SubFrLen; i+=G7231STEP) {
L32 = G7231L_mac(L32, Dn[i], 1);
L32 = G7231L_mac(L32, Dn[i+2], 1);
L32 = G7231L_mac(L32, Dn[i+4], 1);
}
means =G7231extract_l( G7231L_shr(L32, 4));
/* max1 = means + (max0-means)*threshold */
max1 = G7231sub(max0, means);
max1 = G7231mult(max1, G7231threshold);
max1 = G7231add(max1, means);
/* Keep maximum threshold between odd and even position */
if(max1 > thres) thres = max1;
/*
* Modification of rrixiy[] to take signs into account.
*/
ptr_ri0i1 = rri0i1;
ptr_ri0i2 = rri0i2;
ptr_ri0i3 = rri0i3;
ptr1_ri0i1 = rri0i1;
ptr1_ri0i2 = rri0i2;
ptr1_ri0i3 = rri0i3;
for(i0=0; i0<G7231SubFrLen/2; i0+=G7231STEP/2) {
for(i1=2/2; i1<G7231SubFrLen/2; i1+=G7231STEP/2) {
*ptr_ri0i1++ = G7231i_mult(*ptr1_ri0i1++,
G7231i_mult(p_sign[i0], p_sign[i1]));
*ptr_ri0i2++ = G7231i_mult(*ptr1_ri0i2++,
G7231i_mult(p_sign[i0], p_sign[i1+1]));
*ptr_ri0i3++ = G7231i_mult(*ptr1_ri0i3++,
G7231i_mult(p_sign[i0], p_sign[i1+2]));
}
}
ptr_ri1i2 = rri1i2;
ptr_ri1i3 = rri1i3;
ptr1_ri1i2 = rri1i2;
ptr1_ri1i3 = rri1i3;
for(i1=2/2; i1<G7231SubFrLen/2; i1+=G7231STEP/2) {
for(i2=4/2; i2<G7231SubFrLen2/2; i2+=G7231STEP/2) {
*ptr_ri1i2++ = G7231i_mult(*ptr1_ri1i2++,
G7231i_mult(p_sign[i1], p_sign[i2]));
*ptr_ri1i3++ = G7231i_mult(*ptr1_ri1i3++,
G7231i_mult(p_sign[i1], p_sign[i2+1]));
}
}
ptr_ri2i3 = rri2i3;
ptr1_ri2i3 = rri2i3;
for(i2=4/2; i2<G7231SubFrLen2/2; i2+=G7231STEP/2) {
for(i3=6/2; i3<G7231SubFrLen2/2; i3+=G7231STEP/2)
*ptr_ri2i3++ = G7231i_mult(*ptr1_ri2i3++, G7231i_mult(p_sign[i2], p_sign[i3]));
}
ip0 = 0;
ip1 = 2;
ip2 = 4;
ip3 = 6;
shif = 0;
psc = 0;
alpha = 32767;
time = G7231add(G7231max_time, G7231extra);
/* Four loops to search innovation code. */
/* Init. pointers that depend on first loop */
ptr_ri0i0 = rri0i0;
ptr_ri0i1 = rri0i1;
ptr_ri0i2 = rri0i2;
ptr_ri0i3 = rri0i3;
/* first pulse loop */
for (i0 = 0; i0 < G7231SubFrLen; i0 += G7231STEP) {
ps0 = Dn[i0];
ps0a = Dn[i0+1];
alp0 = *ptr_ri0i0++;
/* Init. pointers that depend on second loop */
ptr_ri1i1 = rri1i1;
ptr_ri1i2 = rri1i2;
ptr_ri1i3 = rri1i3;
/* second pulse loop */
for (i1 = 2; i1 < G7231SubFrLen; i1 += G7231STEP) {
ps1 = G7231add(ps0, Dn[i1]);
ps1a = G7231add(ps0a, Dn[i1+1]);
/* alp1 = alp0 + *ptr_ri1i1++ + 2.0 * ( *ptr_ri0i1++); */
alp1 = G7231L_mult(alp0, 1);
alp1 = G7231L_mac(alp1, *ptr_ri1i1++, 1);
alp1 = G7231L_mac(alp1, *ptr_ri0i1++, 2);
/* Init. pointers that depend on third loop */
ptr_ri2i2 = rri2i2;
ptr_ri2i3 = rri2i3;
/* third pulse loop */
for (i2 = 4; i2 < G7231SubFrLen2; i2 += G7231STEP) {
ps2 = G7231add(ps1, Dn[i2]);
ps2a = G7231add(ps1a, Dn[i2+1]);
/* alp2 = alp1 + *ptr_ri2i2++
+ 2.0 * (*ptr_ri0i2++ + *ptr_ri1i2++); */
alp2 = G7231L_mac(alp1, *ptr_ri2i2++, 1);
alp2 = G7231L_mac(alp2, *ptr_ri0i2++, 2);
alp2 = G7231L_mac(alp2, *ptr_ri1i2++, 2);
/* Decide the shift */
shift = 0;
if(ps2a > ps2) {
shift = 1;
ps2 = ps2a;
}
/* Test threshold */
if ( ps2 > thres) {
/* Init. pointers that depend on 4th loop */
ptr_ri3i3 = rri3i3;
/* 4th pulse loop */
for (i3 = 6; i3 < G7231SubFrLen2; i3 += G7231STEP) {
ps3 = G7231add(ps2, Dn[i3+shift]);
/* alp3 = alp2 + (*ptr_ri3i3++) +
2 x ( (*ptr_ri0i3++) +
(*ptr_ri1i3++) +
(*ptr_ri2i3++) ) */
alp3 = G7231L_mac(alp2, *ptr_ri3i3++, 1);
alp3 = G7231L_mac(alp3, *ptr_ri0i3++, 2);
alp3 = G7231L_mac(alp3, *ptr_ri1i3++, 2);
alp3 = G7231L_mac(alp3, *ptr_ri2i3++, 2);
alp = G7231extract_l(G7231L_shr(alp3, 5));
ps3c = G7231mult(ps3, ps3);
if( G7231L_mult(ps3c, alpha) > G7231L_mult(psc, alp) ) {
psc = ps3c;
alpha = alp;
ip0 = i0;
ip1 = i1;
ip2 = i2;
ip3 = i3;
shif = shift;
}
} /* end of for i3 = */
time --;
if(time <= 0 ) goto end_search; /* Max time finish */
ptr_ri0i3 -= G7231NB_POS;
ptr_ri1i3 -= G7231NB_POS;
} /* end of if >thres */
else {
ptr_ri2i3 += G7231NB_POS;
}
} /* end of for i2 = */
ptr_ri0i2 -= G7231NB_POS;
ptr_ri1i3 += G7231NB_POS;
} /* end of for i1 = */
ptr_ri0i2 += G7231NB_POS;
ptr_ri0i3 += G7231NB_POS;
} /* end of for i0 = */
end_search:
G7231extra = time;
/* Set the sign of impulses */
i0 = p_sign[G7231shr(ip0, 1)];
i1 = p_sign[G7231shr(ip1, 1)];
i2 = p_sign[G7231shr(ip2, 1)];
i3 = p_sign[G7231shr(ip3, 1)];
/* Find the codeword corresponding to the selected positions */
for(i=0; i<G7231SubFrLen; i++) cod[i] = 0;
if(shif > 0) {
ip0 = G7231add(ip0 ,1);
ip1 = G7231add(ip1 ,1);
ip2 = G7231add(ip2 ,1);
ip3 = G7231add(ip3 ,1);
}
cod[ip0] = i0;
cod[ip1] = i1;
if(ip2<G7231SubFrLen) cod[ip2] = i2;
if(ip3<G7231SubFrLen) cod[ip3] = i3;
/* find the filtered codeword */
for (i = 0; i < G7231SubFrLen; i++) y[i] = 0;
if(i0 > 0)
for(i=ip0, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231add(y[i], h[j]);
else
for(i=ip0, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231sub(y[i], h[j]);
if(i1 > 0)
for(i=ip1, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231add(y[i], h[j]);
else
for(i=ip1, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231sub(y[i], h[j]);
if(ip2 < G7231SubFrLen) {
if(i2 > 0)
for(i=ip2, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231add(y[i], h[j]);
else
for(i=ip2, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231sub(y[i], h[j]);
}
if(ip3 < G7231SubFrLen) {
if(i3 > 0)
for(i=ip3, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231add(y[i], h[j]);
else
for(i=ip3, j=0; i<G7231SubFrLen; i++, j++)
y[i] = G7231sub(y[i], h[j]);
}
/* find codebook index; 17-bit address */
*code_shift = shif;
*sign = 0;
if(i0 > 0) *sign = G7231add(*sign, 1);
if(i1 > 0) *sign = G7231add(*sign, 2);
if(i2 > 0) *sign = G7231add(*sign, 4);
if(i3 > 0) *sign = G7231add(*sign, 8);
i = G7231shr(ip0, 3);
i = G7231add(i, G7231shl(G7231shr(ip1, 3), 3));
i = G7231add(i, G7231shl(G7231shr(ip2, 3), 6));
i = G7231add(i, G7231shl(G7231shr(ip3, 3), 9));
return i;
}
Word16 G7231G_code(Word16 X[], Word16 Y[], Word16 *gain_q)
{
Word16 i;
Word16 xy, yy, exp_xy, exp_yy, gain, gain_nq;
Word32 L_xy, L_yy;
Word16 dist, dist_min;
/* Scale down Y[] by 8 to avoid overflow */
for(i=0; i<G7231SubFrLen; i++)
Y[i] = G7231shr(Y[i], 3);
/* Compute scalar product <X[],Y[]> */
L_xy = 0L;
for(i=0; i<G7231SubFrLen; i++)
L_xy = G7231L_mac(L_xy, X[i], Y[i]);
exp_xy = G7231norm_l(L_xy);
xy = G7231extract_h( G7231L_shl(L_xy, exp_xy) );
if(xy <= 0)
{
gain = 0;
*gain_q =G7231FcbkGainTable[gain];
return(gain);
}
/* Compute scalar product <Y[],Y[]> */
L_yy = 0L;
for(i=0; i<G7231SubFrLen; i++)
L_yy = G7231L_mac(L_yy, Y[i], Y[i]);
exp_yy = G7231norm_l(L_yy);
yy = G7231extract_h( G7231L_shl(L_yy, exp_yy) );
/* compute gain = xy/yy */
xy = G7231shr(xy, 1); /* Be sure xy < yy */
gain_nq = G7231div_s( xy, yy);
i = G7231add(exp_xy, 5); /* Denormalization of division */
i = G7231sub(i, exp_yy);
gain_nq = G7231shr(gain_nq, i);
gain = (Word16) 0;
dist_min = G7231sub(gain_nq, G7231FcbkGainTable[0]);
dist_min = G7231abs_s(dist_min);
for ( i = 1; i <G7231NumOfGainLev ; i ++ ) {
dist = G7231sub(gain_nq, G7231FcbkGainTable[i]);
dist =G7231abs_s(dist);
if ( dist< dist_min) {
dist_min = dist;
gain = (Word16) i ;
}
}
*gain_q = G7231FcbkGainTable[gain];
return(gain);
}
Word16 G7231search_T0 ( Word16 T0, Word16 Gid, Word16 *gain_T0)
{
Word16 T0_mod;
T0_mod = T0+G7231epsi170[Gid];
*gain_T0 = G7231gain170[Gid];
return(T0_mod);
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -