基于加权自适应平方根容积卡尔曼滤波的GPS/INS组合导航方法

岳哲; 廉保旺; 唐成凯

doi:10.11999/JEIT170597

基于加权自适应平方根容积卡尔曼滤波的GPS/INS组合导航方法

doi: 10.11999/JEIT170597

基金项目:

国家自然科学基金(61301094, 61473308, 61501430)

计量
- 文章访问数: 657
- HTML全文浏览量: 65
- PDF下载量: 270
- 被引次数: 0
出版历程
- 收稿日期: 2017-06-22
- 修回日期: 2017-11-23
- 刊出日期: 2018-03-19

A GPS/INS Integrated Navigation Method Based on Weighting Adaptive Square-root Cubature Kalman Filter

Funds:

The National Natural Science Foundation of China (61301094, 61473308, 61501430)

摘要

摘要: 针对GPS/INS组合导航系统中，由于量测噪声统计的不确定性导致平方根容积卡尔曼滤波器(SCKF)滤波精度下降甚至发散的问题，该文提出一种基于加权的自适应SCKF(WASCKF)方法。该方法首先利用移动开窗理论对SCKF新息的协方差阵进行最大似然估计，实现对测量噪声统计特性的在线调整；然后，利用加权理论，依据窗口内不同时刻信息的有用程度的不同而设置相应的权值，增强对窗口内有用信息的利用。最后，将WASCKF方法应用于GPS/INS组合导航系统中进行仿真验证，并与SCKF和ASCKF方法进行比较，结果表明，在测量噪声统计存在不确定情况下，该文所提出方法的速度误差和位置误差的均方根均小于SCKF和ASCKF方法，能够有效地提高GPS/INS组合导航系统对量测噪声统计不确定的自适应能力与导航性能。
- 组合导航 /
- 量测噪声 /
- 容积卡尔曼滤波 /
- 加权
Abstract: In the GPS/INS integrated navigation system, the filtering precision of Square-root Cubature Kalman Filter (SCKF) will decrease or even diverge resulting from the uncertainty of the measured noise statistics, therefore, a Weighting Aaptive Square-root Cubature Kalman Filter (WASCKF) method is proposed in this paper. Firstly, the moving window method is employed to conduct the maximum likelihood estimation of the covariance matrix of SCKF, in order to realize the on-line adjustment of the statistical characteristics of the measured noise. Then, the weighting theory is utilized to set the corresponding weights according to the usefulness of the information at different times in the window, thus it takes great use of effective information in the window. Finally, the WASCKF is applied to the GPS/INS integrated navigation system for simulation and verification, and comparing with the SCKF and ASCKF methods. The results indicate that the mean square root of velocity errors and position errors of the proposed method are less than SCKF and ASCKF, and it can effectively improve the adaptive capability and navigation performance of GPS/INS integrated navigation system with the measured noise uncertainty.
- Integrated navigation /
- Measured noise /
- Cubature Kalman Filter (CKF) /
- Weighting

HTML全文

参考文献(20)

[1]	TSENG Chienhao, LIN Shengfuu, and JWO Dahjing. Fuzzy adaptive cubature Kalman filter for integrated navigation systems[J]. Sensors, 2016, 16(8): 1167-1189. doi: 10.3390/ s16081167.
[2]	LI Zengke, WANG Jingxiang, WANG Jian, et al. PPP/INS tightly coupled navigation using adaptive federated filter[J]. GPS Solutions, 2017, 21(1): 1-12. doi: 10.1007/s10291-015- 0511-z.
[3]	WANG Liansheng and XIA Yuanqing. Mars Entry Navigation with uncertain parameters based on desensitized extended Kalman filter[J]. IEEE Transactions on Industrial Informatics, 2015, 11(5): 998-1005. doi: 10.1109/TII.2015. 2463763.
[4]	LI Donggong, JI Daxiong, LIU Jian, et al. A Multi-model EKF integrated navigation algorithm for deep water AUV[J]. International Journal of Advanced Robotic Systems, 2016, 13(1): 1-15. doi: 10.5772/62076.
[5]	YAZDKHASTI S, SASIADEK J, and ULRICH S. Performance enhancement for GPS/INS fusion by using a fuzzy adaptive unscented Kalman filter[C]. 2016 21st International Conference on Methods and Models in Automation and Robotics, Poland, 2016: 1194-1199. doi: 10.1109/MMAR.2016.7575308.
[6]	LI Kailong, CHANG Lubin, and HU Baiqing. A variational bayesian-based unscented Kalman filter with both adaptivity and robustness[J]. IEEE Sensors Journal, 2016, 16(18): 6966-6976. doi: 10.1109/JSEN.2016.2591260.
[7]	ARASARATNAM I and HAYKIN S. Cubature Kalman filters[J]. IEEE Transactions on Automatic Control, 2009, 54(6): 510-518. doi: 10.1109/TAC.2009.2019800.
[8]	XU Bo, ZHANG Peng, WEN Hongzhi, et al. Stochastic stability and performance analysis of Cubature Kalman Filter[J]. Neurocomputing, 2015, 186: 218-227. doi: 10.1016 /j.neucom.2015.12.087.
[9]	CHANDRA K, GU D, and POSTLETHWAITE I. Square root cubature information filter[J]. IEEE Sensors Journal, 2013, 13(2): 750-758. doi: 10.1109/JSEN.2012.2226441.
[10]	WANG Dingjie, L Hanfeng, and WU Jie. Augmented cubature Kalman filter for nonlinear RTK/MIMU integrated navigation with non-additive noise[J]. Measurement Journal of the International Measurement Confederation, 2017, 97: 111-125. doi: 10.1016/j.measurement.2016.10.056.
[11]	CUI Bingbo, CHEN Xiyuan, and TANG Xinhua. Improved cubature Kalman filter for GNSS/INS based on transformation of posterior sigma-points error[J]. IEEE Transactions on Signal Processing, 2017, 65(11): 2975-2987. doi: 10.1109/TSP.2017.267968.
[12]	JIANG Changhui, CHEN Shuai, BO Yuming, et al. Performance improvement of GPS/SINS ultra-tightly integrated navigation system utilizing a robust Cubature Kalman Filter[J]. Journal of Aeronautics, Astronautics and Aviation, 2017, 49(1): 49-55. doi: 10.6125/16-1201-916.
[13]	SHI Yuepeng, CHE Lei, GE Quanbo, et al. Adaptive high-degree Cubature Kalman Filter with unknown noise statistics[J]. Journal of Information and Computational Science, 2014, 11(18): 6703-6712. doi: 10.12773/jics20105083.
[14]	JIANG Chen, ZHANG Shubi, and ZHANG Qiuzhao. A novel robust interval Kalman filter algorithm for GPS/INS integrated navigation[J]. Journal of Sensors, 2016, 2016: ID 3727241. doi: 10.1155/2016/3727241.
[15]	YUE Zhe, LIAN Baowang, and TANG Chengkai. The GPS/INS integrated navigation method based on adaptive SSR-SCKF cubature Kalman filter[C]. The 8th China Satellite Navigation Conference, Shanghai, 2017: 395-405. doi: 10.1007/978-981-10-4591-2_32.
[16]	胡宇, 张世英, 罗雷. 基于自适应容积卡尔曼滤波方法的涡扇发动机气路部件故障诊断[J]. 航空动力学报, 2016, 31(5): 1260-1267. doi: 10.13224/j.cnki.jasp.2016.05.030.
[17]	HU Yu, ZHANG Shiying, and LUO Lei. Turbofan engine gas path components fault diagnosis based on adaptive cubature Kalman filter[J]. Journal of Aerospace Power, 2016, 31(5):
[18]	YANG Yuanxi and ZHANG Shuangcheng. Adaptive fitting of systematic errors in navigation[J]. Journal of Geodesy, 2005, 79(1): 43-49. doi: 10.1007/s00190-005-0441-6.
[19]	GAO Shesheng, HU Gaoge, and ZHONG Yongmin. Window and random weighting-based adaptive unscented Kalman filter[J]. International Journal of Adaptive Control and Signal Processing, 2015, 29: 201-223. doi: 10.1002/acs.2467.
[20]	-1267. doi: 10.13224/j.cnki.jasp.2016.05.030.

相关文章(20)

[1]	李庆华, 尤越, 沐雅琪, 张钊, 冯超. 一种针对大型凹型障碍物的组合导航算法, 电子与信息学报. doi: 10.11999/JEIT190179
[2]	王旭东, 仲倩, 闫贺, 张迪. 一种二维信号波达方向估计的改进多重信号分类算法, 电子与信息学报. doi: 10.11999/JEIT181090
[3]	张红颖, 王赛男, 胡文博. 基于粒子滤波与样本加权的压缩跟踪算法, 电子与信息学报. doi: 10.11999/JEIT170854
[4]	汪玲, 朱栋强, 马凯莉, 肖卓. 空间目标卡尔曼滤波稀疏成像方法, 电子与信息学报. doi: 10.11999/JEIT170319
[5]	单甘霖, 张凯, 吉兵. 基于高斯和均方根容积卡尔曼滤波的姿态角辅助目标跟踪算法, 电子与信息学报. doi: 10.3724/SP.J.1146.2013.01474
[6]	李江, 钱富才, 刘丁, 胡绍林. 具有未知参数的GPS/DR组合导航系统跟踪与辨识, 电子与信息学报. doi: 10.3724/SP.J.1146.2012.01065
[7]	徐定杰, 沈忱, 沈锋. 时变有色观测噪声下基于变分贝叶斯学习的自适应卡尔曼滤波, 电子与信息学报. doi: 10.3724/SP.J.1146.2012.01457
[8]	刘彦, 蒲亦非, 沈晓东, 周激流. 分数阶Unscented卡尔曼滤波器研究, 电子与信息学报. doi: 10.3724/SP.J.1146.2011.00942
[9]	冯肖亮, 文韬, 徐立中. 基于伪测量方程模型库的延迟量测滤波, 电子与信息学报. doi: 10.3724/SP.J.1146.2011.00304
[10]	张俊根, 姬红兵. IMM迭代扩展卡尔曼粒子滤波跟踪算法, 电子与信息学报. doi: 10.3724/SP.J.1146.2009.00298
[11]	牛铜, 张连海, 屈丹. 基于加权最小统计的噪声谱估计改进算法, 电子与信息学报. doi: 10.3724/SP.J.1146.2008.00467
[12]	王光鼎, 张升康, 杨汝良. 一种基于卡尔曼滤波处理的北斗卫星无源组合导航自适应野值剔除方法, 电子与信息学报. doi: 10.3724/SP.J.1146.2007.00163
[13]	杨磊, 刘伟, 王志刚. 加权全极化SAR图像非监督Wishart分类方法, 电子与信息学报. doi: 10.3724/SP.J.1146.2007.00950
[14]	熊伟, 陈立奎, 何友, 张晶炜. 有色噪声下的不敏卡尔曼滤波器, 电子与信息学报. doi: 10.3724/SP.J.1146.2005.00975
[15]	龚享铱, 周良柱. 一种变换状态空间的稳定卡尔曼滤波算法, 电子与信息学报.
[16]	郭福成, 李宗华, 孙仲康. 无源定位跟踪中修正协方差扩展卡尔曼滤波算法, 电子与信息学报.
[17]	杨军, 马晓岩, 万山虎. 稳态噪声背景下加权Myriad滤波的遗传算法实现, 电子与信息学报.
[18]	韩明华, 袁乃昌. 多层神经网络在跟踪式卡尔曼滤波器中的应用, 电子与信息学报.
[19]	付萍, 陈贺新, 付宁阳. 全方位钟形加权中值滤波器, 电子与信息学报.
[20]	何平. 短波信道的分步平方根卡尔曼滤波, 电子与信息学报.