『壹』 二阶低通滤波器的C程序求一个,急用!!!
long lvbo_test(long NEW_DATA,unsigned char k)
{
long result; //声明一个变量作为滤波缓存
if( NEW_DATA < OLD_DATA )
{
result = OLD_DATA - NEW_DATA;
result *= k;
result += 128; //+128是为了四舍五入
result /= 256;
result = OLD_DATA - result;
}
else if( NEW_DATA > OLD_DATA )
{
result = NEW_DATA - OLD_DATA;
result *= k;
result += 128; //+128是为了四舍五入
result /= 256;
result = OLD_DATA + result;
}
else
{
result = OLD_DATA;
}
OLD_DATA = result;
return result;
}