基于高阶补偿模型的新圆锥算法.pdfVIP

第21 卷第 1 期 中国惯性技术学报 Vol.21 No.1 2013 年 2 月 Journal of Chinese Inertial Technology Feb. 2013 文章编号：1005-6734(2013)01-0037-05 基于高阶补偿模型的新圆锥算法 1,2 1 1 黄 磊 ，刘建业 ，曾庆化 (1. 南京航空航天大学 导航研究中心，南京 210016 ；2. 南京林业大学 自动化系，南京 210037) 摘要：分析表明传统圆锥算法的误差由常值漂移误差和截断误差组成。通常截断误差大于漂移误差， 是误差的主项应优先补偿。而传统圆锥算法一般通过增加单次更新周期内的子样数来提高算法精度， 但子样数的增加只能减少漂移误差，对截断误差并没有改善作用。从Bortz 的旋转矢量微分方程出发， 在不增加采样数的前提下，通过高阶误差补偿模型，对圆锥运动产生的截断误差进行了有效的补偿， 提高了算法精度。从理论上比较了该算法和传统 3 子样圆锥算法、4 子样圆锥算法的误差，证明算法 精度一般优于传统3 子样圆锥算法和4 子样圆锥算法。通过仿真证明了上述结论的正确性。虽然新算 法增加了一定的计算量，但随着导航计算机性能的不断提高，实测的结果表明仍能满足实时性的要求。 关 键 词：捷联惯性导航系统；旋转矢量；圆锥算法；圆锥修正 中图分类号：TN966 文献标志码：A New coning algorithm based on high-order error compensation model HUANG Lei1,2 1 1 , LIU Jian-ye , ZENG Qing-hua (1. Navigation Research Center of Nanjing University of Aeronautics and Astronautics, Nanjing 210016, China; 2. Automation Department of Nanjing Forestry University, Nanjing 210037, China) Abstract: The analysis indicates that the errors of traditional coning algorithms are composed by two parts: drift error and truncation error. Truncation error is often far larger than drift error, which means that the truncation error should be reduced firstly. The existing coning algorithms are usually by increasing the sample numbers to reduce the drift error, but the increment of the sample numbers has little positive effect on reducing truncation error. Based on the Bortz’s rotation vector equ