简单的滤波算法（DEMO）

#define N 5
#define FILTER_N 5

//*去除最大值和最小值后求均值*//

long middleAverageFilter(unsigned char next_select)//中值平均滤波
{
    u8 i,j,k;
    long temp,sum = 0;
        long value_buf[N];//滤波数组
    
    for(i = 0; i < N; ++i)
    {
        value_buf[i] = Read_TM7711(next_select);
    }
    /*从小到大冒泡排序*/    
    for(j = 0; j < N-1; ++j)
    {
        for(k = 0; k < N-j-1; ++k)
        {
            if(value_buf[k] > value_buf[k+1])
            {
                temp = value_buf[k];
                value_buf[k] = value_buf[k+1];
                value_buf[k+1] = temp;
                            
            }
        }
    }
    for(i = 1; i < N-1; ++i)
    {
        sum += value_buf[i];
    } 
    return sum/(N-2);
}

///*每次采样到一个新数据放入队尾，并扔掉原来队首的一次数据，然后求均值*//

long  filter_buf[FILTER_N+1];

long Filter(unsigned char next_select) //滑动平均滤波
{
    char i;
    long filter_sum = 0;
    filter_buf[FILTER_N] = Read_TM7711(next_select);    //AD转换的值赋给数组最后一个值
    for(i = 0; i < FILTER_N; i++) 
    {
        filter_buf[i] = filter_buf[i + 1]; // 所有数据左移，低位仍掉
        filter_sum += filter_buf[i];
    }
    return (long)(filter_sum / FILTER_N);
}