DSP C語言的IIR濾波器程序源碼

ID:209315 · 發表于 2018-8-8 16:32

分享個DSP C語言的IIR濾波器

單片機源程序如下:

#include <math.h>
#include <stdio.h>
#include "fdacoefs.h"
//*********************************************
//fs=1000000,fpass=10000,fstop=50000(-80db)
//butterworth iir-df1
//*********************************************
#define fs 1000000
#define f1 4000//測試正弦頻率1
#define f2 50000//測試正弦頻率2
#define f_rec 5000//測試方波頻率
#define Impulse 1
#define Sine 2
#define Rect 3
#define pi 3.1415926
#define STG_NUM (MWSPT_NSEC-1)/2
#define DAT_NUM 800
float IIR_out[DAT_NUM];
float input_step[STG_NUM+1][3];// n; n-1; n-2
void iir_filter_init(float *ptr,int num)
{
int i;
for(i=0;i<num;i++)
{
*ptr++=0;
}
}
float iir_filter(float in)
{
int i;
float temp;
input_step[0][0] = in;
for(i=0;i<STG_NUM;i++)
{
temp =NUM[i*2][0]*(input_step[i][0]*NUM[i*2+1][0]+input_step[i][1]*NUM[i*2+1][1]+input_step[i][2]*NUM[i*2+1][2])-
input_step[i+1][1]*DEN[i*2+1][1]-input_step[i+1][2]*DEN[i*2+1][2];
temp *= DEN[i*2+1][0];
input_step[i][2]=input_step[i][1];
input_step[i][1]=input_step[i][0];
input_step[i+1][0]=temp;
}
return temp*NUM[MWSPT_NSEC-1][0];
}
float x;
int main()
{
int i,Test_type;
printf("請選擇測試類型：1、沖擊測試 2、正弦測試 3、方波測試\n");
scanf("%d",&Test_type);
while(1){
iir_filter_init(input_step[0],sizeof(input_step)/sizeof(input_step[0][0]));
switch(Test_type)
{
case Rect://方波輸入
for(i=0;i<DAT_NUM;i++)
{
if(((2*f_rec*i/fs)%2)==0)
x=5000;
else
x=-5000;
IIR_out[i]=iir_filter(x);
}
break;
case Impulse://沖激輸入
IIR_out[0]=iir_filter(5000);
for(i=1;i<DAT_NUM;i++)
IIR_out[i]=iir_filter(0);
break;
case Sine://正弦輸入
for(i=0;i<DAT_NUM;i++)
{
//***************************************************************
x=500*(cos(2*pi*f1*i/fs)+cos(2*pi*f2*i/fs)); //正弦測試
IIR_out[i]=iir_filter(x);
}
break;
}
//請在printf前設置斷點，以便停止運行查看輸出結果否則，看不到輸出
printf("請選擇測試類型：1、沖擊測試 2、正弦測試 3、方波測試\n");
scanf("%d",&Test_type);
}
while(1);
}