www.pudn.com > source.rar > LPCFUNC.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 : LPCFUNC.C 
 Used for the floating point version of G.729 main body 
 (not for G.729A) 
*/ 
#include  
#include "typedef.h" 
#include "ld8k.h" 
#include "tab_ld8k.h" 
 
/* local function */ 
static void  get_lsp_pol(FLOAT lsf[],FLOAT f[]); 
static void  lsp_az(FLOAT *lsp, FLOAT *a); 
 
/*----------------------------------------------------------------------------- 
 * lsp_az - convert LSPs to predictor coefficients a[] 
 *----------------------------------------------------------------------------- 
 */ 
static void lsp_az( 
 FLOAT *lsp,            /* input : lsp[0:M-1] */ 
 FLOAT *a               /* output: predictor coeffs a[0:M], a[0] = 1. */ 
) 
{ 
 
  FLOAT f1[NC+1], f2[NC+1]; 
  int i,j; 
 
 
  get_lsp_pol(&lsp[0],f1); 
  get_lsp_pol(&lsp[1],f2); 
 
  for (i = NC; i > 0; i--) 
  { 
    f1[i] += f1[i-1]; 
    f2[i] -= f2[i-1]; 
  } 
  a[0] = (F)1.0; 
  for (i = 1, j = M; i <= NC; i++, j--) 
  { 
    a[i] = (F)0.5*(f1[i] + f2[i]); 
    a[j] = (F)0.5*(f1[i] - f2[i]); 
  } 
 
  return; 
} 
 
 
/*---------------------------------------------------------------------------- 
 * get_lsp_pol - find the polynomial F1(z) or F2(z) from the LSFs 
 *---------------------------------------------------------------------------- 
 */ 
static void get_lsp_pol( 
   FLOAT lsp[],           /* input : line spectral freq. (cosine domain)  */ 
   FLOAT f[]              /* output: the coefficients of F1 or F2 */ 
) 
{ 
  FLOAT b; 
  int   i,j; 
 
  f[0] = (F)1.0; 
  b = (F)-2.0*lsp[0]; 
  f[1] = b; 
  for (i = 2; i <= NC; i++) 
  { 
    b = (F)-2.0*lsp[2*i-2]; 
    f[i] = b*f[i-1] + (F)2.0*f[i-2]; 
    for (j = i-1; j > 1; j--) 
      f[j] += b*f[j-1] + f[j-2]; 
    f[1] += b; 
  } 
  return; 
} 
 
/*---------------------------------------------------------------------------- 
 * lsf_lsp - convert from lsf[0..M-1 to lsp[0..M-1] 
 *---------------------------------------------------------------------------- 
 */ 
void lsf_lsp( 
 FLOAT lsf[],          /* input :  lsf */ 
 FLOAT lsp[M],          /* output: lsp */ 
 int m 
) 
{ 
    int     i; 
    for ( i = 0; i < m; i++ ) 
        lsp[i] = (FLOAT)cos((double)lsf[i]); 
    return; 
} 
 
/*---------------------------------------------------------------------------- 
 * lsp_lsf - convert from lsp[0..M-1 to lsf[0..M-1] 
 *---------------------------------------------------------------------------- 
 */ 
void lsp_lsf( 
 FLOAT lsp[],          /* input :  lsp coefficients */ 
 FLOAT lsf[],          /* output:  lsf (normalized frequencies */ 
 int m 
) 
{ 
    int     i; 
 
    for ( i = 0; i < m; i++ ) 
        lsf[i] = (FLOAT)acos((double)lsp[i]); 
    return; 
} 
 
 
/*--------------------------------------------------------------------------- 
 * weigh_az:  Weighting of LPC coefficients  ap[i]  =  a[i] * (gamma ** i) 
 *--------------------------------------------------------------------------- 
 */ 
void weight_az( 
 FLOAT *a,              /* input : lpc coefficients a[0:m] */ 
 FLOAT gamma,           /* input : weighting factor */ 
 int m,                  /* input : filter order */ 
 FLOAT *ap             /* output: weighted coefficients ap[0:m] */ 
 
) 
{ 
    FLOAT fac; 
    int i; 
 
    ap[0] = a[0]; 
    fac = gamma; 
    for (i = 1; i