基于速度约束与模糊自适应滤波的车载组合导航

doi:10.3969/j.issn.1000-1093.2020.02.003

兵工学报 ›› 2020, Vol. 41 ›› Issue (2): 231-238.doi: 10.3969/j.issn.1000-1093.2020.02.003

基于速度约束与模糊自适应滤波的车载组合导航

胡杰¹，严勇杰¹，王子卉²

（1.中国电子科技集团公司第二十八研究所空中交通管理系统与技术国家重点实验室，江苏南京 210007；2.东南大学微惯性仪表与先进导航技术教育部重点实验室，江苏南京 210096）

收稿日期:2019-04-09 修回日期:2019-04-09 上线日期:2020-04-04
作者简介:胡杰（1987—），男，工程师，博士。E-mail: hj_student@163.com
基金资助:
国家重点研发计划项目（2017YFB0503401、2016YFB0502405）；江苏省自然科学基金青年基金项目（BK20170157）

Vehicle Integrated Navigation Based on Velocity Constraint and Fuzzy Adaptive Filtering

HU Jie¹， YAN Yongjie¹， WANG Zihui²

(1.State Key Laboratory of Air Traffic Management System and Technology, the 28th Research Institute of China Electronics Technology Group Corporation, Nanjing 210007, Jiangsu, China; 2.Key Laboratory of Micro-Inertial Instrument and Advanced Navigation technology of Ministry of Education, Southeast University, Nanjing 210096, Jiangsu, China)

Received:2019-04-09 Revised:2019-04-09 Online:2020-04-04

摘要/Abstract

摘要： 针对车载组合导航系统中卫星信号易受遮挡而引起导航精度降低问题，提出采用车辆速度约束条件辅助的组合导航方案。利用车辆正常行驶过程中侧向和天向速度为零作为虚拟观测信息，推导得到卫星信号失效时组合导航滤波量测方程；考虑到Kalman滤波过程中量测噪声协方差矩阵难以获取，推导给出一种新的自适应Kalman滤波（ADKF）算法，该算法计算新息序列实际协方差与理论协方差比值后，利用模糊推理系统（FIS）自适应调节量测噪声协方差矩阵大小；通过光纤捷联惯性导航系统（SINS）进行了验证试验。结果表明：卫星信号失效时，虚拟速度组合能够提高SINS定位精度，其纬度最大误差由41.33 m减小为8.61 m，且采用FIS-ADKF组合导航算法时3个方向位置精度相比标准Kalman滤波算法提高了60%以上，验证了所提出算法的有效性。

关键词: 组合导航, 速度约束, 自适应滤波, 模糊推理系统, 捷联惯性导航系统

Abstract: The satellite signal is easily obstructed to reduce the positioning precision of the integrated navigation system for the vehicle integrated navigation system. An integrated navigation scheme is proposed, which is assisted by the vehicle velocity constraints. The Kalman filter measurement equation is deduced by taking the side and up velocities of normal running vehicle be zero. A new adaptive Kalman filtering (ADKF) algorithm is deduced in consideration that it is difficult to determine the statistical characteristics of integrated navigation measurement noise. After calculating the ratio of actual covariance to theoretical covariance of innovation sequence, the fuzzy inference system (FIS) is used to adjust the Kalman's measurement noise covariance matrix adaptively. The verification experiments were carried out by using fiber optic strapdown inertial navigation system (SINS). The experimental results show that, when the satellite signal is invalid, the integration of virtual velocities can improve the positioning accuracy of SINS, and the maximum latitude error is reduced from 41.33 m to 8.61 m. The positioning accuracies of the vehicle's three directions calculated by the proposed FIS-ADKF integrated navigation algorithm are more than 60 percent higher than those calculated by the standard Kalman filtering algorithm, which verifies the effectiveness of the proposed algorithm. Key

Key words: integratednavigation, velocityconstraint, adaptivefiltering, fuzzyinferencesystem, strapdowninertialnavigationsystem

中图分类号:

U463.67⁺5

胡杰，严勇杰，王子卉. 基于速度约束与模糊自适应滤波的车载组合导航[J]. 兵工学报, 2020, 41(2): 231-238.

HU Jie， YAN Yongjie， WANG Zihui. Vehicle Integrated Navigation Based on Velocity Constraint and Fuzzy Adaptive Filtering[J]. Acta Armamentarii, 2020, 41(2): 231-238.

参考文献

［1］ NOURMOHAMMADI H, KEIGHOBADI J. Fuzzy adaptive integration scheme for low-cost SINS/GPS navigation system[J]. Mechanical Systems and Signal Processing, 2018, 99: 434-449.
[2］ YAO Y Q, XU X S, XU X. An IMM-aided ZUPT methodology for an INS/DVL integrated navigation system [J]. Sensors, 2017, 17: 1-17.
[3］ XU T L. Adaptive Kalman filter for INS/GPS integrated navigation system[J]. Applied Mechanics and Materials, 2013, 336: 332-335.
[4］严恭敏, 秦永元, 马建萍. 惯导/里程仪组合导航系统算法研究[J]. 计算机测量与控制, 2006, 14(8): 1087-1089.
YAN G M, QIN Y Y, MA J P. Research on INS/OD integrated navigation system algorithm[J]. Computer Measurement & Control, 2006, 14(8): 1087-1089.（in Chinese）
[5］肖烜, 王清哲, 程远, 等. 捷联惯导系统/里程计高精度紧组合导航算法[J]. 兵工学报, 2012, 33(4): 395-400.
XIAO X, WANG Q Z, CHENG Y, et al. High accuracy navigation algorithm for tightly coupled INS/odometer[J]. Acta Armamentarii, 2012, 33(4): 395-400.（in Chinese）
[6］ LIU H S, WANG Z C, FANG S S, et al. MEMS based SINS/OD filter for land vehicles' applications[J]. Mathematical Problems in Engineering, 2017, 3: 1-9， Article ID 1691320.
[7］高钟毓, 王进, 董景新, 等. 惯性测量系统零速修正的几种估计方法[J]. 中国惯性技术学报, 1995, 3(2): 24-29.
GAO Z Y, WANG J, DONG J X, et al. A comparison of ZUPT estimation methods for inertial survey systems[J]. Journal of Chinese Inertial Technology, 1995, 3(2): 24-29.（in Chinese）
[8］方靖, 顾启泰, 丁天怀. 车载惯性导航的动态零速修正技术[J]. 中国惯性技术学报, 2008, 16(3): 265-268.
FANG J, GU Q T, DING T H. Dynamic zero velocity update for vehicle inertial navigation system[J]. Journal of Chinese Inertial Technology, 2008, 16(3): 265-268.（in Chinese）
[9］ ZHANG T, XU X S. A new method of seamless land navigation for GPS/INS integrated system[J]. Measurement, 2012, 45(4): 691-701.

[10］ CHEN L, FANG J C. A hybrid prediction method for bridging GPS outages in high-precision POS application[J]. IEEE Transactions on Instrumentation & Measurement, 2014, 63(6): 1656-1665.
[11］ LI J, SONG N F, YANG G L, et al. Improving positioning accuracy of vehicular navigation system during GPS outages utilizing ensemble learning algorithm[J]. Information Fusion, 2017, 35: 1-10.
[12］ NOURELDIN A, OSMAN A, ELSHEIMY N. A neuro-wavelet method for multi-sensor system integration for vehicular navigation[J]. Measurement Science & Technology, 2003, 15(2): 404-412.
[13］ YAO Y Q, XU X S, ZHU C C, et al. A hybrid fusion algorithm for GPS/INS integration during GPS outages[J]. Measurement, 2017, 103: 42-51.
[14］ HU J, SUN Q W, SHI X Z. Differential positioning algorithm for GBAS based on extended Kalman filtering[C]∥Proceedings of 2018 13th World Congress on Intelligent Control and Automation(WCICA). Changsha, China: IEEE Control System Society, 2018: 296-303.
[15］ ZHAO L, QIU H Y, FENG H M. Analysis of a robust Kalman filter in loosely coupled GPS/INS navigation system[J]. Measurement, 2016, 80: 138-147.
[16］ SAGE A P, HUSA G W. Adaptive filtering with unknown prior statistics[C]∥Proceedings of Joint Automatic Control Conference. Boulder, CO, US: University of Colorado Boulder, 1969: 760-769.
[17］徐田来, 崔平远, 崔祜涛. 组合导航自适应交互多模型算法研究[J]. 系统工程与电子技术, 2008, 30(11): 2070-2074.
XU T L, CUI P Y, CUI H T. Research on algorithm of adaptive interacting multiple model for integrated navigation system[J]. Systems Engineering and Electronics, 2008, 30(11): 2070-2074.（in Chinese）
[18］王向华, 覃征, 杨新宇, 等. 基于两次Kalman滤波的观测噪声自适应调整算法[J]. 系统工程与电子技术, 2010, 32(2): 232-234.
WANG X H, QIN Z, YANG X Y, et al. Adaptive algorithm for adjusting observation noises based on double-Kalman filter[J]. Systems Engineering and Electronics, 2010, 32(2): 232-234.（in Chinese）
[19］秦永元. 惯性导航[M]. 北京: 科学出版社, 2014.
QIN Y Y. Inertial navigation[M]. Beijing: Science Press, 2014.(in Chinese)
[20］姜博文, 王可东. 低成本车载组合导航在GPS失效时的算法设计[J]. 传感技术学报, 2017, 30(3): 412-417.
JIANG B W, WANG K D. Algorithm design for a low-cost vehicle integrated navigation system in the GPS outage[J]. Chinese Journal of Sensors and Actuators, 2017, 30(3): 412-417.（in Chinese）
[21］屈桢深, 楚翔宇, 赵宵洋, 等. 一种基于改进Kalman滤波的视觉/惯性组合导航算法[J]. 导航定位与授时, 2017, 4(2): 14-20.
QU Z S, CHU X Y, ZHAO X Y, et al. A visual/inertial integrated navigation algorithm based on improved Kalman filter[J]. Navigation Position & Timing, 2017, 4(2): 14-20. （in Chinese）

第41卷
第2期2020 年2月兵工学报ACTA
ARMAMENTARIIVol.41No.2Feb.2020

[1]	张福斌，林家昀. 深度相机与微机电惯性测量单元松组合导航算法[J]. 兵工学报, 2021, 42(1): 159-166.
[2]	沈世斌，谢非，赵静，钱伟行，康国华，刘锡祥. 基于相位控制的惯性与卫星超紧组合导航系统信号解调方法[J]. 兵工学报, 2020, 41(3): 495-506.
[3]	张梦得, 李开龙, 胡柏青, 吕旭. 辅助信息源短时失效下的捷联惯性基组合导航算法[J]. 兵工学报, 2020, 41(10): 2008-2015.
[4]	董春梅，任顺清，陈希军，李巍. 一种激光陀螺捷联惯性导航系统级标定方法[J]. 兵工学报, 2019, 40(8): 1618-1626.
[5]	徐昊玮，廉保旺，刘尚波. 基于滑动窗迭代最大后验估计的多源组合导航因子图融合算法[J]. 兵工学报, 2019, 40(4): 807-819.
[6]	马艳，刘小东. 状态自适应无迹卡尔曼滤波算法及其在水下机动目标跟踪中的应用[J]. 兵工学报, 2019, 40(2): 361-368.
[7]	李群生，赵剡，王进达. 一种适用于高动态强干扰环境的视觉辅助微机械捷联惯性导航系统/全球定位系统超紧组合导航系统[J]. 兵工学报, 2019, 40(11): 2241-2249.
[8]	刘生攀, 王文举, 饶兴桥. 单轴旋转捷联惯性导航系统误差分析与转位方案研究[J]. 兵工学报, 2018, 39(9): 1749-1755.
[9]	李伟，姜俊峰，任海波，张光辉. 行进间火炮指向稳定跟踪系统建模与控制[J]. 兵工学报, 2018, 39(8): 1479-1490.
[10]	周召发，胡文，张志利，徐梓皓，陈河. 一种新的捷联惯性导航系统姿态四元数方程求解方法[J]. 兵工学报, 2018, 39(3): 511-518.
[11]	闵艳玲，熊智，邢丽，刘建业，殷德全. 基于对偶四元数的惯性/卫星/天文组合导航系统改进联邦滤波方法[J]. 兵工学报, 2018, 39(2): 315-324.
[12]	张旭，崔乃刚，王小刚，崔祜涛，秦武韬. 一种鲁棒自适应容积卡尔曼滤波方法及其在相对导航中的应用[J]. 兵工学报, 2018, 39(1): 94-100.
[13]	赵志欣, 朱斯航, 洪升, 周新华, 王玉皞. 基于数字调幅广播外辐射源雷达的弱目标检测[J]. 兵工学报, 2017, 38(11): 2159-2165.
[14]	黄欣，熊智，许建新，徐丽敏. 基于零速/航向自观测/地磁匹配的行人导航算法研究[J]. 兵工学报, 2017, 38(10): 2031-2040.
[15]	高军强，汤霞清，黄湘远，程旭维. 减振系统造成捷联惯性导航误差的有限元分析方法[J]. 兵工学报, 2016, 37(9): 1570-1577.

基于速度约束与模糊自适应滤波的车载组合导航

Vehicle Integrated Navigation Based on Velocity Constraint and Fuzzy Adaptive Filtering

PDF

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价