att_abs_postp.c
上传用户:sun1608
上传日期:2007-02-02
资源大小:6116k
文件大小:4k
源码类别:

流媒体/Mpeg4/MP4

开发平台:

Visual C++

  1. /*
  2.  * Pitch/ Pole/Zero/Tilt postfilter
  3.  *
  4. This software module was originally developed by
  5. Peter Kroon (Bell Laboratories, Lucent Technologies)
  6. in the course of development of the MPEG-2 NBC/MPEG-4 Audio standard
  7. ISO/IEC 13818-7, 14496-1,2 and 3. This software module is an
  8. implementation of a part of one or more MPEG-2 NBC/MPEG-4 Audio tools
  9. as specified by the MPEG-2 NBC/MPEG-4 Audio standard. ISO/IEC gives
  10. users of the MPEG-2 NBC/MPEG-4 Audio standards free license to this
  11. software module or modifications thereof for use in hardware or
  12. software products claiming conformance to the MPEG-2 NBC/ MPEG-4 Audio
  13. standards. Those intending to use this software module in hardware or
  14. software products are advised that this use may infringe existing
  15. patents. The original developer of this software module and his/her
  16. company, the subsequent editors and their companies, and ISO/IEC have
  17. no liability for use of this software module or modifications thereof
  18. in an implementation. Copyright is not released for non MPEG-2
  19. NBC/MPEG-4 Audio conforming products. The original developer retains
  20. full right to use the code for his/her own purpose, assign or donate
  21. the code to a third party and to inhibit third party from using the
  22. code for non MPEG-2 NBC/MPEG-4 Audio conforming products. This
  23. copyright notice must be included in all copies or derivative works.
  24. Copyright (c) 1996.
  25.  * Last modified: May 1, 1996
  26.  *
  27.  * Modified July 1, 1996
  28.  *    changed a[1]->a[order] to a[0]->a[order-1]
  29.  */
  30. #include <stdio.h>
  31. #include <math.h>
  32. #include "att_proto.h"
  33. /* according to the VM, the following parameters are fixed. However, for
  34.  * optimal performance they should be definable for different applications
  35.  * 
  36.  */
  37. #define ALPHA 0.55 /* weight factor numerator */
  38. #define BETA  0.70 /* weight factor denominator  */
  39. #define MU 0.25 /* weight factor high-frequency tilt */
  40. #define AGCFAC 0.95 /* smoothing filter coefficient */
  41. #define MAXORDER 20 /* maxorder for LPC */
  42. void att_abs_postprocessing( 
  43.  float *input, /* input : signal */
  44.  float *output, /* output: signal */
  45.  float *a, /* input : lpc coefficients 1 + a1z^-1 + a2 */
  46.  long order, /* input : lpc order */
  47.  long len, /* input : frame size */
  48.  long acb_delay, /* input : delay (samples) for pitch postfilter  */
  49.  float acb_gain /* input : adaptive codebook gain */
  50. )
  51. {
  52.   static long firstcall=0;
  53.    float ax[MAXORDER+1]; /* weighted FIR coefficients */
  54.    float bx[MAXORDER+1]; /* weighted IIR coefficients */
  55.    static float firmem[MAXORDER];
  56.    static float iirmem[MAXORDER];
  57.    static float scalefil;
  58.    static float tmem;
  59.    static float alpha=ALPHA;
  60.    static float beta=BETA;
  61.    static float mu=MU;
  62.    float scale;
  63.    float ein;
  64.    float eout;
  65.    float rx;
  66.    float xtmp;
  67.    long i;
  68.    float rc0, c0, c1;
  69.    static float pre_rc0;
  70.    if (firstcall == 0) { /* initialization */
  71.      for (i=0; i< order ; i++){
  72.        firmem[i] = 0.;
  73.        iirmem[i] = 0.;
  74.      }
  75.      tmem = 0.;
  76.      scalefil=0.;
  77.      firstcall = 1;
  78.    } /* else { */
  79.    
  80.      /* postfilter for spectral envelope */
  81.      bwx( ax, a, alpha, order);
  82.      
  83.  /* Revised 07/01/96  Because a[] is chenged a[1]->a[10] to a[0]->a[9] */
  84.  for(i=order;i>0;i--) ax[i] = ax[i-1];
  85.  ax[0] = 1.;
  86.      firfilt( output, input, ax, firmem, order, len);
  87.      bwx( bx, a, beta, order);
  88.  for(i=order;i>0;i--) bx[i] = bx[i-1];
  89.  bx[0] = 1.;
  90.      iirfilt( output, output, bx, iirmem, order, len);
  91.      /* spectral tilt compensation */
  92.      c0 = 0.0;
  93.      for ( i = 0; i < len; i++ ) c0 += input[i]*input[i];
  94.      c1 = 0.0;
  95.      for ( i = 1; i < len; i++ ) c1 += input[i-1]*input[i];
  96.      rc0 = (c0 == 0.0) ? 0.0 : c1/c0;
  97.      rc0 = 0.75 * pre_rc0 + 0.25 * rc0;
  98.      pre_rc0 = rc0;
  99.      rx = mu * rc0;
  100.  ein = 0.0001;
  101.      eout = 0.0001;
  102.      for (i=0; i< len; i++){
  103.        ein += input[i] * input[i];
  104.        xtmp = output[i];
  105.    output[i] = output[i] - rx * tmem;
  106.    tmem = xtmp;
  107.        eout += output[i]*output[i];
  108.      }
  109.      if (eout > 1.) {
  110.        scale = sqrt( ein / eout);
  111.      } else
  112.        scale = 1.0;
  113.      
  114.      /* actual amplitude correction */
  115.      for (i=0; i< len; i++){
  116.        scalefil = AGCFAC * scalefil + ( 1. - AGCFAC) * scale;
  117.        output[i] = output[i] * scalefil;
  118.      }
  119. }