一种GPS辅助的低精度捷联惯导动态对准方法Low accuracy SINS dynamic alignment method based on CKF aided by GPS location information
刘昶,王中元,邓海峰,姚荣景
摘要(Abstract)：
针对低精度SINS的陀螺不能辨识地球自转角速度,难以完成自对准的问题,该文引入GPS的位置观测信息利用5级-CKF简化算法辅助低精度SINS完成初始对准;因为低精度SINS粗对准给出的初始姿态质量很差,不满足小失准角的条件,所以必须采用大失准角非线性误差模型和非线性滤波方法。该文提出5级-CKF算法,并在系统模型噪声和量测噪声均为加性噪声且量测方程为线性方程时,对5级-CKF算法进行简化,其需要在kalman滤波的基础上利用5级容积采样点对非线性状态方程的状态及其方差进行预测。设计仿真实验验证了该方法的有效性,并分析了大失准角情况下载体运动状态对航向角估计的影响。
关键词(KeyWords)： 动态对准;SINS;5级-CKF;大失准角;GPS
基金项目(Foundation): 国家自然科学基金项目(51374209);; 中央高校基本科研业务费专项资金项目(2011QNA02)
作者(Author): 刘昶,王中元,邓海峰,姚荣景
DOI: 10.16251/j.cnki.1009-2307.2016.07.028
参考文献(References)：
- [1]刘国海,李沁雪,施维,等.动态卡尔曼滤波在导航试验状态估计中的应用[J].仪器仪表学报,2009(2):396-400.
- [2]周卫东,乔相伟,任蕾,等.QUKF算法及其在SINS初始对准中的应用[J].仪器仪表学报,2010(2):264-269.
- [3]SCHERZINGER B M.Inertial navigator error models for large heading uncertainty[C]//Position Location and Navigation Symposium.地:IEEE,1996:477-484.
- [4]SHIN E H,ELSHEIMY N.An unscented Kalman filter for in-motion alignment of low-cost IMUs[C]//Position Location and Navigation Symposium,PLANS.地:IEEE,2004:273-279.
- [5]严恭敏,严卫生,徐德民.简化UKF滤波在SINS大失准角初始对准中的应用[J].中国惯性技术学报,2008,16(3):253-264.
- [6]秦永元,张洪钺,汪叔华.卡尔曼滤波与组合导航原理[M].西安:西北工业大学出版社,1998.
- [7]CHENG Zijian,HE Xiaofei,JIANG Huan.Research on initial alignment for large azimuth misalignment angle with Sage_Husa adaptive filtering[J].IEEE,Control and Decision Conference(CCDC),2013:1744-1749.
- [8]吴富梅,杨元喜.基于小波变换和序贯抗差估计的捷联惯导初始对准[J].武汉大学学报:信息科学版,2007,32(7):617-623.
- [9]严恭敏,严卫生,徐德民.简化UKF滤波在SINS大失准角初始对准中的应用[J].中国惯性技术学报,2008,16(3):253-264.
- [10]SUN Feng,TANG Lijun.Initial alignment of large azimuth misalignment angle in SINS based on CKF[J].Chinese Ionmal of Scientific Instrument,2012,33(2):328-335.
- [11]JIA Bin,XIN Ming,CHENG Yang.High-degree cubature Kalman filter[J].Automatic a:A Journal of Ifac the International Federation of Automatic Contro,2012,49(2):510-518.
- [12]JIA B,XIN M,CHENG Y.Sparse Gauss-Hermite quadrature filter with application to spacecraft attitude estimate[J].Journal of Guidance Control and Dynamic,2011,34(2):367-379.
- [13]ZHANG Y,HUANG Y,LI N,et al.SINS initial alignment based on fifth-degree Cubature Kalman Filter[C]//Mechatronics and Automation(ICMA),IEEE International Conference on,2013:401-406.
- [14]王丹力,张洪钺.惯性系统初始对准的非线性滤波算法[J].中国惯性技术学报,1999,7(3):17-21.
- [15]邓海峰,高井祥,李增科,等.简化5级-CKF在SINS大失准角初始对准中的应用[J].测绘科学技术学报,2014(5):473-476.
- [16]ANUP.Bayesian Filtering for Dynamic Systems with Application to Tracking[M].University Politecnica Catalunya,2010.