一阶,二阶,卡尔曼滤波后的角度效果图

2019-07-21 02:59发布

一阶滤波

二阶滤波,二阶好像反应好迟钝
卡尔曼滤波

测试过程中,我把mpu6050在+-90°反复转得到上面的角度值,紫 {MOD}是没滤波的,黄的是经过滤波后的
float First_order_filter(float Com_angle,float angle_pt,float angle,float dt);
参数说明:com_angle 滤波后的角度,  angle_pt 角速度(弧度制), angle 角度(弧度制), dt 微分时间(秒)
调用       :  com_angle = First_order_filter(com_angle, ang_pt, ang, dtime)

上位机用的是匿名飞控上位机,上位机使用说明请查看9mcu的匿名发的帖子
 
友情提示: 此问题已得到解决,问题已经关闭,关闭后问题禁止继续编辑,回答。
40条回答
商朕
2019-07-24 02:46
666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666666

一周热门 更多>