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

流媒体/Mpeg4/MP4

开发平台:

Visual C++

  1. /*====================================================================*/
  2. /*         MPEG-4 Audio (ISO/IEC 14496-3) Copyright Header            */
  3. /*====================================================================*/
  4. /*
  5. This software module was originally developed by Rakesh Taori and Andy
  6. Gerrits (Philips Research Laboratories, Eindhoven, The Netherlands) in
  7. the course of development of the MPEG-4 Audio (ISO/IEC 14496-3). This
  8. software module is an implementation of a part of one or more MPEG-4
  9. Audio (ISO/IEC 14496-3) tools as specified by the MPEG-4 Audio
  10. (ISO/IEC 14496-3). ISO/IEC gives users of the MPEG-4 Audio (ISO/IEC
  11. 14496-3) free license to this software module or modifications thereof
  12. for use in hardware or software products claiming conformance to the
  13. MPEG-4 Audio (ISO/IEC 14496-3). Those intending to use this software
  14. module in hardware or software products are advised that its use may
  15. infringe existing patents. The original developer of this software
  16. module and his/her company, the subsequent editors and their
  17. companies, and ISO/IEC have no liability for use of this software
  18. module or modifications thereof in an implementation. Copyright is not
  19. released for non MPEG-4 Audio (ISO/IEC 14496-3) conforming products.
  20. CN1 retains full right to use the code for his/her own purpose, assign
  21. or donate the code to a third party and to inhibit third parties from
  22. using the code for non MPEG-4 Audio (ISO/IEC 14496-3) conforming
  23. products.  This copyright notice must be included in all copies or
  24. derivative works. Copyright 1996.
  25. */
  26. /*====================================================================*/
  27. /*======================================================================*/
  28. /*                                                                      */
  29. /*      SOURCE_FILE:    PHI_POST.C                                      */
  30. /*      PACKAGE:        WDBxx                                           */
  31. /*      COMPONENT:      Post-processing Module                          */
  32. /*                                                                      */
  33. /*======================================================================*/
  34. /*======================================================================*/
  35. /*      I N C L U D E S                                                 */
  36. /*======================================================================*/
  37. #include <stdio.h>
  38. #include <stdlib.h>
  39. #include <math.h>
  40. #include "phi_post.h"
  41. #include "bitstream.h"
  42. /*======================================================================*/
  43. /*     L O C A L     D A T A     D E F I N I T I O N S                  */
  44. /*======================================================================*/
  45. /*======================================================================*/
  46. /* Function Definition: PHI_InitPostProcessor                           */
  47. /*======================================================================*/
  48. void                            /* Return Value: Void                   */
  49. PHI_InitPostProcessor
  50. (
  51. const long lpc_order,            /* In: Order of LPC                     */
  52. PHI_PRIV_TYPE *PHI_Priv         /* In/Out: private data (instance context)*/
  53. )
  54. {
  55.     int k;
  56.     
  57.     /* -----------------------------------------------------------------*/
  58.     /* Create Arrays for delay line(s)                                  */
  59.     /* -----------------------------------------------------------------*/
  60.     if
  61.     (
  62.     (( PHI_Priv->PHI_g1 = (float *)malloc((unsigned int)lpc_order * sizeof(float))) == NULL ) ||
  63.     (( PHI_Priv->PHI_g2 = (float *)malloc((unsigned int)lpc_order * sizeof(float))) == NULL ) ||
  64.     (( PHI_Priv->PHI_P1_states = (float *)malloc((unsigned int)lpc_order * sizeof(float))) == NULL )||
  65.     (( PHI_Priv->PHI_P2_states = (float *)malloc((unsigned int)lpc_order * sizeof(float))) == NULL )
  66.     )
  67.     {
  68.         printf("MALLOC FAILURE in Routine InitPostProcessor n");
  69.         exit(1);
  70.     }
  71.     /* -----------------------------------------------------------------*/
  72.     /* Initialise Arrays for delay line(s)                              */
  73.     /* -----------------------------------------------------------------*/
  74.     for (k = 0; k < (int)lpc_order; k++)
  75.     {
  76.          PHI_Priv->PHI_P1_states[k] = PHI_Priv->PHI_P2_states[k] = (float)0.0;
  77.     }
  78.     PHI_Priv->PHI_Gpf = PHI_Priv->PHI_P3_state = (float)0.0;
  79.     
  80.     /* -----------------------------------------------------------------*/
  81.     /* Initialise Gamma Arrys of the postfilter                         */
  82.     /* -----------------------------------------------------------------*/
  83.     for(PHI_Priv->PHI_g1[0] = (float)0.65, PHI_Priv->PHI_g2[0] = (float)0.75, k = 1; k < (int)lpc_order; k++)
  84.     {
  85.         PHI_Priv->PHI_g1[k]  = (float)0.65 * PHI_Priv->PHI_g1[k-1];
  86.         PHI_Priv->PHI_g2[k]  = (float)0.75 * PHI_Priv->PHI_g2[k-1];
  87.     }
  88.    
  89. }
  90. /*======================================================================*/
  91. /* Function Definition: PHI_ClosePostProcessor                          */
  92. /*======================================================================*/
  93. void                            /* Return Value: Void                   */
  94. PHI_ClosePostProcessor
  95. (
  96. PHI_PRIV_TYPE *PHI_Priv         /* In/Out: private data (instance context)*/
  97. )
  98. {
  99.    FREE (PHI_Priv->PHI_P1_states);
  100.    FREE (PHI_Priv->PHI_P2_states);
  101.    FREE (PHI_Priv->PHI_g1);
  102.    FREE (PHI_Priv->PHI_g2);
  103. }
  104. /*======================================================================*/
  105. /* Function Definition: celp_postprocessing                             */
  106. /*======================================================================*/
  107. void                            /* Return Value: Void                   */
  108. celp_postprocessing
  109. (
  110. const float synth_signal[],          /*In:  Input sig [0..sbfrm_size -1]*/
  111.       float PP_synth_signal[],       /*Out: Postprocessed ooutput       */
  112. const float int_Qlpc_coefficients[], /*In:  Decoded LPC coefficients    */  
  113. const long  lpc_order,               /*In:  Order of LPC                */
  114. const long  sbfrm_size,              /*In:  #Samps to be processed      */
  115. const long  acb_delay,               /*In:  Pitch-like information      */
  116. const float adaptive_gain,            /*In:  DON'T KNOW WHY IT IS NEEDED */
  117. PHI_PRIV_TYPE *PHI_Priv         /* In/Out: private data (instance context)*/
  118. )
  119. {
  120.     int   nnn     = (int)sbfrm_size;
  121.     const float *in_ptr = synth_signal;
  122.     float *out    = PP_synth_signal; 
  123.     int k;
  124.     
  125.     /* -------------------------------------------------------------*/
  126.     /* Begin Post-processing                                        */
  127.     /* -------------------------------------------------------------*/
  128.     do
  129.     {
  130.         float tmp          = *in_ptr;
  131.         const float *ap_q  = int_Qlpc_coefficients;
  132.         float *PHI_g1_ptr  = PHI_Priv->PHI_g1;
  133.         float *PHI_g2_ptr  = PHI_Priv->PHI_g2;
  134.         for(k = 0; k < (int)lpc_order; k++)
  135.         {
  136.             tmp = tmp - (PHI_Priv->PHI_P1_states[k] * *PHI_g1_ptr++ - PHI_Priv->PHI_P2_states[k] * *PHI_g2_ptr++) * *ap_q++;
  137.         }
  138.         *out++ = PHI_Priv->PHI_Gpf * (tmp - (float)0.3 * PHI_Priv->PHI_P3_state);
  139.         PHI_Priv->PHI_P3_state = tmp;
  140.         for(k = (int)lpc_order - 1; k > 0; k--)
  141.         {
  142.             PHI_Priv->PHI_P1_states[k] = PHI_Priv->PHI_P1_states[k-1];
  143.             PHI_Priv->PHI_P2_states[k] = PHI_Priv->PHI_P2_states[k-1];
  144.         }
  145.         PHI_Priv->PHI_P1_states[0] = *in_ptr++;
  146.         PHI_Priv->PHI_P2_states[0] = tmp;
  147.     }
  148.     while(--nnn);
  149.     /* -------------------------------------------------------------*/
  150.     /* Update PHI_Gpf  Borrowed from Friedhelm's report -II pp.29   */
  151.     /* -------------------------------------------------------------*/
  152.     {
  153.         float pwr1 = (float)0.0;
  154.         float pwr2 = (float)0.0;
  155.         float r    = (float)1.0;
  156.         int   nnn;
  157.         for(nnn = 0; nnn < (int)sbfrm_size; nnn++)
  158.         {
  159.             float ss = synth_signal[nnn];
  160.             float sy = PP_synth_signal[nnn];
  161.             
  162.             if (fabs((double)(ss + sy)) > 1e-17)
  163.             {
  164.                 pwr1 += (ss * ss);
  165.                 pwr2 += (sy * sy);
  166.             }
  167.         }
  168.         if (pwr2 > (float)0.0)
  169.         {
  170.             r = (float)sqrt((double)pwr1/(double)pwr2);
  171.         }
  172.         PHI_Priv->PHI_Gpf = (((float)1.0 - (float)0.0625) * PHI_Priv->PHI_Gpf) + ((float)0.0625 * r);
  173.     }
  174. }
  175. /*======================================================================*/
  176. /*      H I S T O R Y                                                   */
  177. /*======================================================================*/
  178. /* 08-08-96 R. Taori  Initial Version                                   */