filter.c

来自「基于TMS320LF2407的一个倒立控制程序」· C语言 代码 · 共 25 行

#include "ClearDog.h"

int Filter(int *table,int size)
{
   int i,j, tmp;
   int sum=0;
   int m=(int)(size/4);
   
	for(i=size-1;i>=1;i--){    /*order*/
		for(j=0;j<i;j++){
			if(table[i] < table[j]){
				tmp = table[j];
				table[j] = table[i];
				table[i] = tmp;			
			}
		}
		ClearDog();
	}
	
	for(i=size-1-m;i>=m;i--)			
	     sum += table[i];
	     	
   return sum/(size-2*m);  
}