if(sampleFlg)
{
gyrox_sum +=ap_imu.gyrox;
gyroy_sum +=ap_imu.gyroy;
gyroz_sum +=ap_imu.gyroz;
sampCounter++;
sampleFlg=0;
if(sampCounter>=26)
{
gyrox_sum2=gyrox_sum/26;
gyroy_sum2=gyroy_sum/26;
gyroz_sum2=gyroz_sum/26;
sampCounter=0;
gyrox_sum = 0;
gyroy_sum = 0;
gyroz_sum = 0;
}
}
/*定义一个采集标志位,在采集函数中置1,在while循环中判断,每采集一次进行一次累计,累计26次后求出26次采集结果得均值赋值给输出变量作为输出,然后清除累计值,进入一次新得26次循环*/
一个简单的平滑滤波处理
最新推荐文章于 2024-09-03 16:36:34 发布