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

流媒体/Mpeg4/MP4

开发平台:

Visual C++

  1. /**********************************************************************
  2. MPEG-4 Audio VM
  3. Common module
  4. This software module was originally developed by
  5. Bodo Teichmann (FhG)
  6. and edited by
  7. in the course of development of the MPEG-2 NBC/MPEG-4 Audio standard
  8. ISO/IEC 13818-7, 14496-1,2 and 3. This software module is an
  9. implementation of a part of one or more MPEG-2 NBC/MPEG-4 Audio tools
  10. as specified by the MPEG-2 NBC/MPEG-4 Audio standard. ISO/IEC gives
  11. users of the MPEG-2 NBC/MPEG-4 Audio standards free license to this
  12. software module or modifications thereof for use in hardware or
  13. software products claiming conformance to the MPEG-2 NBC/ MPEG-4 Audio
  14. standards. Those intending to use this software module in hardware or
  15. software products are advised that this use may infringe existing
  16. patents. The original developer of this software module and his/her
  17. company, the subsequent editors and their companies, and ISO/IEC have
  18. no liability for use of this software module or modifications thereof
  19. in an implementation. Copyright is not released for non MPEG-2
  20. NBC/MPEG-4 Audio conforming products. The original developer retains
  21. full right to use the code for his/her own purpose, assign or donate
  22. the code to a third party and to inhibit third party from using the
  23. code for non MPEG-2 NBC/MPEG-4 Audio conforming products. This
  24. copyright notice must be included in all copies or derivative works.
  25. Copyright (c) 1997.
  26. Source file: fir_filt.c
  27. $Id: fir_filt.c,v 1.2 2002/05/13 15:48:41 mvillari Exp $
  28. Authors:
  29. tmn       Bodo Teichmann mailto:tmn@iis.fhg.de
  30. Changes:
  31. **********************************************************************/
  32. #include <stdio.h>
  33. #include <stdlib.h>
  34. #include <string.h>
  35. #include "common_m4a.h"
  36. #include "fir_filt.h"
  37. static float fir48_4_120[] =
  38.   { -0.0000000000F, -0.0004061767F, -0.0006554074F, -0.0005603479F,
  39.     +0.0000000000F, +0.0010332072F, +0.0024067306F, +0.0038511274F,
  40.     +0.0049972718F, +0.0054446460F, +0.0048504364F, +0.0030230276F,
  41.     -0.0000000000F, -0.0039090311F, -0.0081300062F, -0.0118895363F,
  42.     -0.0143338396F, -0.0146862233F, -0.0124177060F, -0.0073988790F,
  43.     +0.0000000000F, +0.0088885044F, +0.0179316783F, +0.0255223974F,
  44.     +0.0300328067F, +0.0301098647F, +0.0249669378F, +0.0146174761F,
  45.     -0.0000000000F, -0.0170435762F, -0.0339530545F, -0.0477884869F,
  46.     -0.0556838859F, -0.0553529653F, -0.0455668957F, -0.0265189851F,
  47.     +0.0000000000F, +0.0306695549F, +0.0609699140F, +0.0857542392F,
  48.     +0.1000000000F, +0.0996415654F, +0.0823628662F, +0.0482228773F,
  49.     -0.0000000000F, -0.0568263967F, -0.1144916118F, -0.1637363938F,
  50.     -0.1948936008F, -0.1991420526F, -0.1697652726F, -0.1032409730F,
  51.     +0.0000000000F, +0.1352696593F, +0.2938416526F, +0.4636919170F,
  52.     +0.6306889405F, +0.7800976241F, +0.8982140690F, +0.9739261298F,
  53.     +1.0000000000F, +0.9739261298F, +0.8982140690F, +0.7800976241F,
  54.     +0.6306889405F, +0.4636919170F, +0.2938416526F, +0.1352696593F,
  55.     +0.0000000000F, -0.1032409730F, -0.1697652726F, -0.1991420526F,
  56.     -0.1948936008F, -0.1637363938F, -0.1144916118F, -0.0568263967F,
  57.     -0.0000000000F, +0.0482228773F, +0.0823628662F, +0.0996415654F,
  58.     +0.1000000000F, +0.0857542392F, +0.0609699140F, +0.0306695549F,
  59.     +0.0000000000F, -0.0265189851F, -0.0455668957F, -0.0553529653F,
  60.     -0.0556838859F, -0.0477884869F, -0.0339530545F, -0.0170435762F,
  61.     -0.0000000000F, +0.0146174761F, +0.0249669378F, +0.0301098647F,
  62.     +0.0300328067F, +0.0255223974F, +0.0179316783F, +0.0088885044F,
  63.     +0.0000000000F, -0.0073988790F, -0.0124177060F, -0.0146862233F,
  64.     -0.0143338396F, -0.0118895363F, -0.0081300062F, -0.0039090311F,
  65.     -0.0000000000F, +0.0030230276F, +0.0048504364F, +0.0054446460F,
  66.     +0.0049972718F, +0.0038511274F, +0.0024067306F, +0.0010332072F,
  67.     +0.0000000000F, -0.0005603479F, -0.0006554074F, -0.0004061767F,
  68.     -0.0000000000F,
  69.   };
  70. #define SCALE 0.128
  71. FIR_FILT *initFirLowPass(float stopBand,int taps)
  72. {
  73.   FIR_FILT *filter;
  74.   
  75.   filter = (FIR_FILT*)malloc(sizeof(FIR_FILT));
  76.   filter->filtLength=taps;
  77.   filter->memoryPtr = (float*)malloc(sizeof(float)*(taps+1));
  78.   filter->writeIdx =0 ;
  79.   filter->readIdx = taps;
  80.   if ((stopBand == 48000/4000)&& (taps == 120))
  81.     filter->filtPtr=fir48_4_120;
  82.   else 
  83.     CommonExit(-1,"nthis filter is not yet defined in fir_filt.c");
  84.   
  85.   return filter;
  86.     
  87. }
  88. void firLowPass(float* inBuffer,float *outBuffer,int no, FIR_FILT *filter )
  89.   int i,j,k;
  90.   float y;
  91.   for (j=0;j<no;j++) { 
  92.     filter->memoryPtr[(filter->readIdx)] = inBuffer[j];
  93.     filter->readIdx=(filter->readIdx + 1)%(filter->filtLength + 1);    
  94.     y = 0.0; 
  95.     k=0;
  96.     for (i = filter->writeIdx; i <= filter->filtLength ; i++) 
  97.       y += (filter->filtPtr[k++] * filter->memoryPtr[i]);
  98.     for (i = 0; i < filter->writeIdx; i++) 
  99.       y += (filter->filtPtr[k++] * filter->memoryPtr[i]);
  100.     filter->writeIdx=(filter->writeIdx+1)%(filter->filtLength+1);    
  101. #if 1 
  102.     outBuffer[j] = y*SCALE;
  103. #else 
  104.     outBuffer[j] = y;
  105. #endif
  106. #if 0
  107.     if ((long)(y*SCALE) != (short)(y*SCALE)){ 
  108.       fprintf(stderr,"nclipping!"); 
  109.       exit(-1);
  110.     }
  111. #endif
  112.   }
  113. }
  114. void subSampl(float * inBuff, float * outBuff,int factor,int *noOfSampl)
  115. {
  116.   int i ;
  117.   if ((*noOfSampl%6)!= 0)
  118.     CommonExit(-1,"n Error in downsampling");
  119.   else
  120.     *noOfSampl = *noOfSampl/6;
  121.   for (i=0;i< *noOfSampl;i++){
  122.     outBuff[i]=inBuff[i * factor];
  123.   }
  124. }