分享：经典滤波算法（下）

软件滤波的C程序样例

11种软件滤波方法的示例程序

假定从8位AD中读取数据（如果是更高位的AD可定义数据类型为int),子程序为get_ad();

1、限副滤波

/* A值可根据实际情况调整

value为有效值， new_value为当前采样值

滤波程序返回有效的实际值 */

#defineA10

char value;

char filter()

{

char new_value;

new_value= get_ad();

if ((new_value -value >A)||(value -new_value> A)

returnvalue;

else returnnew_value;

}

2、中位值滤波法

/* N值可根据实际情况调整

排序采用冒泡法*/

#defineN 11

char filter()

{

char value_buf[N];

char count,i,j,temp;

for(count=0;count {

value_buf[count]=get_ad();

delay();

}

for(j=0;j<N-1;j++)//冒泡法

{

for(i=0;i<N-1-j;i++)

{

if (value_buf>value_buf[i+1] )

{

temp= value_buf;

value_buf =value_buf[i+1]

value_buf[i+1] =temp;

}

}

}

returnvalue_buf[(N-1)/2];

}

3、算术平均滤波法

/*

*/

#defineN12

char filter()

{

int sum =0;

for(count=0;count<N;count++)

{

sum += get_ad();

delay();

}

return(char)(sum/N);

}

4、递推平均滤波法（又称滑动平均滤波法）

/*

*/

#defineN12

char value_buf[N];

char i=0;

char filter(

{

char count;

int sum=0;

value_buf[i++]= get_ad();

if (i ==N) i =0;

for(count=0;count<N;count++) sum = value_buf[count];

return(char)(sum/N);

}

5、中位值平均滤波法（又称防脉冲干扰平均滤波法）

/*

*/

#defineN12

char filter()

{

char count,i,j;

char value_buf[N];

int sum=0;

for (count=0;count {

value_buf[count]=get_ad();

delay();

}

for(j=0;j<N-1;j++)//冒泡法

{

for(i=0;i<N-1-j;i++)

{

if (value_buf>value_buf[i+1] )

{

temp= value_buf;

value_buf =value_buf[i+1];

value_buf[i+1] =temp;

}

}

}

for(count=0;count<N;count++)sum = value_buf[count];

return(char)(sum/(N-2));

}

6、限幅平均滤波法
/*
*/
略 参考子程序1、 3
7、一阶滞后滤波法
/* 为加快程序处理速度假定基数为100， a=0~100*/
#definea50
char value;
char filter()
{
char new_value;
new_value= get_ad();
return(100-a)*value +a*new_value;
}

8、加权递推平均滤波法
/*coe数组为加权系数表，存在程序存储区。 */
#defineN12
char codecoe[N]={1,2,3,4,5,6,7,8,9,10,11,12};
char codesum_coe=1+2+3+4+5+6+7+8+9+10+11+12;
char filter()
{
char count;
char value_buf[N];
int sum=0;
for(count=0,count {
value_buf[count]=get_ad();
delay();
}
for(count=0;count<N;count++) sum = value_buf[count];
return(char)(sum/sum_coe);
}

9、消抖滤波法
#defineN12
char filter()
{
char count=0;
char new_value;
new_value= get_ad();
while (value!=new_value);
{
count++;
if (count>=N) returnnew_value;
delay();
new_value= get_ad();
}
returnvalue;
}
10、限幅消抖滤波法
/*
*/
略 参考子程序1、 9
11、 IIR滤波例子
int BandpassFilter4(int InputAD4)
{
int ReturnValue;
int ii;
RESLO=0;
RESHI=0;
MACS=*PdelIn;
OP2=1068;//FilterCoeff4[4];
MACS=*(PdelIn+1);
OP2=8; //FilterCoeff4[3];
MACS=*(PdelIn+2);
OP2=-2001;//FilterCoeff4[2];
MACS=*(PdelIn+3);
OP2=8; //FilterCoeff4[1];
MACS=InputAD4;
OP2=1068;//FilterCoeff4[0];
MACS=*PdelOu;
OP2=-7190;//FilterCoeff4[8];
MACS=*(PdelOu+1);
OP2=-1973; //FilterCoeff4[7];
MACS=*(PdelOu+2);
OP2=-19578;//FilterCoeff4[6];
MACS=*(PdelOu+3);
OP2=-3047; //FilterCoeff4[5];
*p=RESLO;
*(p+1)=RESHI;
mytestmul<<=2;
ReturnValue=*(p+1);
for (ii=0;ii<3;ii++)
{
DelayInput[ii]=DelayInput[ii+1];
DelayOutput[ii]=DelayOutput[ii+1];
}
DelayInput[3]=InputAD4;
DelayOutput[3]=ReturnValue;
// if (ReturnValue<0)
// {
// ReturnValue=-ReturnValue;
// }
returnReturnValue;