捷联惯导/里程计高精度组合导航算法

doi:10.3969/j.issn.1000-1093.2014.04.001

摘要/Abstract

摘要： 针对里程计(OD)刻度系数误差和惯导安装误差角对车载捷联惯导(SINS)/OD组合导航系统的影响，重新推导并建立了新的量测方程，在此基础上加入故障检测的方法，从而构成了新的组合导航算法。该组合导航算法能够有效地提高组合导航精度，及时准确地检测出量测故障；同时该组合导航算法同样适用于车辆运动学约束辅助导航模式，为OD发生故障时提供了一种容错方案。仿真结果验证了该算法的有效性。

关键词: 控制科学与技术, 捷联惯导系统, 里程计, 刻度系数误差, 安装误差角, 故障检测

Abstract: To solve the problems induced by the scale factor error of odometer (OD) and the installation error of inertial measurement unit in the vehicle strapdown inertial navigation system (SINS)/OD integrated navigation system, a SINS/OD integrated navigation algorithm is proposed, in which a new measurement equation is established and a fault detection method is introduced. This algorithm can effectively improve the navigation accuracy, and accurately detect the fault in time. It can also be suitable for the navigation mode aided by vehicle kinematics constraints to provide a fault-tolerant scheme for OD fault. The simulation results show that the algorithm is effective.

Key words: control science and technology, strapdown inertial navigation system, odometer, scale factor error, installation error, fault detection

中图分类号:

U666.12

赵洪松，缪玲娟，沈军. 捷联惯导/里程计高精度组合导航算法[J]. 兵工学报, 2014, 35(4): 433-440.

ZHAO Hong-song, MIAO Ling-juan, SHEN Jun. High Accuracy Algorithm for SINS/Odometer Integrated Navigation System[J]. Acta Armamentarii, 2014, 35(4): 433-440.

参考文献

［1］丁文娟, 李岁劳, 熊伟. 捷联惯导系统/里程计自主式车载组合导航系统研究[J]. 计测技术, 2006, 26(1):14-16.
DING Wen-juan, LI Sui-lao, XIONG Wei. Research on SINS/OD independently integrated navigation system for land vehicles[J]. Metrology & Measurement Technology, 2006, 26(1):14-16. (in Chinese)
[2] 朱立彬, 王玮. 基于滑动模型的车辆里程仪标度因数标定方法[J]. 系统工程与电子技术, 2012, 34(4):778-781.
ZHU Li-bin, WANG Wei. Calibration of odometer’s scale factor based on sliding model[J]. Systems Engineering and Electronics, 2012, 34(4):778-781. (in Chinese)
[3] Skog I, Hndel P. In-car positioning and navigation technologies-a survey[J]. IEEE Transactions on Intelligent Transportation Systems, 2009, 10(1):4-21.
[4] Georgy J, Karamat T, Iabal U, et al. Enhanced MEMS-IMU/odometer/GPS integration using mixture particle filter[J]. GPS Solutions, 2011, 15(3):239-252.
[5] Georgy J, Noureldin A, Korenberg M J, et al. Modeling the stochastic drift of a MEMS-based gyroscope in gyro/odometer/GPS integrated navigation[J]. IEEE Transactions on Intelligent Transportation Systems, 2010, 11(4):856-872.
[6] Duong T T, Huang Y W, Chiang K W. Improving the accuracy of mems IMU/GPS POS systems for land-based mobile mapping system by using tightly coupled integration and auxiliary odometer[C]∥31st Asian Conference on Remote Sensing. Tokyo, Japan: Asian Association on Remote Sensing, 2010:515-520.
[7] Wang W, Wang D. Land vehicle navigation using odometry/INS/vision integrated system[C]∥2008 IEEE International Conference on Cybernetics and Intelligent Systems. Chengdu: IEEE Computer Society, 2008:754-759.
[8] 徐田来，崔平远，崔祜涛. 车载多传感器组合导航系统设计与实现[J]. 系统工程与电子技术, 2008, 30(4):686-691.
XU Tian-lai, CUI Ping-yuan, CUI Hu-tao. Design and implementation of multi-sensor integrated navigation system of land vehicle[J]. Systems Engineering and Electronics, 2008, 30(4): 686-691. (in Chinese)
[9] 严恭敏. 车载自主定位定向系统研究[D]. 西安：西北工业大学, 2006.
YAN Gong-min. Research on autonomous position and azimuth determining systems for land vehicles[D]. Xi’an: Northwestern Polytechnical University, 2006. (in Chinese)
[10] 肖煊, 王清哲, 程远, 等. 捷联惯导系统/里程计高精度紧组合导航算法[J]. 兵工学报, 2012, 33(4):395-400.
XIAO Xuan, WANG Qing-zhe, CHENG Yuan, et al. High accuracy navigation algorithm for tightly coupled INS/odometer[J]. Acta Armamentarii, 2012, 33(4):395-400. (in Chinese)
[11] Kim S B, Bazin J C, Lee H K, et al. Ground vehicle navigation in harsh urban conditions by integrating inertial navigation system, global positioning system, odometer and vision data[J]. IET Radar, Sonar & Navigation, 2011, 5(8):814-823.
[12] 付强文, 秦永元, 李四海, 等. 车辆运动学约束辅助的惯性导航算法[J]. 中国惯性技术学报, 2012, 20(6):640-643.
FU Qiang-wen, QIN Yong-yuan, LI Si-hai, et al. Inertial navigation algorithm aided by motion constraints of vehicle[J]. Journal of Chinese Inertial Technology, 2012, 20(6):640-643. (in Chinese)
[13] 兰春云, 缪玲娟, 沈军. 陆用捷联惯导系统中里程计刻度因子的在线辨识[J]. 北京理工大学学报, 2003, 23(2):198-201.
LAN Chun-yun, MIAO Ling-juan, SHEN Jun. Online-identification of odometer’s scale factor in land-used strapdown inertial navigation system[J]. Transactions of Beijing Institute of Technology, 2003, 23(2):198-201. (in Chinese)
[14] 刘建业, 曾庆化, 赵伟, 等. 导航系统理论与应用[M]. 西安: 西北工业大学出版社，2010:336-337.
LIU Jian-ye, ZENG Qing-hua, ZHAO Wei, et al. Navigation system theory and application[M]. Xi’an: Northwestern Polytechnical University Press, 2010:336-337. (in Chinese)
[15] 方靖, 顾启泰, 丁天怀. 车载惯性导航的动态零速修正技术[J]. 中国惯性技术学报, 2008, 16(3):265-268.
FANG Jing, GU Qi-tai, DING Tian-huai. Dynamic zero velocity update for vehicle inertial navigation system[J]. Journal of Chinese Inertial Technology, 2008, 16(3):265-268. (in Chinese)
[16] Godha S, Cannon M E. GPS/MEMS INS integrated system for navigation in urban areas[J]. GPS Solutions, 2007, 11(3):193-203.
[17] Dissanayake G, Sukkarieh S, Nebot E, et al. The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications[J]. IEEE Transactions on Robotics and Automation, 2001, 17(5):731-747.
[18] 吴富梅, 杨元喜. 附加速度先验信息的车载GPS/INS/Odometer组合导航算法[J]. 宇航学报, 2010, 31(10):2314-2320.
WU Fu-mei, YANG Yuan-xi. GPS/INS/odometer integrated navigation algorithm with prior velocity in land vehicle system[J]. Journal of Astronautics, 2010, 31(10):2314-2320. (in Chinese)
[19] 石静, 缪玲娟, 倪茂林. 一种抗野值自适应滤波算法及在MEMS-SINS/GPS中应用[J]. 宇航学报, 2010, 32(12): 2711-2716.
SHI Jing, MIAO Ling-juan, NI Mao-lin. An outlier rejecting and adaptive filter algorithm applied in MEMS-SINS/GPS[J]. Journal of Astronautics, 2010, 32(12): 2711-2716. (in Chinese)

[1]	曹昊哲, 刘全攀. 基于半直接法的无人集群协同视觉SLAM算法[J]. 兵工学报, 2023, 44(11): 3345-3358.
[2]	张福斌，张炳烁，杨玉帅. 基于单目/IMU/里程计融合的SLAM算法[J]. 兵工学报, 2022, 43(11): 2810-2817.
[3]	史贤俊，王康，韩旭，龙玉峰. 基于层次Bayesian网络及后验风险准则的故障样本量确定方法[J]. 兵工学报, 2019, 40(1): 171-181.
[4]	田灵飞，钱林方，陈龙淼，岳才成. 基于未知输入观测器的车载炮电液位置伺服系统故障检测[J]. 兵工学报, 2018, 39(11): 2100-2108.
[5]	李炳乾，董文瀚，马小山. 无人机编队保持反步容错控制[J]. 兵工学报, 2018, 39(11): 2172-2184.
[6]	苗建明，王少萍，范磊，李元. 欠驱动自主水下航行器空间曲线路径跟踪控制研究[J]. 兵工学报, 2017, 38(9): 1786-1796.
[7]	查峰，覃方君，李京书，叶斌. 三轴旋转惯性导航系统的旋转控制建模研究[J]. 兵工学报, 2017, 38(8): 1610-1618.
[8]	伍明，张国良，李琳琳，付光远，李承剑. 基于动态和静态环境对象观测一致性约束的移动机器人多传感器标定优化方法[J]. 兵工学报, 2017, 38(8): 1630-1641.
[9]	王世峰，都凯悦，孟颖，王锐. 基于机器学习的车辆路面类型识别技术研究[J]. 兵工学报, 2017, 38(8): 1642-1648.
[10]	周荻，董金鲁. 带襟翼的飞行器非线性控制系统分析和设计[J]. 兵工学报, 2017, 38(7): 1322-1329.
[11]	郑睿，赵伟，方明星，杜友武. 基于多圈环绕结构的超流体陀螺噪声抑制方法[J]. 兵工学报, 2017, 38(7): 1330-1335.
[12]	邢丽, 熊智, 刘建业, 杭义军. 基于对偶四元数的圆锥及划船误差补偿改进算法[J]. 兵工学报, 2017, 38(7): 1336-1347.
[13]	庞辉, 陈嘉楠, 刘凯. 汽车磁流变半主动悬架系统自适应反推跟踪控制[J]. 兵工学报, 2017, 38(7): 1430-1442.
[14]	马艳彤，郑荣，韩晓军. 面向海底光学探测使命的自治水下机器人水平路径跟随控制[J]. 兵工学报, 2017, 38(6): 1147-1153.
[15]	陈慧岩，陈舒平，龚建伟. 智能汽车横向控制方法研究综述[J]. 兵工学报, 2017, 38(6): 1203-1214.