From afe80d069530e3dfea8c3e4aa079394fd340b6d4 Mon Sep 17 00:00:00 2001 From: 95384 <664090429@qq.com> Date: Wed, 22 Jan 2025 15:42:33 +0800 Subject: [PATCH] =?UTF-8?q?=E6=BB=A4=E9=99=A4=E8=BE=83=E5=A4=A7=E6=B3=A2?= =?UTF-8?q?=E5=8A=A8=E6=9C=89BUG=EF=BC=8C=E5=8F=96=E6=B6=88?= MIME-Version: 1.0 Content-Type: text/plain; charset=UTF-8 Content-Transfer-Encoding: 8bit --- Drivers/Filter/LowPassFilter.c | 50 +++++++++++++++++----------------- 1 file changed, 25 insertions(+), 25 deletions(-) diff --git a/Drivers/Filter/LowPassFilter.c b/Drivers/Filter/LowPassFilter.c index f4879c8..50a3052 100644 --- a/Drivers/Filter/LowPassFilter.c +++ b/Drivers/Filter/LowPassFilter.c @@ -21,31 +21,31 @@ float updateFilter(SL_LowPassFilter* filter, float new_input) // 滤波新值 float filtedData = (1.0f - filter->alpha) * filter->previous + filter->alpha * new_input; - //差值大于一定值认为有问题,暂定4 - if((filter->x) - filtedData > 4 || (filtedData) - filter->x > 4 ) - { -// 将有问题的值存起来 - (filter->x) = filtedData; -// 使用上一次的正确值当结果 - filtedData = filter->previous; -// 清空计数 - filter->times = 0; - }else - { -// 差值在允许范围内 -// 差值合理一定时间后认为数据没问题 - if(filter->times < 3) - { - filter->times++; -// 没满足次数,使用旧值 - filtedData = filter->previous; - } - else - { -// 将值存起来,直接使用滤波后的值 - (filter->x) = filtedData; - } - } +// //差值大于一定值认为有问题,暂定4 +// if((filter->x) - filtedData > 4 || (filtedData) - filter->x > 4 ) +// { +//// 将有问题的值存起来 +// (filter->x) = filtedData; +//// 使用上一次的正确值当结果 +// filtedData = filter->previous; +//// 清空计数 +// filter->times = 0; +// }else +// { +//// 差值在允许范围内 +//// 差值合理一定时间后认为数据没问题 +// if(filter->times < 3) +// { +// filter->times++; +//// 没满足次数,使用旧值 +// filtedData = filter->previous; +// } +// else +// { +//// 将值存起来,直接使用滤波后的值 +// (filter->x) = filtedData; +// } +// } // 更新上一次的输出值 filter->previous = filtedData;