首页 > 论文 > 电光与控制 > 20卷 > 11期(pp:52-55)

基于MRPs的改进SRUKF姿态估计算法

An Improved SRUKF for Attitude Estimation Based on MRPs

  • 摘要
  • 论文信息
  • 参考文献
  • 被引情况
  • PDF全文
分享:

摘要

针对四元数在飞行器姿态描述时存在冗余的问题,设计了把修正罗德里格参数(MRPs)作为描述姿态的一种全姿态描述方法,将加速度计和磁强计作为观测量,提出了基于平方根无迹卡尔曼滤波器(SRUKF)的姿态估计算法,针对外界环境对加速度计和磁强计的干扰问题,将专家系统引入SRUKF算法中,根据加速度及磁场信息实时调整滤波器的量测噪声矩阵,有效地提高了算法的抗干扰性。实验结果表明,该算法成功使系统的静态精度姿态角小于0.05°,航向角小于0.1°;动态精度姿态角小于0.5°,航向角小于1°,优化效果得到了明显改善。

Abstract

In view of the shortage of redundancy when using quaternion to describe attitudethe Modified Rodrigues Parameters (MRPs)which is a threedimensional independent vectoris put forward for attitude estimation.The attitude estimation algorithm based on Square Root Unscented Kalman Filter (SRUKF) is established with the outputs of accelerometer and magnetometer as observation vectors.In order to avoid the accelerometer and magnetometer interference by environmentan expert system is introduced to the SRUKF algorithm.The expert system is designed to estimate the information of acceleration and magnetic field to adjust the measurement noise matrix.The experiment results indicate that the algorithm successfully makes the static attitude accuracy less than 0.05°and static heading accuracy less than 0.1°.And it makes the dynamic attitude accuracy less than 0.5°and dynamic heading accuracy less than 1°.The optimization effect is improved significantly.

Newport宣传-MKS新实验室计划
补充资料

中图分类号:V249

DOI:10.3969/j.issn.1671-637x.2013.11.012

所属栏目:学术研究

收稿日期:2012-11-20

修改稿日期:2012-12-24

网络出版日期:--

作者单位    点击查看

肖文健:军械工程学院无人机工程系,石家庄050003
路平:军械工程学院无人机工程系,石家庄050003

备注:肖文健(1989 —),男,河北张家口人,硕士生,研究方向为微小型无人机导航、控制。

【1】付梦印,邓志红,闫莉萍.Kalman滤波理论及其在导航系统中的应用[M].2版.北京:科学出版社,2010.

【2】刘兴川,张盛,李丽哲,等.基于四元数的MARG传感器姿态测量算法[J].清华大学学报:自然科学版,2012,52(5):627-631.

【3】薛亮,苑伟政,常洪龙,等.用于微小型飞行器姿态估计的四元数扩展卡尔曼滤波算法[J].纳米技术与精密工程,2009(7):163-167.

【4】杨淑洁,曾庆双,伊国兴.低成本无人机姿态测量系统研究[J].传感器与微系统,2012,31(2):15-18.

【5】HANEPETER SJUNKINE J L.Steregraphic orientation parameters or attitude dynamics:A generalization of the rodriguee parameters[J].The Journal of the Astronautical Sciences199644(1):1-19.

【6】CHEN JizhengYUAN JianpingFANG Qun.Flight vehicle attitude determination using the modified Rodrigues parameters[J].Chinese Journal of Aeronautics200829(5):1622-1626.

【7】RAYMOND KPER J NJAN T G.Satellite attitude control by quaternionbased backstepping[J].IEEE Transactions on Control Systems Technology200917(1):227-232.

【8】张红梅,邓正隆,高玉凯.UKF在基于修正罗德里格参数的飞行器姿态确定中的应用[J].宇航学报,2005,26(2):164-167.

【9】郭庆,魏瑞轩,许洁,等.基于MRPs/NPUP的地磁/加速度计测量的姿态估计新方法[J].宇航学报,2011,32(2):336-341.

【10】周王森,鲍其莲.组合导航系UKF滤波算法设计[J].上海交通大学学报,2009,43(3):389-392.

【11】渠晋,宋艳君,臧洁,等.加速度计/磁强计无陀螺捷联惯导姿态解算研究[J].电光与控制,2012,19(2):40-43.

引用该论文

XIAO Wenjian,LU Ping. An Improved SRUKF for Attitude Estimation Based on MRPs[J]. Electronics Optics & Control, 2013, 20(11): 52-55

肖文健,路平. 基于MRPs的改进SRUKF姿态估计算法[J]. 电光与控制, 2013, 20(11): 52-55

您的浏览器不支持PDF插件,请使用最新的(Chrome/Fire Fox等)浏览器.或者您还可以点击此处下载该论文PDF