组合导航抗差自适应卡尔曼滤波Research on robust adaptive Kalman filter for integrated navigation
付心如;孙伟;徐爱功;丁伟;段顺利;
摘要(Abstract):
针对组合导航系统的定位精度与稳定性要求不断提高的现状,该文引入一种观测噪声协方差与抗差自适应相结合的Kalman滤波算法。利用新息向量和移动窗口协方差分析法,动态自适应修正观测噪声协方差阵;通过分析基于状态不符值、方差分量的统计量构造的自适应因子所存在的问题,提出一种由预测残差向量构造的自适应因子。仿真结果表明,该方法能够有效抑制观测异常对组合导航定位精度的影响。
关键词(KeyWords): 组合导航;观测噪声协方差;自适应滤波;抗差
基金项目(Foundation): 国家自然科学基金项目(41304032);; 高等学校博士学科点专项科研基金项目(新教师类)(20132121120005);; 第8批中国博士后科学基金特别资助项目(2015T80265);; 辽宁省自然科学基金项目(2015020078);; 精密工程与工业测量国家测绘地理信息局重点实验室开放基金项目(PF2015-13);; 地球空间环境与大地测量教育部重点实验室开放基金项目(14-01-05)
作者(Authors): 付心如;孙伟;徐爱功;丁伟;段顺利;
DOI: 10.16251/j.cnki.1009-2307.2018.01.002
参考文献(References):
- [1]何正斌,吴富梅,聂建亮.先验协方差阵误差对动态Kalman滤波解的影响[J].武汉大学学报(信息科学版),2011,36(1):34-38.(HE Zhengbin,WU Fumei,NIE Jianliang.Error influences of prior covariance matrices on dynamic Kalman filtering[J].Geomatics and Information Science of Wuhan University,2011,36(1):34-38.)
- [2]GAO S S,ZHONG Y M,LI W.Random weighting method for multi-sensor data fusion[J].IEEE Sensors Journal,2011,11(11):1955-1961.
- [3]程向红,郑梅.捷联惯导系统初始对准中Kalman参数优化方法[J].中国惯性技术学报,2006,14(4):12-17.(CHENG Xianghong,ZHENG Mei.Optimazation on Kalman filter parameters of SINS during initial alignment[J].Journal of Chinese Inertial Technology,2006,14(4):12-17.)
- [4]杨元喜.动态Kalman滤波模型误差的影响[J].测绘科学,2006,31(1):17-18.(YANG Yuanxi.Effect of dynamic Kalman filter model error[J].Science of Surveying and Mapping,2006,31(1):17-18.)
- [5]YANG Y X,HE H B,XU G C.Adaptively robust filtering for kinematic geodetic positioning[J].Journal of Geodesy,2001,75(2):109-116.
- [6]吴富梅,杨元喜.基于小波阈值消噪自适应滤波的GPS/INS组合导航[J].测绘学报,2007,36(2):124-128.(WU Fumei,YANG Yuanxi.GPS/INS integrated navigation by adaptive filtering based on wavelet threshold de-noising[J].Acta Geodaetica et Cartographica Sinica,2007,36(2):124-128.)
- [7]杨元喜,何海波,徐天河.论动态自适应滤波[J].测绘学报,2001,30(4):293-298.(YANG Yuanxi,HE Haibo,XU Tianhe.Adaptive robust filter for kinematic GPS positioning[J].Acta Geodaetica et Cartographica Sinica,2001,30(4):293-298.)
- [8]付梦印.Kalman滤波理论及其在导航系统中的应用[M].北京:科学出版社,2010.(FU Mengying.The applocations of Kalman filtering theory on the navigation systems[M].Beijing:Scinece Press,2010.)
- [9]HIDE C,MOORE T,SMITH M.Adaptive Kalman filtering for low-cost INS/GPS[J].Journal of Navigation,2003,56(1):143-152.
- [10]王永刚,王顺宏.改进Sage-Husa滤波及在GPS/INS容错组合制导中的应用[J].中国惯性技术学报,2003,11(5):29-32.(WANG Yonggang,WANG Shunhong.Improved Sage-Husa filter and its application in GPS/INS fault tolerant integrated navigation[J].Journal of Chinese Inertial Technology,2003,11(5):29-32.)
- [11]杨元喜,高为广.基于方差分量估计的自适应融合导航[J].测绘学报,2004,33(1):22-23.(YANG Yuanxi,GAO Weiguang.Integrated navigation by using variance component estimates of multi-sensor measurements and adaptive weights of dynamic model information[J].Acta Geodaetica et Cartographica Sinica,2004,33(1):22-23.)
- [12]杨元喜,徐天河.基于移动开窗法协方差估计和方差分量估计的自适应滤波[J].武汉大学学报(信息科学版),2003,28(6):714-718.(YANG Yuanxi,XU Tianhe.An adaptive Kalman filter combining variance component estimation with covariance matrix estimation based on moving window[J].Geomatics and Information Science of Wuhan University,2003,28(6):714-718.)
- [13]YANG Y,XU T H.An adaptive Kalman filter based on Sage windowing weights and variance components[J].The Journal of Navigation,2003,56(2):231-240.
- [14]YANG Y X,GAO W G.An optimal adaptive Kalman filter[J].Journal of Geodesy,2006,80:177-183.
- [15]MOHAMED A H,SCHWARZ K P.Adaptive Kalman filtering for INS/GPS[J].Journal of Geodesy,1999,73(4):193-203.
- [16]WANG J,STEWART M P,TSAKIRI M.Adaptive Kalman filtering for integration of GPS with GLONASS and INS[R].Birmingham:IUGG/IAG,1999:18-31.