（完整版）经典滤波算法及C语言程序

【电子设计吧】DEMOK_DEVICE 软件滤波的C程序样例

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

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

1、限副滤波

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

value为有效值，new_value为当前采样值 滤波程序返回有效的实际值 */ #define A 10

char value;

char filter() {

char new_value; new_value = get_ad();

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

else return new_value; }

2、中位值滤波法

/* N值可根据实际情况调整 排序采用冒泡法*/ #define N 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

for (i=0;i

if ( value_buf[i]>value_buf[i+1] ) {

temp = value_buf[i];

value_buf [i]= value_buf[i+1]; value_buf[i+1] = temp; } }

【电子设计吧】DEMOK_DEVICE }

return value_buf[(N-1)/2]; }

3、算术平均滤波法

/* */

#define N 12

char filter() {

int sum = 0;

for ( count=0;count

sum + = get_ad(); delay(); }

return (char)(sum/N); }

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

/* */

#define N 12

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

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

/* */

#define N 12

char filter() {

char count,i,j;

char value_buf[N];

【电子设计吧】DEMOK_DEVICE int sum=0;

for (count=0;count {

value_buf[count] = get_ad(); delay(); }

for (j=0;j

for (i=0;i

if ( value_buf[i]>value_buf[i+1] ) {

temp = value_buf[i];

value_buf [i]= value_buf[i+1]; value_buf[i+1] = temp; } } }

for ( count=0;count

6、限幅平均滤波法

/* */

略 参考子程序1、3

7、一阶滞后滤波法

/* 为加快程序处理速度假定基数为100，a=0~100 */

#define a 50

char value;

char filter() {

char new_value; new_value = get_ad();

return (100-a)*value + a*new_value; }

8、加权递推平均滤波法

/* coe数组为加权系数表，存在程序存储区。*/

#define N 12

char code coe[N] = {1,2,3,4,5,6,7,8,9,10,11,12};

【电子设计吧】DEMOK_DEVICE char code sum_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

9、消抖滤波法

#define N 12

char filter() {

char count=0; char new_value;

new_value = get_ad();

while (value !=new_value); {

count++;

if (count>=N) return new_value; delay();

new_value = get_ad(); }

return value; }

10、限幅消抖滤波法

/* */

略 参考子程序1、9

11、IIR滤波例子

int BandpassFilter4(int InputAD4) {

int ReturnValue; int ii; RESLO=0; RESHI=0;

MACS=*PdelIn;

【电子设计吧】DEMOK_DEVICE 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; // }

return ReturnValue; }