基于共轭梯度法和互补滤波相结合的姿态解算算法

被引:44
作者
孙金秋 [1 ,2 ]
游有鹏 [1 ]
傅忠云 [2 ]
机构
[1] 南京航空航天大学机电学院
[2] 南京航空航天大学金城学院
关键词
传感器; 姿态估计; 共轭梯度法; 互补滤波; 四元数;
D O I
暂无
中图分类号
TP212 [发送器(变换器)、传感器];
学科分类号
080202 ;
摘要
为了提高姿态解算精度,提出了一种基于共轭梯度和互补滤波相结合的多传感器数据融合策略。系统采用四元数方法进行姿态解算。利用加速度计和磁强计的输出数据,通过共轭梯度方法对姿态四元数进行寻优估计,再将其和利用陀螺仪输出数据更新的四元数进行互补滤波,解算出姿态角。实验测试表明,这种融合策略使姿态检测系统静态性能和和动态性能均有所提高,尤其在姿态剧烈变化时,其性能明显优于卡尔曼滤波和梯度下降法。
引用
收藏
页码:524 / 528
页数:5
相关论文
共 5 条
[1]  
基于对偶四元数的捷联惯导算法研究.[D].李贵珍.中北大学.2012, 08
[2]  
An Approach to Improving Attitude Estimation Using Sensor Fusion for Robot Navigation.[J].Lu Lou;Xin Xu.Procedia Engineering.2011,
[3]   基于四元数和卡尔曼滤波的两轮车姿态稳定方法 [J].
叶锃锋 ;
冯恩信 .
传感技术学报, 2012, 25 (04) :524-528
[4]   基于卡尔曼滤波器的航姿系统测姿算法研究 [J].
苑艳华 ;
李四海 ;
南江 .
传感技术学报, 2011, 24 (12) :1718-1722
[5]   基于低成本陀螺和倾角仪的姿态估计 [J].
朱丰超 ;
姚敏立 ;
贾维敏 .
宇航学报, 2011, 32 (08) :1728-1733