data_process.c

伺服控制器主要用于电动执行器的控制 在工业方面大量应用

float filter(unsigned int a[])   //中位值滤波,排序采用冒泡法
{
   unsigned int value_buf[M];
   unsigned char count,i,j,temp,n;
   for (count=0,n =0;count<M;count++,n++)
   {
     value_buf[count] = a[n];
   }
   for (j=0;j<M-1;j++)
   {
     for (i=0;i<M-j;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[(M+1)/2];
}