General formulas of coning compensation algorithm with angular rate input
-
摘要: 传统圆锥补偿算法直接应用于由速率陀螺组成的捷联惯导系统时,算法误差明显增大.为抑制算法误差,提出了一种以角速率为输入信号,任意子样数圆锥补偿算法(包括改进算法)的一般形式,并在典型圆锥运动条件下以算法漂移误差最小为优化准则,推导了相应的圆锥补偿系数方程和算法误差表达式.利用给出的公式,求解一个线性方程组即可得到圆锥补偿系数,可方便快捷的设计任意子样数的角速率圆锥补偿算法以及改进算法.仿真结果表明,所设计的改进算法比同子样数常规角速率圆锥补偿算法在精度上有明显提高.Abstract: When the traditional coning compensation algorithm applied in the strapdown inertial navigation system (SINS), which comprises of angular rate gyroscopes, the algorithm error increased dramatically. The general formulas of coning compensation algorithm, taking arbitrary samples of angular rate signal as input, were presented. Together with an improved algorithm, which utilizes angular rate signal and gyro increments from previous and current attitude update periods simultaneously. Then the algorithms were optimized by minimizing algorithm drift error under classical coning motion, and the coning compensation coefficient equations and algorithm error expressions were deduced respectively. The coning compensation algorithms, with arbitrary samples of angular rate signal as input, can be easily obtained from the deduced formulas. And the corresponding coefficients can be computed from the linear equations. Simulation result shows that the improved angular rate coning compensation algorithm was greatly improved in accuracy than regular algorithm with the same number of gyro angular rate samples.
-
[1] Bortz J E.A new mathematical formulation for strapdown inertial navigation[J].IEEE Transaction on Aerospace and Electronic Systems,1971,27(1):61-66 [2] Miller R B. A new strapdown attitude algorithm[J]. Journal of Guidance, Control, and Dynamics, 1983, 6(4):287-291 [3] Jiang Y F, Lin Y P. Improved strapdown coning algorithms[J]. IEEE Transaction on Aerospace and Electronic Systems, 1992, 28(2):484-490 [4] 魏小莹,林玉荣,邓正隆.光纤陀螺捷联姿态算法的改进研究[J].中国惯性技术学报,2005,13(2):70-74 Wei Xiaoying,Lin Yurong,Deng Zhenglong.Improved attitude algorithm of strapdown system based on FOG[J].Journal of Chinese Inertial Technology,2005,13(2):70-74(in Chinese) [5] 黄昊,邓正隆.旋转矢量航姿算法的一种新的表达式[J].宇航学报,2001,22(3):92-98 Huang Hao,Deng Zhenglong.A new expression for rotation vector attitude algorithm[J].Journal of Astronautics,2001,22(3):92-98(in Chinese) [6] 魏晓虹,张春熹,朱奎宝.一种高精度角速率圆锥补偿算法[J].北京航空航天大学学报,2005,31(12):1312-1316 Wei Xiaohong,Zhang Chunxi,Zhu Kuibao.High accuracy coning compensate algorithm by angular velocity[J].Journal of Beijing University of Aeronautics and Astronautics,2005,31(12):1312-1316(in Chinese) [7] 王养柱,崔中兴.捷联惯导系统圆锥补偿算法优化设计[J].中国惯性技术学报,2000,8(1):7-10 Wang Yangzhu,Cui Zhongxing.Optimal design for coning algorithms of SINS[J].Journal of Chinese Inertial Technology,2000,8(1):7-10(in Chinese) [8] 周江华,王峰,孙国基.多子样旋转矢量捷联姿态算法的一般结果[J].航天控制,2002,20(2):18-22 Zhou Jianghua,Wang Feng,Sun Guoji.General formulas of rotation vector based attitude algorithm of SDINS[J].Aerospace Control,2002,20(2):18-22(in Chinese) [9] Park C G. Formalized approach to obtaining optimal coefficients for coning algorithms[J]. Journal of Guidance, Control, and Dynamics, 1999, 22 (1):165-168
点击查看大图
计量
- 文章访问数: 3286
- HTML全文浏览量: 176
- PDF下载量: 1458
- 被引次数: 0