|
|
- 2016
SINS的SRC-KF姿态估计算法
|
Abstract:
基于飞行器载体SINS姿态计算精度要求,提出了一种SINS(strap-down inertial navigation system)的球面径向容积卡尔曼(spherical-radial cubature Kalman filtering, SRC-KF) 姿态确定算法。该算法把笛卡尔坐标系中状态向量变换到球坐标系中,通过Gauss-Hermite求积计算获得2n个球面径向容积点及其权值系数来逼近计算系统状态估计及其方差矩阵,其计算精度可达到三阶;采用四元数姿态建模方法构建新型SINS状态变量与噪声向量相关的姿态方程模型,利用伪观测向量构建观测噪声与四元数相关的观测方程模型,设计系统噪声方差分离计算算法进行系统噪声方差计算,引入拉格朗日乘子算法计算四元数估计均值,最后利用SINS/CCD姿态估计仿真系统开展的SINS 的SRC-KF姿态模型算法进行仿真验证。通过与中心差滤波(CDKF)和无迹卡尔曼滤波(UKF)算法计算结果进行对比,可以看出SRC-KF算法具有计算精度高以及数值计算稳定等特点
| [1] | Halil E S, Chingiz H. Pico Satellite Attitude Estimation via Robust Unscented Kalman Filter in the Presence of Measurement Faults [J]. <em>ISA Transactions,</em> 2010, 49(3):249-256 |
| [2] | Ding Guoqing, Zhou Weidong, Hao Yanling. QCDKF Algorithm for a Transfer Alignment System by Using Multiplicative Quaternion Error Model [J]. <em>J Huazhong Univ of Sci& Tech(Natural Science Edition),</em> 2010,38(8):89-94(丁国强,周卫东,郝燕玲. 传递对准误差模型及其QCDKF算法[J].华中科技大学学报(自然科学版),2010,38(8): 89-94) |
| [3] | Crassidis J, Markley F. Attitude Estimation or Quaternion Estimation [J]. <em>Journal of the Astronautical Sciences</em>,2004,52(2): 221-238 |
| [4] | Bin J, Ming X, Yang C. High-Degree Cubature Kalman Filter [J]. <em>Automatica,</em> 2013,49(2):510-518 |
| [5] | Lasserre J B.The Existence of Gaussian Cubature Formulas [J]. <em>Journal of Approximation Theory,</em> 2012, 164(5):572-585 |
| [6] | Choukroun D, Bar-Itzhack I Y, Oshman Y. Novel Quaternion Kalman Filter [J].<em> IEEE Transaction on Aerospace and Electronic Systems,</em> 2006,42(1):174-190 |
| [7] | Ding Guoqiang, Zhou Weidong, Hao Yanling. Study on Divided Difference Filtering and Its Application on Large Initial Misalignment Transfer Alignment Sytem [J]. <em>Journal of Projectiles,Rockets,Missiles and Guidance,</em> 2010,30(4):163-168(丁国强,周卫东,郝燕玲. 插值非线性滤波技术在大失准角传递对准中的应用研究[J]. 弹箭与制导学报,2010,30(4):163-168) |
| [8] | Zhang Tianguang,Wang Xiuping, Wang Lixia. Strapdown Inertial Navigation Technology[M]. 2 nd ed Beijing:National Defense Industry Press, 2007: 287-367(张天光,王秀萍,王丽霞.捷联惯性导航技术(第二版)[M].第二版. 北京:国防工业出版社, 2007:287-367) |
| [9] | Shuster M D. Filter Quest or Request[J]. <em>Journal of Guidance, Control, and Dynamics,</em> 2009,32(2):643-645 |
| [10] | Angelo M, Oshman S. Quaternion -Based Extended Kalman Filter for Determining Orientation by Inertial and Magnetic Sensing [J]. <em>IEEE Transactions on Biomedical Engineering,</em> 2006,53(7): 1 346-1 356 |
| [11] | Liu Zhiping, Zhang Shubi.Variance-covariance Component Estimation Method Based on Generalization Adjustment Factor [J]. <em>Geomatics and Information Science of Wuhan University,</em> 2013, 38(8):925-929(刘志平,张书毕.方差-协方差分量估计的概括平差因子法[J].武汉大学学报·信息科学版,2013,38(8):925-929) |
| [12] | Markley F L.Attitude Error Representations for Kalman Filtering[J]. <em>Journal of Guidance, Control, and Dynamics,</em>2003,26(2): 311-317 |
| [13] | Gao F Q, Chen L R, Ding C H. Simplified Gauss Hermite Filter Based on Sparse Grid Gauss Hermite Quadrature [J]. <em>Telkomnika,</em> 2013, 11(12):7 138-7 145 |
