高通fir.cpp

数个关于滤波器的产生的C程序

 #include <math.h>
 #include <stdio.h>
 #define M 40
 #define pi 3.141592653589793
   //////////////////////////////////////////////////////////////
   // w为3dB截止频率;要求w<=1,1对应采样频率的一般;滤波器阶数n; //
   // b返回滤波器n+1个抽头系数;                                //
   // type整型变量标志位用于确定所选的窗函数                   //
   //   type: 1:  巴特利特(Bartlett)窗                         //
   //         2:  汉宁(Hanning)窗                              //
   //         3:  哈明(Hamming)窗                              //
   //         4:  布莱克曼(Blackman)窗                         //
   //         其他:矩形窗                                      //
   // 函数返回0为正常返回;返回-1为异常返回:原因w>=1 or w<=0    // 
   //////////////////////////////////////////////////////////////
 int fir4(float w,int n,float b[],int type)
 { int i;
   float alpha,m;

   if(w>=1||w<=0)
    { printf("\n W must be in the range of (0,pi]!\n");
      return(-1);
      }
   alpha=n/2.0;
   for(i=0; i<=(n+1)/2; i++)
    { //m=pi*(i-alpha);
      //if(m==0) b[i]=1-w;
      //else     b[i]=(sin(m)-sin(w*m))/m;
      m=pi*(i-alpha+1e-20);
      b[i]=(sin(m)-sin(w*m))/m;
      }
   alpha=pi/alpha;
   switch(type)
    { case 1 : for(i=0; i<=(n+1)/2; i++)
                  if(i<=n/2) b[i]*=i*alpha/pi;
                  else       b[i]*=2-i*alpha/pi;
               break;
      case 2 : for(i=0; i<=(n+1)/2; i++)
                  b[i]*=0.5*(1-cos(i*alpha));
               break;
      case 3 : for(i=0; i<=(n+1)/2; i++)
                  b[i]*=0.54-0.46*cos(i*alpha);
               break;
      case 4 : for(i=0; i<=(n+1)/2; i++)
                  b[i]*=0.42-0.50*cos(i*alpha)
                            +0.08*cos(2*i*alpha);
               break;
      default: {   };
      }
   for(i=(n+1)/2+1; i<=n; i++)
     b[i]=b[n-i];
   return(0);
   }

   void main( )
   { float b[M+1],w;
     int rtn,i;

     w=0.0215;
     rtn=fir1(w,M,b,3);
     printf("\n\n");
     if(rtn==0)
      for(i=0; i<=M; i++)
       printf("%.4f\t",b[i]);
       
     scanf("%f",&w);
     }