亲测有效的IIR数字滤波器C程序实现,输入与输出有明显的滤波效果,如图
输入时波形
输出时波形
附录(C程序源码):
- #include "DSP2833x_Device.h" // DSP2833x Headerfile Include File
- #include "DSP2833x_Examples.h" // DSP2833x Examples Include File
- #include <math.h>
- #define IIRNUMBER 2
- #define SIGNAL1F 1000
- #define SIGNAL2F 4500
- #define SAMPLEF 10000
- #define PI 3.1415926
- float InputWave();
- float IIR();
- float fBn[IIRNUMBER]={ 0.0,0.7757 };
- float fAn[IIRNUMBER]={ 0.1122,0.1122 };
- float fXn[IIRNUMBER]={ 0.0 };
- float fYn[IIRNUMBER]={ 0.0 };
- float fInput,fOutput;
- float fSignal1,fSignal2;
- float fStepSignal1,fStepSignal2;
- float f2PI;
- int i;
- float fin[256],fout[256];
- //输入fIn毛刺正弦波,输出fOut较光滑正弦波,Graph: 256,32-bit floating integer,
- int nIn,nOut;
- main()
- {
- nIn=0; nOut=0;
- fInput=fOutput=0;
- f2PI=2*PI;
- fSignal1=0.0;
- fSignal2=PI*0.1;
- // fStepSignal1=2*PI/30;
- // fStepSignal2=2*PI*1.4;
- fStepSignal1=2*PI/50;
- fStepSignal2=2*PI/2.5;
- while ( 1 )
- {
- fInput=InputWave();
- fin[nIn]=fInput;
- nIn++; nIn%=256;
- fOutput=IIR();
- fout[nOut]=fOutput;
- nOut++; // break point
- if ( nOut>=256 )
- {
- nOut=0;
- }
- }
- }
- float InputWave()
- {
- for ( i=IIRNUMBER-1;i>0;i-- )
- {
- fXn[i]=fXn[i-1];
- fYn[i]=fYn[i-1];
- }
- fXn[0]=sin((double)fSignal1)+cos((double)fSignal2)/6.0;
- fYn[0]=0.0;
- fSignal1+=fStepSignal1;
- if ( fSignal1>=f2PI ) fSignal1-=f2PI;
- fSignal2+=fStepSignal2;
- if ( fSignal2>=f2PI ) fSignal2-=f2PI;
- return(fXn[0]);
- }
- float IIR()
- {
- float fSum;
- fSum=0.0;
- for ( i=0;i<IIRNUMBER;i++ )
- {
- fSum+=(fXn[i]*fAn[i]);
- fSum+=(fYn[i]*fBn[i]);
- }
- return(fSum);
- }
复制代码
全部资料51hei下载地址:
IIR滤波C程序.docx
(13.53 KB, 下载次数: 84)
|