g7231_exc_lbc.c

G723.1语音压缩解压在tms320c54系列上的实现代码,本人已在CCS上仿真通过. 包含全部源代码,主函数请自已写(本人的就不奉送了:

    return;
}

G7231PFDEF G7231Comp_Lpf( Word16 *Buff, Word16 Olp, Word16 Sfc )
{
    int   i,j   ;

    G7231PFDEF Pf    ;
    Word32   Lcr[5] ;
    Word16   Scr[5] ;
    Word16   Bindx, Findx ;
    Word16   Exp ;

    Word32   Acc0,Acc1 ;

    /* Initialize */
    Pf.Indx = (Word16) 0 ;
    Pf.Gain = (Word16) 0 ;
    Pf.ScGn = (Word16) 0x7fff ;

    /* Find both indices */
    Bindx = G7231Find_B( Buff, Olp, Sfc ) ;
    Findx = G7231Find_F( Buff, Olp, Sfc ) ;

    /* Combine the results */
    if ( (Bindx == (Word16) 0) && (Findx == (Word16) 0) )
        return Pf ;

    /* Compute target energy */
    Acc0 = (Word32) 0 ;
    for ( j = 0 ; j < G7231SubFrLen ; j ++ )
        Acc0 = G7231L_mac( Acc0, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+j],
                                    Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+j] ) ;
    Lcr[0] = Acc0 ;

    if ( Bindx != (Word16) 0 ) {
        Acc0 = (Word32) 0 ;
        Acc1 = (Word32) 0 ;
        for ( j = 0 ; j < G7231SubFrLen ; j ++ ) {
            Acc0 = G7231L_mac( Acc0, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+j],
                        Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+(int)Bindx+j] ) ;
            Acc1 = G7231L_mac( Acc1, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+(int)Bindx+j],
                        Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+(int)Bindx+j] ) ;
        }
        Lcr[1] = Acc0 ;
        Lcr[2] = Acc1 ;
    }
    else {
        Lcr[1] = (Word32) 0 ;
        Lcr[2] = (Word32) 0 ;
    }

    if ( Findx != (Word16) 0 ) {
        Acc0 = (Word32) 0 ;
        Acc1 = (Word32) 0 ;
        for ( j = 0 ; j < G7231SubFrLen ; j ++ ) {
            Acc0 = G7231L_mac( Acc0, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+j],
                        Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+(int)Findx+j] ) ;
            Acc1 = G7231L_mac( Acc1, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+(int)Findx+j],
                        Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+(int)Findx+j] ) ;
        }
        Lcr[3] = Acc0 ;
        Lcr[4] = Acc1 ;
    }
    else {
        Lcr[3] = (Word32) 0 ;
        Lcr[4] = (Word32) 0 ;
    }

    /* Normalize and convert to shorts */
    Acc1 = 0L ;
    for ( i = 0 ; i < 5 ; i ++ ) {
        Acc0 = Lcr[i] ;
        if ( Acc0 > Acc1 )
            Acc1 = Acc0 ;
    }

    Exp = G7231norm_l( Acc1 ) ;
    for ( i = 0 ; i < 5 ; i ++ ) {
        Acc0 = G7231L_shl( Lcr[i], Exp ) ;
        Scr[i] = G7231extract_h( Acc0 ) ;
    }

    /* Select the best pair */
    if ( (Bindx != (Word16) 0) && ( Findx == (Word16) 0) )
        Pf = G7231Get_Ind( Bindx, Scr[0], Scr[1], Scr[2] ) ;

    if ( (Bindx == (Word16) 0) && ( Findx != (Word16) 0) )
        Pf = G7231Get_Ind( Findx, Scr[0], Scr[3], Scr[4] ) ;

    if ( (Bindx != (Word16) 0) && ( Findx != (Word16) 0) ) {
        Exp = G7231mult_r( Scr[1], Scr[1] ) ;
        Acc0 = G7231L_mult( Exp, Scr[4] ) ;
        Exp = G7231mult_r( Scr[3], Scr[3] ) ;
        Acc1 = G7231L_mult( Exp, Scr[2] ) ;
        if ( Acc0 > Acc1 )
            Pf = G7231Get_Ind( Bindx, Scr[0], Scr[1], Scr[2] ) ;
        else
            Pf = G7231Get_Ind( Findx, Scr[0], Scr[3], Scr[4] ) ;
    }

    return Pf ;
}

Word16   G7231Find_B( Word16 *Buff, Word16 Olp, Word16 Sfc )
{
    int   i,j   ;

    Word16   Indx = 0 ;

    Word32   Acc0,Acc1 ;

    if ( Olp > (Word16) (G7231PitchMax-3) )
        Olp = (Word16) (G7231PitchMax-3) ;

    Acc1 = (Word32) 0 ;

    for ( i = (int)Olp-3 ; i <= (int)Olp+3 ; i ++ ) {

        Acc0 = (Word32) 0 ;
        for ( j = 0 ; j < G7231SubFrLen ; j ++ )
            Acc0 = G7231L_mac( Acc0, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+j],
                                    Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen-i+j] ) ;
        if ( Acc0 > Acc1 ) {
            Acc1 = Acc0 ;
            Indx = -(Word16) i ;
        }
    }
    return Indx ;
}

Word16   G7231Find_F( Word16 *Buff, Word16 Olp, Word16 Sfc )
{
    int   i,j   ;

    Word16   Indx = 0 ;

    Word32   Acc0,Acc1 ;

    if ( Olp > (Word16) (G7231PitchMax-3) )
        Olp = (Word16) (G7231PitchMax-3) ;

    Acc1 = (Word32) 0 ;

    for ( i = Olp-3 ; i <= Olp+3 ; i ++ ) {

        Acc0 = (Word32) 0 ;
        if ( ((int)Sfc*G7231SubFrLen+G7231SubFrLen+i) <= G7231Frame ) {
            for ( j = 0 ; j < G7231SubFrLen ; j ++ )
                Acc0 = G7231L_mac( Acc0, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+j],
                            Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+i+j] ) ;
        }


        if ( Acc0 > Acc1 ) {
            Acc1 = Acc0 ;
            Indx = (Word16) i ;
        }
    }

    return Indx ;
}

G7231PFDEF G7231Get_Ind( Word16 Ind, Word16 Ten, Word16 Ccr, Word16 Enr )
{
    Word32   Acc0,Acc1 ;
    Word16   Exp   ;

    G7231PFDEF Pf ;


    Pf.Indx = Ind ;

    /* Check valid gain */
    Acc0 = G7231L_mult( Ten, Enr ) ;
    Acc0 = G7231L_shr( Acc0, (Word16) 2 ) ;
    Acc1 = G7231L_mult( Ccr, Ccr ) ;

    if ( Acc1 > Acc0 ) {

        if ( Ccr >= Enr )
            Pf.Gain = G7231LpfConstTable[(int)G7231DecStat.WrkRate] ;
        else 
        {

            Pf.Gain = G7231div_s( Ccr, Enr ) ;

            Pf.Gain = G7231mult( Pf.Gain, G7231LpfConstTable[(int)G7231DecStat.WrkRate] ) ;
        }
        /* Compute scaling gain */
        Acc0 = G7231L_deposit_h( Ten ) ;
        Acc0 = G7231L_shr( Acc0, (Word16) 1 ) ;
        Acc0 = G7231L_mac( Acc0, Ccr, Pf.Gain ) ;
        Exp  = G7231mult( Pf.Gain, Pf.Gain ) ;
        Acc1 = G7231L_mult( Enr, Exp ) ;
        Acc1 = G7231L_shr( Acc1, (Word16) 1 ) ;
        Acc0 = G7231L_add( Acc0, Acc1 ) ;
        Exp = G7231round( Acc0 ) ;

        Acc1 = G7231L_deposit_h( Ten ) ;
        Acc0 = G7231L_deposit_h( Exp ) ;
        Acc1 = G7231L_shr( Acc1, (Word16) 1 ) ;

        if ( Acc1 >= Acc0 )
            Exp = (Word16) 0x7fff ;
        else
            Exp = G7231div_l( Acc1, Exp ) ;

        Acc0 = G7231L_deposit_h( Exp ) ;
        Pf.ScGn = G7231Sqrt_lbc( Acc0 ) ;
    }
    else {
        Pf.Gain = (Word16) 0 ;
        Pf.ScGn = (Word16) 0x7fff ;
    }

    Pf.Gain = G7231mult( Pf.Gain, Pf.ScGn ) ;

    return Pf ;
}

void  G7231Filt_Lpf( Word16 *Tv, Word16 *Buff, G7231PFDEF Pf, Word16 Sfc )
{
    int   i  ;

    Word32   Acc0 ;

    for ( i = 0 ; i < G7231SubFrLen ; i ++ ) {
        Acc0 = G7231L_mult( Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+i], Pf.ScGn ) ;
        Acc0 = G7231L_mac( Acc0, Buff[G7231PitchMax+(int)Sfc*G7231SubFrLen+(int)Pf.Indx+i],
                                                                Pf.Gain ) ;
        Tv[(int)Sfc*G7231SubFrLen+i] = G7231round( Acc0 ) ;
    }

    return;
}

Word16  G7231ACELP_LBC_code(Word16 X[], Word16 h[], Word16 T0, Word16 code[],
        Word16 *ind_gain, Word16 *shift, Word16 *sign, Word16 gain_T0)
{
    Word16 i, index, gain_q;
    Word16 Dn[G7231SubFrLen2], tmp_code[G7231SubFrLen2];
    Word16 rr[G7231DIM_RR];

 /*
  * Include fixed-gain pitch contribution into impulse resp. h[]
  * Find correlations of h[] needed for the codebook search.
 */
    for (i = 0; i < G7231SubFrLen; i++)    /* Q13 -->  Q12*/
        h[i] = G7231shr(h[i], 1);

    if (T0 < G7231SubFrLen-2) {
        for (i = T0; i < G7231SubFrLen; i++)    /* h[i] += gain_T0*h[i-T0] */
        h[i] = G7231add(h[i], G7231mult(h[i-T0], gain_T0));
    }

    G7231Cor_h(h, rr);

 /*
  * Compute correlation of target vector with impulse response.
  */

    G7231Cor_h_X(h, X, Dn);

 /*
  * Find innovative codebook.
  * rr input matrix autocorrelation
  *    output filtered codeword
  */

    index = G7231D4i64_LBC(Dn, rr, h, tmp_code, rr, shift, sign);

 /*
  * Compute innovation vector gain.
  * Include fixed-gain pitch contribution into code[].
  */

    *ind_gain = G7231G_code(X, rr, &gain_q);

    for (i = 0; i < G7231SubFrLen; i++)   {
        code[i] = G7231i_mult(tmp_code[i], gain_q);
    }

    if(T0 < G7231SubFrLen-2)
        for (i = T0; i < G7231SubFrLen; i++)    /* code[i] += gain_T0*code[i-T0] */
            code[i] = G7231add(code[i], G7231mult(code[i-T0], gain_T0));


    return index;
}

void G7231Cor_h(Word16 *H, Word16 *rr)
{
    Word16 *rri0i0, *rri1i1, *rri2i2, *rri3i3;
    Word16 *rri0i1, *rri0i2, *rri0i3;
    Word16 *rri1i2, *rri1i3, *rri2i3;

    Word16 *p0, *p1, *p2, *p3;

    Word16 *ptr_hd, *ptr_hf, *ptr_h1, *ptr_h2;
    Word32 cor;
    Word16 i, k, ldec, l_fin_sup, l_fin_inf;
    Word16 h[G7231SubFrLen2];

    /* Scaling for maximum precision */

    cor = 0;
    for(i=0; i<G7231SubFrLen; i++)
        cor = G7231L_mac(cor, H[i], H[i]);

    if(G7231extract_h(cor) > 32000 ) {
        for(i=0; i<G7231SubFrLen; i++) h[i+4] = G7231shr(H[i], 1);
    }
    else {
        k = G7231norm_l(cor);
        k = G7231shr(k, 1);
        for(i=0; i<G7231SubFrLen; i++) h[i+4] = G7231shl(H[i], k);
    }

    for(i=0; i<4; i++) h[i] = 0;

    /* 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;

 /*
  * Compute rri0i0[], rri1i1[], rri2i2[] and rri3i3[]
  */

    p0 = rri0i0 + G7231NB_POS-1;   /* Init pointers to last position of rrixix[] */
    p1 = rri1i1 + G7231NB_POS-1;
    p2 = rri2i2 + G7231NB_POS-1;
    p3 = rri3i3 + G7231NB_POS-1;

    ptr_h1 = h;
    cor    = 0;
    for(i=0;  i<G7231NB_POS; i++) {
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        *p3-- = G7231extract_h(cor);

        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        *p2-- = G7231extract_h(cor);

        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        *p1-- = G7231extract_h(cor);

        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h1); ptr_h1++;
        *p0-- = G7231extract_h(cor);
    }


 /*
  * Compute elements of: rri0i1[], rri0i3[], rri1i2[] and rri2i3[]
  */

    l_fin_sup = G7231MSIZE-1;
    l_fin_inf = l_fin_sup-(Word16)1;
    ldec = G7231NB_POS+1;

    ptr_hd = h;
    ptr_hf = ptr_hd + 2;

    for(k=0; k<G7231NB_POS; k++) {

        p3 = rri2i3 + l_fin_sup;
        p2 = rri1i2 + l_fin_sup;
        p1 = rri0i1 + l_fin_sup;
        p0 = rri0i3 + l_fin_inf;
        cor = 0;
        ptr_h1 = ptr_hd;
        ptr_h2 =  ptr_hf;

        for(i=k+(Word16)1; i<G7231NB_POS; i++ ) {

            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);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p2 = G7231extract_h(cor);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p1 = G7231extract_h(cor);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p0 = G7231extract_h(cor);

            p3 -= ldec;
            p2 -= ldec;
            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);

        cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
        *p2 = G7231extract_h(cor);

        cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
        *p1 = G7231extract_h(cor);

        l_fin_sup -= G7231NB_POS;
        l_fin_inf--;
        ptr_hf += G7231STEP;
    }

 /*
  * Compute elements of: rri0i2[], rri1i3[]
  */

    ptr_hd = h;
    ptr_hf = ptr_hd + 4;
    l_fin_sup = G7231MSIZE-1;
    l_fin_inf = l_fin_sup-(Word16)1;
    for(k=0; k<G7231NB_POS; k++) {
        p3 = rri1i3 + l_fin_sup;
        p2 = rri0i2 + l_fin_sup;
        p1 = rri1i3 + l_fin_inf;
        p0 = rri0i2 + l_fin_inf;

        cor = 0;
        ptr_h1 = ptr_hd;
        ptr_h2 =  ptr_hf;
        for(i=k+(Word16)1; i<G7231NB_POS; i++ ) {
            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);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p2 = G7231extract_h(cor);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p1 = G7231extract_h(cor);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p0 = G7231extract_h(cor);

            p3 -= ldec;
            p2 -= ldec;
            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);

        cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
        cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
        *p2 = G7231extract_h(cor);


        l_fin_sup -= G7231NB_POS;
        l_fin_inf--;
        ptr_hf += G7231STEP;
    }

 /*
  * Compute elements of: rri0i1[], rri0i3[], rri1i2[] and rri2i3[]
  */

    ptr_hd = h;
    ptr_hf = ptr_hd + 6;
    l_fin_sup = G7231MSIZE-1;
    l_fin_inf = l_fin_sup-(Word16)1;
    for(k=0; k<G7231NB_POS; k++) {

        p3 = rri0i3 + l_fin_sup;
        p2 = rri2i3 + l_fin_inf;
        p1 = rri1i2 + l_fin_inf;
        p0 = rri0i1 + l_fin_inf;

        ptr_h1 = ptr_hd;
        ptr_h2 =  ptr_hf;
        cor = 0;
        for(i=k+(Word16)1; i<G7231NB_POS; i++ ) {

            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);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p2 = G7231extract_h(cor);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p1 = G7231extract_h(cor);

            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            cor = G7231L_mac(cor, *ptr_h1, *ptr_h2); ptr_h1++; ptr_h2++;
            *p0 = G7231extract_h(cor);

            p3 -= ldec;
            p2 -= ldec;