g7231_exc_lbc.c

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

#include "typedef.h"
#include "G7231_basop.h"
#include "G7231_cst_lbc.h"
#include "G7231_tab_lbc.h"
#include "G7231_lbccodec.h"
#include "G7231_util_lbc.h"
#include "G7231_exc_lbc.h"
#include "G7231_tame.h"
#include "G7231_util_cng.h"

#include "G7231_coder.h"
#include "G7231_decod.h"
#include "intrindefs.h"

Word16   G7231Estim_Pitch( Word16 *Dpnt, Word16 Start )
{
    int   i,j   ;

    Word32   Acc0,Acc1   ;

    Word16   Exp,Tmp  ;
    Word16   Ccr,Enr  ;

    Word16   Indx = (Word16) G7231PitchMin ;

    Word16   Mxp = (Word16) 30 ;
    Word16   Mcr = (Word16) 0x4000 ;
    Word16   Mnr = (Word16) 0x7fff ;

    Word16   Pr ;

    Pr = Start - (Word16)G7231PitchMin + (Word16)1 ;
    Acc1 = (Word32) 0 ;
    for ( j = 0 ; j < 2*G7231SubFrLen ; j ++ )
        Acc1 = G7231L_mac( Acc1, Dpnt[Pr+j], Dpnt[Pr+j] ) ;

    for ( i = G7231PitchMin ; i <= G7231PitchMax-3 ; i ++ ) {

        Pr = G7231sub( Pr, (Word16) 1 ) ;

        Acc1 = G7231L_msu( Acc1, Dpnt[Pr+2*G7231SubFrLen], Dpnt[Pr+2*G7231SubFrLen] ) ;
        Acc1 = G7231L_mac( Acc1, Dpnt[Pr], Dpnt[Pr] ) ;

        Acc0 = (Word32) 0 ;
        for ( j = 0 ; j < 2*G7231SubFrLen ; j ++ )
            Acc0 = G7231L_mac( Acc0, Dpnt[Start+j], Dpnt[Pr+j] ) ;

        if ( Acc0 > (Word32) 0 ) {

            Exp = G7231norm_l( Acc0 ) ;
            Acc0 = G7231L_shl( Acc0, Exp ) ;
            Exp = G7231shl( Exp, (Word16) 1 ) ;
            Ccr = G7231round( Acc0 ) ;
            Acc0 = G7231L_mult( Ccr, Ccr ) ;
            Ccr = G7231norm_l( Acc0 ) ;
            Acc0 = G7231L_shl( Acc0, Ccr ) ;
            Exp = G7231add( Exp, Ccr ) ;
            Ccr = G7231extract_h( Acc0 ) ;

            Acc0 = Acc1 ;
            Enr = G7231norm_l( Acc0 ) ;
            Acc0 = G7231L_shl( Acc0, Enr ) ;
            Exp = G7231sub( Exp, Enr ) ;
            Enr = G7231round( Acc0 ) ;

            if ( Ccr >= Enr ) {
                Exp = G7231sub( Exp, (Word16) 1 ) ;
                Ccr = G7231shr( Ccr, (Word16) 1 ) ;
            }

            if ( Exp <= Mxp ) {

                if ( (Exp+1) < Mxp ) {
                    Indx = (Word16) i ;
                    Mxp = Exp ;
                    Mcr = Ccr ;
                    Mnr = Enr ;
                    continue ;
                }

                if ( (Exp+1) == Mxp )
                    Tmp = G7231shr( Mcr, (Word16) 1 ) ;
                else
                    Tmp = Mcr ;

                Acc0 = G7231L_mult( Ccr, Mnr ) ;
                Acc0 = G7231L_msu( Acc0, Enr, Tmp ) ;
                if ( Acc0 > (Word32) 0 ) {

                    if ( ((Word16)i - Indx) < (Word16) G7231PitchMin ) {
                        Indx = (Word16) i ;
                        Mxp = Exp ;
                        Mcr = Ccr ;
                        Mnr = Enr ;
                    }

                    else {
                        Acc0 = G7231L_mult( Ccr, Mnr ) ;
                        Acc0 = G7231L_negate(G7231L_shr( Acc0, (Word16) 2 ) ) ;
                        Acc0 = G7231L_mac( Acc0, Ccr, Mnr ) ;
                        Acc0 = G7231L_msu( Acc0, Enr, Tmp ) ;
                        if ( Acc0 > (Word32) 0 ) {
                            Indx = (Word16) i ;
                            Mxp = Exp ;
                            Mcr = Ccr ;
                            Mnr = Enr ;
                        }
                    }
                }
            }
        }
    }

    return Indx ;
}

G7231PWDEF G7231Comp_Pw( Word16 *Dpnt, Word16 Start, Word16 Olp )
{

    int   i,j   ;

    Word32   Lcr[15] ;
    Word16   Scr[15] ;
    G7231PWDEF    Pw ;

    Word32   Acc0,Acc1   ;
    Word16   Exp   ;

    Word16   Ccr,Enr  ;
    Word16   Mcr,Mnr  ;

    Lcr[0] = (Word32) 0 ;
    for ( i = 0 ; i < G7231SubFrLen ; i ++ )
        Lcr[0] = G7231L_mac( Lcr[0], Dpnt[Start+i], Dpnt[Start+i] ) ;

    for ( i = 0 ; i <= 2*G7231PwRange ; i ++ ) {

        Acc1 = Acc0 = (Word32) 0 ;
        for ( j = 0 ; j < G7231SubFrLen ; j ++ ) {
            Acc0 = G7231L_mac( Acc0, Dpnt[Start+j],
                                            Dpnt[Start-(Olp-G7231PwRange+i)+j]) ;
            Acc1 = G7231L_mac( Acc1, Dpnt[Start-(Olp-G7231PwRange+i)+j],
                                            Dpnt[Start-(Olp-G7231PwRange+i)+j] ) ;
        }

        Lcr[2*i+1] = Acc1 ;
        Lcr[2*i+2] = Acc0 ;
    }

    Acc1 = (Word32) 0 ;
    for ( i = 0 ; i < 15 ; i ++ ) {
        Acc0 = Lcr[i] ;
        Acc0 = G7231L_abs( Acc0 ) ;
        if ( Acc0 > Acc1 )
            Acc1 = Acc0 ;
    }

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

    }

    Pw.Indx = (Word16) -1 ;
    Pw.Gain = (Word16) 0  ;

    Mcr = (Word16) 1 ;
    Mnr = (Word16) 0x7fff ;

    for ( i = 0 ; i <= 2*G7231PwRange ; i ++ ) {

        Enr = Scr[2*i+1] ;
        Ccr = Scr[2*i+2] ;

        if ( Ccr <= (Word16) 0 )
            continue ;

        Exp = G7231mult_r( Ccr, Ccr ) ;

        Acc0 = G7231L_mult( Exp, Mnr ) ;
        Acc0 = G7231L_msu ( Acc0, Enr, Mcr ) ;

        if ( Acc0 > (Word32) 0 ) {
            Mcr = Exp ;
            Mnr = Enr ;
            Pw.Indx = (Word16)i ;
        }
    }

    if ( Pw.Indx == -1 ) {
        Pw.Indx = Olp ;
        return Pw ;
    }

    Acc0 = G7231L_mult( Scr[0], Mnr ) ;
    Acc1 = Acc0 ;
    Acc0 = G7231L_shr( Acc0, (Word16) 2 ) ;
    Acc1 = G7231L_shr( Acc1, (Word16) 3 ) ;
    Acc0 = G7231L_add( Acc0, Acc1 ) ;
    Acc1 = G7231L_mult( Scr[2*Pw.Indx+2], Scr[2*Pw.Indx+2] ) ;
    Acc0 = G7231L_sub( Acc0, Acc1 ) ;

    if ( Acc0 < (Word32) 0 ) {

        Exp = Scr[2*Pw.Indx + 2] ;

        if ( Exp >= Mnr )
            Pw.Gain = G7231PwConst ;
        else 
        {

            Pw.Gain = G7231div_s( Exp, Mnr ) ;
           
            Pw.Gain = G7231mult_r( Pw.Gain, G7231PwConst ) ;
        }
    }

    Pw.Indx = Olp - G7231PwRange + Pw.Indx ;

    return Pw ;

}

void  G7231Filt_Pw( Word16 *DataBuff, Word16 *Dpnt, Word16 Start, G7231PWDEF Pw )
{
    int   i  ;

    Word32   Acc0 ;

    for ( i = 0 ; i < G7231SubFrLen ; i ++ ) {
        Acc0 = G7231L_deposit_h( Dpnt[G7231PitchMax+Start+i] ) ;
        Acc0 = G7231L_msu( Acc0, Pw.Gain, Dpnt[G7231PitchMax+Start-Pw.Indx+i] ) ;
        DataBuff[Start+(Word16)i] = G7231round( Acc0 ) ;
    }

    return;
}

void  G7231Find_Fcbk( Word16 *Dpnt, Word16 *ImpResp, G7231LINEDEF *Line, Word16 Sfc )
{
    int   i  ;
    Word16 T0_acelp, gain_T0;
    Word16   Srate ;


    G7231BESTDEF  Best ;

    switch(G7231CodStat.WrkRate)  {

        case Rate63: {

            Srate = G7231Nb_puls[(int)Sfc] ;
            Best.MaxErr = (Word32) 0xc0000000L ;
            G7231Find_Best( &Best, Dpnt, ImpResp, Srate, (Word16) G7231SubFrLen ) ;
            if ( (*Line).Olp[Sfc>>1] < (Word16) (G7231SubFrLen-2) ) {
                G7231Find_Best( &Best, Dpnt, ImpResp, Srate, (*Line).Olp[Sfc>>1]);
            }

            for ( i = 0 ; i <  G7231SubFrLen ; i ++ )
                Dpnt[i] = (Word16) 0 ;
            for ( i = 0 ; i < Srate ; i ++ )
                Dpnt[Best.Ploc[i]] = Best.Pamp[i] ;

            G7231Fcbk_Pack( Dpnt, &((*Line).Sfs[Sfc]), &Best, Srate ) ;

            if ( Best.UseTrn == (Word16) 1 )
                G7231Gen_Trn( Dpnt, Dpnt, (*Line).Olp[Sfc>>1] ) ;

            break;
        }

        case Rate53: {

            T0_acelp = G7231search_T0(
                    (Word16) ((*Line).Olp[Sfc>>1]-1+(*Line).Sfs[Sfc].AcLg),
                    (*Line).Sfs[Sfc].AcGn, &gain_T0 );

            (*Line).Sfs[Sfc].Ppos = G7231ACELP_LBC_code(
                    Dpnt, ImpResp, T0_acelp, Dpnt, &(*Line).Sfs[Sfc].Mamp,
                    &(*Line).Sfs[Sfc].Grid, &(*Line).Sfs[Sfc].Pamp, gain_T0 );

            (*Line).Sfs[Sfc].Tran = 0;

            break;
        }
    }

    return;
}

void  G7231Gen_Trn( Word16 *Dst, Word16 *Src, Word16 Olp )
{
    int   i  ;

    Word16   Tmp0,Tmp1   ;
    Word16   Tmp[G7231SubFrLen] ;

    Tmp0 = Olp ;

    for ( i = 0 ; i < G7231SubFrLen ; i ++ ) {
        Tmp[i] = Src[i] ;
        Dst[i] = Src[i] ;
    }

    while ( Tmp0 < G7231SubFrLen ) {
        for ( i = (int) Tmp0 ; i < G7231SubFrLen ; i ++ ) {
            Tmp1 = G7231add( Dst[i], Tmp[i-(int)Tmp0] ) ;
            Dst[i] = Tmp1 ;
        }
        Tmp0 = G7231add( Tmp0, Olp ) ;
    }

    return;
}

void  G7231Find_Best( G7231BESTDEF *Best, Word16 *Tv, Word16 *ImpResp, Word16 Np, Word16 Olp )
{

    int   i,j,k,l  ;
    G7231BESTDEF  Temp  ;

    Word16   Exp   ;
    Word16   MaxAmpId ;
    Word16   MaxAmp   ;
    Word32   Acc0,Acc1,Acc2 ;

    Word16   Imr[G7231SubFrLen]  ;
    Word16   OccPos[G7231SubFrLen] ;
    Word16   ImrCorr[G7231SubFrLen] ;
    Word32   ErrBlk[G7231SubFrLen] ;
    Word32   WrkBlk[G7231SubFrLen] ;


    if ( Olp < (Word16) (G7231SubFrLen-2) ) {
        Temp.UseTrn = (Word16) 1 ;
        G7231Gen_Trn( Imr, ImpResp, Olp ) ;
    }
    else {
        Temp.UseTrn = (Word16) 0 ;
        for ( i = 0 ; i < G7231SubFrLen ; i ++ )
            Imr[i] = ImpResp[i] ;
    }

    for ( i = 0 ; i < G7231SubFrLen ; i ++ )
        OccPos[i] = G7231shr( Imr[i], (Word16) 1 ) ;

    Acc0 = (Word32) 0 ;
    for ( i = 0 ; i < G7231SubFrLen ; i ++ )
        Acc0 = G7231L_mac( Acc0, OccPos[i], OccPos[i] ) ;

    Exp = G7231norm_l( Acc0 ) ;
    Acc0 = G7231L_shl( Acc0, Exp ) ;
    ImrCorr[0] = G7231round( Acc0 ) ;

    for ( i = 1 ; i < G7231SubFrLen ; i ++ ) {
        Acc0 = (Word32) 0 ;
        for ( j = i ; j < G7231SubFrLen ; j ++ )
            Acc0 = G7231L_mac( Acc0, OccPos[j], OccPos[j-i] ) ;
        Acc0 = G7231L_shl( Acc0, Exp ) ;
        ImrCorr[i] = G7231round( Acc0 ) ;
    }

    Exp = G7231sub( Exp, 4 ) ;
    for ( i = 0 ; i < G7231SubFrLen ; i ++ ) {
        Acc0 = (Word32) 0 ;
        for ( j = i ; j < G7231SubFrLen ; j ++ )
            Acc0 = G7231L_mac( Acc0, Tv[j], Imr[j-i] ) ;
        ErrBlk[i] = G7231L_shl( Acc0, Exp ) ;
    }

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

        Temp.GridId = (Word16) k ;

        Acc1 = (Word32) 0 ;
        for ( i = k ; i < G7231SubFrLen ; i += G7231Sgrid ) {
            Acc0 = G7231L_abs( ErrBlk[i] ) ;
            if ( Acc0 >= Acc1 ) {
                Acc1 = Acc0 ;
                Temp.Ploc[0] = (Word16) i ;
            }
        }

        Acc2 = Acc1 ;
        Acc1 = (Word32) 0x40000000L ;
        MaxAmpId = (Word16) (G7231NumOfGainLev - G7231MlqSteps) ;

        for ( i = MaxAmpId ; i >= G7231MlqSteps ; i -- ) {
            Acc0 = G7231L_mult( G7231FcbkGainTable[i], ImrCorr[0] ) ;
            Acc0 = G7231L_sub( Acc0, Acc2 ) ;
            Acc0 = G7231L_abs( Acc0 ) ;
            if ( Acc0 < Acc1 ) {
                Acc1 = Acc0 ;
                MaxAmpId = (Word16) i ;
            }
        }
        MaxAmpId -- ;

        for ( i = 1 ; i <=2*G7231MlqSteps ; i ++ ) {

            for ( j = k ; j < G7231SubFrLen ; j += G7231Sgrid ) {
                WrkBlk[j] = ErrBlk[j] ;
                OccPos[j] = (Word16) 0 ;
            }
            Temp.MampId = MaxAmpId - (Word16) G7231MlqSteps + (Word16) i ;

            MaxAmp = G7231FcbkGainTable[Temp.MampId] ;

            if ( WrkBlk[Temp.Ploc[0]] >= (Word32) 0 )
                Temp.Pamp[0] = MaxAmp ;
            else
                Temp.Pamp[0] = G7231negate(MaxAmp) ;

            OccPos[Temp.Ploc[0]] = (Word16) 1 ;

            for ( j = 1 ; j < Np ; j ++ ) {

                Acc1 = (Word32) 0xc0000000L ;

                for ( l = k ; l < G7231SubFrLen ; l += G7231Sgrid ) {

                    if ( OccPos[l] != (Word16) 0 )
                        continue ;

                    Acc0 = WrkBlk[l] ;
                    Acc0 = G7231L_msu( Acc0, Temp.Pamp[j-1],
                            ImrCorr[G7231abs_s((Word16)(l-Temp.Ploc[j-1]))] ) ;
                    WrkBlk[l] = Acc0 ;
                    Acc0 = G7231L_abs( Acc0 ) ;
                    if ( Acc0 > Acc1 ) {
                        Acc1 = Acc0 ;
                        Temp.Ploc[j] = (Word16) l ;
                    }
                }

                if ( WrkBlk[Temp.Ploc[j]] >= (Word32) 0 )
                    Temp.Pamp[j] = MaxAmp ;
                else
                    Temp.Pamp[j] = G7231negate(MaxAmp) ;

                OccPos[Temp.Ploc[j]] = (Word16) 1 ;
            }

            for ( j = 0 ; j < G7231SubFrLen ; j ++ )
                OccPos[j] = (Word16) 0 ;

            for ( j = 0 ; j < Np ; j ++ )
                OccPos[Temp.Ploc[j]] = Temp.Pamp[j] ;

            for ( l = G7231SubFrLen-1 ; l >= 0 ; l -- ) {
                Acc0 = (Word32) 0 ;
                for ( j = 0 ; j <= l ; j ++ )
                    Acc0 = G7231L_mac( Acc0, OccPos[j], Imr[l-j] ) ;
                Acc0 = G7231L_shl( Acc0, (Word16) 2 ) ;
                OccPos[l] = G7231extract_h( Acc0 ) ;
            }

            Acc1 = (Word32) 0 ;
            for ( j = 0 ; j < G7231SubFrLen ; j ++ ) {
                Acc1 = G7231L_mac( Acc1, Tv[j], OccPos[j] ) ;
                Acc0 = G7231L_mult( OccPos[j], OccPos[j] ) ;
                Acc1 = G7231L_sub( Acc1, G7231L_shr( Acc0, (Word16) 1 ) ) ;
            }

            if ( Acc1 > (*Best).MaxErr ) {
                (*Best).MaxErr = Acc1 ;
                (*Best).GridId = Temp.GridId ;
                (*Best).MampId = Temp.MampId ;
                (*Best).UseTrn = Temp.UseTrn ;
                for ( j = 0 ; j < Np ; j ++ ) {
                    (*Best).Pamp[j] = Temp.Pamp[j] ;
                    (*Best).Ploc[j] = Temp.Ploc[j] ;
                }
            }
        }
    }
    return;
}

void  G7231Fcbk_Pack( Word16 *Dpnt, G7231SFSDEF *Sfs, G7231BESTDEF *Best, Word16 Np )
{
    int   i,j   ;

    j = G7231MaxPulseNum - (int) Np ;

    (*Sfs).Pamp = (Word16) 0 ;
    (*Sfs).Ppos = (Word32) 0 ;

    for ( i = 0 ; i < G7231SubFrLen/G7231Sgrid ; i ++ ) {

        if ( Dpnt[(int)(*Best).GridId + G7231Sgrid*i] == (Word16) 0 )
            (*Sfs).Ppos = G7231L_add( (*Sfs).Ppos, G7231CombinatorialTable[j][i] ) ;
        else {
            (*Sfs).Pamp = G7231shl( (*Sfs).Pamp, (Word16) 1 ) ;
            if ( Dpnt[(int)(*Best).GridId + G7231Sgrid*i] < (Word16) 0 )
                (*Sfs).Pamp = G7231add( (*Sfs).Pamp, (Word16) 1 ) ;

            j ++ ;
            if ( j == G7231MaxPulseNum )
                break ;
        }
    }

    (*Sfs).Mamp = (*Best).MampId ;
    (*Sfs).Grid = (*Best).GridId ;
    (*Sfs).Tran = (*Best).UseTrn ;

    return;
}

void  G7231Fcbk_Unpk_En( Word16 *Tv, G7231SFSDEF Sfs, Word16 Olp, Word16 Sfc )
{
    int   i,j   ;

    Word32   Acc0  ;