作者：王真, 高凤岐, 高敏, 高伟伟

作者单位：军械工程学院, 河北 石家庄 050003

关键词：捷联姿态测量;高动态;圆锥误差补偿;等效旋转矢量

摘要：

为克服高动态条件下的捷联姿态解算存在不可交换性误差的问题，达到进一步增强捷联姿态误差抑制效果的目的，基于角速率的输出提出了等效旋转矢量三子样二次迭代优化算法，推导对应的圆锥补偿算法方程及其表达式。分别在不同圆锥运动频率情况下和不同姿态更新频率情况下，展开仿真验证算法的漂移误差和俯仰角误差，以传统的四元数法、三子样算法为对照，分析仿真数据曲线，得出本改进算法在精度和稳定性方面均有较大提高。在单轴速率转台上进行光纤陀螺的实测验证中，通过调整圆锥运动半偏角和频率，测量获取光纤陀螺惯组输出情况，结果表明：该算法在高动态条件下受圆锥半角、圆锥运动频率的影响较小，性能更加优越。

Research on error compensation improved algorithm of strapdown attitude & heading measurement based on multiple iteration rotation vector

WANG Zhen, GAO Fengqi, GAO Min, GAO Weiwei

Ordnance Engineering College, Shijiazhuang 050003, China

Abstract: To reduce the traditional coning error compensation algorithm noncommutativity errors under high dynamic conditions and to restrain the coning error, proposed the three-sample-and-two-time iteration algorithm of equivalent rotation vector based on angular rate, and deduced the expression of coning error compensation algorithm. At different coning motion frequency and update frequency, simulation validation showed this algorithm had advantages in accuracy and stability than quaternion and three sub-sample algorithms. Experimental results show that there was smaller influence of coning motion frequency and cone angle on this algorithm, thus this algorithm is better than traditional algorithm under high dynamic conditions.

Keywords: strapdown attitude & heading measurement;high dynamic;coning error compensation;equivalent rotation vector

2016, 42(8): 113-117  收稿日期: 2015-9-10;收到修改稿日期: 2015-10-11

基金项目: 装备预研共用技术基金项目（9140A05040213JB34069）

作者简介: 王真(1991-),男,河北唐山市人,硕士研究生,专业方向为精密仪器与微系统。

参考文献

[1] 程承,潘泉,李汉舟. 一种新的捷联惯导系统圆锥误差补偿算法研究[J]. 弹箭与制导学报,2014,34(1):1-4.
[2] 李海涛,曹咏弘,祖静. 等效旋转矢量法在旋转弹姿态解算中的应用[J]. 测试技术学报,2011,25(4):287-291.
[3] 张荣辉,贾宏光. 基于四元数法的捷联式惯性导航系统的姿态解算[J]. 光学精密工程,2008,16(10):1963-1970.
[4] MILLER R B. A new strapdown attitude algorithm[J]. Journal of Guidance Control and Dynamics,1983,6(4):287-291.
[5] 黄磊,刘建业,曾庆化. 基于高阶补偿模型的新圆锥算法[J]. 中国惯性技术学报,2013,21(1):37-41.
[6] 陈建锋,陈熙源,祝雪芬. 硬件增强角速率圆锥优化算法的姿态解算精度分析及改进[J]. 东南大学学报(自然科学版),2012,42(4):632-636.
[7] 汤传业,陈熙源,李建利. 一种角速率输入的圆锥算法设计[J]. 中国惯性技术学报,2013,21(4):456-461.
[8] SONG M, WU W Q, PAN X F. Approach to recovering maneuver accuracy in classical coning algorithms[J]. Journal of Guidance Control and Dynamics,2013,36(6):1872-1880.
[9] 黄磊,刘建业,曾庆化. 基于高阶补偿模型的新圆锥算法[J].中国惯性技术学报,2013,21(1):37-41.
[10] 屈熠,赵忠. 增强型等效旋转矢量算法在圆锥运动下的仿真[J]. 计算机仿真,2010,27(11):25-27.
[11] 李海涛,曹咏弘,祖静. 等效旋转矢量法在旋转弹姿态解算中的应用[J]. 测试技术学报,2011,25(4):287-291.
[12] 袁张贤,王鑫伟. 斜直圆筒内基于Euler-Rodrigues参数的细长杆螺旋屈曲研究[J]. 计算物理,2012,29(4):549-556.
[13] 梁锋,周卫东,马荟. 基于四元数的舰船捷联惯导粗对准方法研究[J]. 舰船科学技术,2013,35(8):53-56.
[14] 汤传业,陈熙源. 一种角速率输入的捷联惯导姿态算法[J].东南大学学报,2014,44(3):543-549.
[15] 彭孝东,张铁民,李继宇,等. 基于传感器校正与融合的农用小型无人机姿态估计算法[J]. 自动化学报,2015,41(4):854-860.
[16] HUANG L, LIU J Y, ZENG Q H. Optimized strapdown coning correction algorithm[J]. Transactions of Nanjing University of Aeronautics & Astronautics,2013,30(4):343-349.