发布时间 : 星期一 文章(完整版)经典滤波算法及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; }