移植PX4 EKF姿态结果
楼主最近移植了PX4姿态估计的代码 源码在px4\Firmware\src\modules\attitude_estimator_ekf目录下和传统四元数方法对比如下图中白线为EKF 结果紫线为 ASHR结果 测试角度为PITCH角
1:手拿平移结果
2:手拿左右水平旋转结果
3:手拿上下高频振动
4:手拿大角度运动
不知道是参数调解问题 还是代码移植有问题感觉EKF 效果不如后者,望了解的同学给点建议
附上一篇详解PX4EKF的帖子http://blog.csdn.net/lizilpl/article/details/45542907 不错,学习了。 学习了,谢谢分享 对这东西一直比较感兴趣,却没时间玩,先收藏了。。。 lz厉害, 谢谢分享, 但是EKF的参数不够准确 这样看不来效果,找个振动台试试,做个振动实验 看不太懂 EKF的参数调整下~另外,px4的EKF的确不怎么样~ APM用的也是这套EKF吧? hz770495569 发表于 2015-9-7 09:47
EKF的参数调整下~另外,px4的EKF的确不怎么样~
大神能说说为什么PX4的EKF不怎么样吗?哪些地方是做的不好需要优化的? xiangyuan_122 发表于 2015-9-7 11:36
大神能说说为什么PX4的EKF不怎么样吗?哪些地方是做的不好需要优化的?
没有对陀螺仪的零偏进行融合处理,所以用这个算法,在温度较高环境下,算出的姿态角会越来越不准,状态量选的一般~ hz770495569 发表于 2015-9-7 14:02
没有对陀螺仪的零偏进行融合处理,所以用这个算法,在温度较高环境下,算出的姿态角会越来越不准,状态量 ...
autoquad倒是考虑这个了,哈哈! =FBI= 发表于 2015-9-7 16:25
autoquad倒是考虑这个了,哈哈!
没看过这个,不过我倒是重新写了个EKF~ hz770495569 发表于 2015-9-8 11:23
没看过这个,不过我倒是重新写了个EKF~
可以发个你写的EKF代码吗? openpilot 13维的INS/GPS EKF 我觉得挺好的 jssk01 发表于 2015-9-8 13:10
可以发个你写的EKF代码吗?
不方便,算公司的~ 小憨不傻 发表于 2015-9-8 13:24
openpilot 13维的INS/GPS EKF 我觉得挺好的
是的,用在固定翼上效果不错,多轴不需要这么复杂的算法 经过EKF 滤波,测量实时性肯定要打折扣,对于飞行器来说是要实时性还是要平稳性,是个综合平衡的问题。 Sebstian OH.Madgwick的论文里的比较对象就有EKF 好想有一个PX4的光流 之前想优化姿态算法时发现水平移动飞控 由于x,y轴上叠加了运动的加速度导致姿态角变化的问题,尝试了用上一时刻用捷联矩阵求得的减速度进行修正效果能将角度漂移减少30%左右,后询问老师说目前我们用的这种加速度和陀螺仪组合方式是用于低动态的飞行器中,想做MIT那样的高动态必须要用更高精度的陀螺仪,由其低漂移能减少加速度对姿态修正的权重从根本上消除振动和平移对姿态的干扰 golaced 发表于 2015-11-10 11:18
之前想优化姿态算法时发现水平移动飞控 由于x,y轴上叠加了运动的加速度导致姿态角变化的问题,尝试了用上一 ...
哪个学校的?讲的不错 px4 的ekf系统模型是假设角加速度恒定,因此会有一点低通的效果,也会带来滞后,从曲线也可以看出,另外需要根据实际情况调整一下噪声协方差矩阵。 很高深的样子
把q和r阵改了。具体你的效果不好是因为你没有顺带把px4的校准方法也一并一直了
页:
[1]