单片机 10种软件滤波方法的示例程序
單片機學習筆記_10種軟件濾波方法的示例程序
假定從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;
? ? ? ?return new_value;
}
2、中位值濾波法
/* ?N值可根據實際情況調整
? ? 排序采用冒泡法*/
#define N ?11
char filter()
{
char value_buf[N];
? char count,i,j,temp;
? for ( count=0; count<N ? ?; count++)
? {
? ? value_buf[count] = get_ad();
? ? delay();
? }
? for (j=0; j <N ?; j++)
? {
? ? for (i=0; i < N-1 ; 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;
? ? ? }
? ? }
? }
? return value_buf[(N-1)/2];
}
3、算術平均濾波法
/*
*/
#define N 12
char filter()
{
? int ?sum = 0;
? for ( count=0; count<N ; 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<N ? ; count++)
? ? sum += value_buf[count];
? return (char)(sum/N);
}
5、中位值平均濾波法(又稱防脈沖干擾平均濾波法)
/*
*/
#define N 12
char filter()
{
? char count,i,j;
? char value_buf[N];
? int ?sum=0;
? for ?(count=0; count < N ?; count++)
? {
? ? value_buf[count] = get_ad();
? ? delay();
? }
??
??
? for (j=0; j < N ; j++)
? {
? ? for (i=0; i < N-1 ; i++)
? ? {
? ? ? if ( value_buf>value_buf[i+1] )
? ? ? {
? ? ? ? temp = value_buf;
? ? ? ? value_buf = value_buf[i+1];
? ? ? ? value_buf[i+1] = temp;
? ? ? }
? ? }
? }
? for(count=1; count<N ?; count++)
? ? sum += value[count];
? return (char)(sum/(N-2));
}
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};
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 < N ?; count++)
? {
? ? value_buf[count] = get_ad();
? ? delay();
? }
? for (count=0,count < N ; count++)
? ? sum += value_buf[count]*coe[count];
? return (char)(sum/sum_coe);
}
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;
? 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;
}
總結
以上是生活随笔為你收集整理的单片机 10种软件滤波方法的示例程序的全部內容,希望文章能夠幫你解決所遇到的問題。
- 上一篇: mfc 实现 设备 热插拔功能
- 下一篇: stm32f030cc 替换 stm32