MPU_Get_Accelerometer(&aacx,&aacy,&aacz);//加速度原始数据
MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);//角度原始数据
ax=(float)aacx/16384;
az=(float)aacz/16384;
gy=(float)gyroy/16.4;
angle_ax=atan2(ax,sqrt(ay*ay+az*az))*57.3;
pitch=Kalman_Filter(angle_ax,gy);
这是处理mpu6050数据的主要程序,利用卡尔曼滤波后,发现滞后了不少,对噪声抑制的效果还不错。滞后是什么原因啊?该怎么解决呢?
友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。
能具体点嘛?上面就是我主要的程序的了,卡尔曼也是网上找到的,大部分都一样
一周热门 更多>