單片機(jī)開發(fā)10種軟件濾波方法

假定從8位AD中讀取數(shù)據(jù)（如果是更高位的AD可定義數(shù)據(jù)類型為int),子程序?yàn)間et_ad();

1、限副濾波

/*  A值可根據(jù)實(shí)際情況調(diào)整

    value為有效值，new_value為當(dāng)前采樣值

    濾波程序返回有效的實(shí)際值  */

#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值可根據(jù)實(shí)際情況調(diào)整

    排序采用冒泡法*/

#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 < 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、算術(shù)平均濾波法

/*

*/

#define N 12

char filter()

{

  int  sum = 0;

  for ( count=0; count

  {

    sum + = get_ad();

    delay();

  }

  return (char)(sum/N);

}

4、遞推平均濾波法（又稱滑動(dòng)平均濾波法）

/*

*/

#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

    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

    sum += value[count];

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

}

6、限幅平均濾波法

/*

*/

略 參考子程序1、3

7、一階滯后濾波法

/* 為加快程序處理速度假定基數(shù)為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、加權(quán)遞推平均濾波法

/* coe數(shù)組為加權(quán)系數(shù)表，存在程序存儲(chǔ)區(qū)。*/

#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;

}