摘要
车载导航系统在理论研究与工程应用上向着智能化与可视化的方向发展。常用的导航方案一般都采用GPS/INS的组合方式,但其理论方法与应用研究工作几乎都集中在GPS和INS都可用条件下对卡尔曼滤波算法的替代或改进方面。在GPS信号无法覆盖以及INS精度下降情况下,如何采用低成本的系统重构方案以及智能信息融合算法来提高导航系统的可靠性与保证系统的导航精度是需要尽快解决的研究课题。
论文结合国家“863”计划项目“组合导航系统自主重构技术与智能导航算法研究”对车载导航系统重构技术与数据融合算法问题进行深入的研究。主要研究内容包括以下几个方面:
研究了车载导航系统的故障检测与隔离问题。在分析车载导航系统故障检测问题的基础上,采用小波技术对各传感器的状态信号作小波分析,在较短时间内发现故障点。通过模糊推理的方法在故障系统和非故障系统之间进行无扰动切换,隔离存在故障的系统,实现自适应系统重构。
研究了室外环境中基于点特征的同时定位与地图构建(Simultaneous Localization and Mapping-SLAM)算法。针对SLAM算法中存在的计算复杂度与信息丰富度之间的矛盾,提出提取环境陆标点特征并转化为线特征的P-L(Point to Line)地图构建算法,形成SLAM地图构建中室外环境信息表达的新方法。为提高地图创建方法的适应能力,从降低观测信息的不确定性入手,利用道路约束条件对SLAM算法中的状态向量进行估计,减少定位误差,增强地图创建的精确度。
研究了GPS信号失效时采用低成本组合方式进行系统重构的问题,设计基于地图构建的系统重构方案、基于协作伪卫星的系统重构方案,并完成可应用性分析。
研究了基于多模型的噪声自适应技术和非线性噪声耦合技术,用以提高系统状态估计的精度。将人工智能技术融合到尔曼滤波法中去,设计基于神经网络的自适应因子,用以调节滤波器增益,提高滤波稳定性。
在上述研究成果的基础上,以机动车沿特定的线路运动过程为基本考察对象,在车辆运动过程中进行卫星导航信号和惯性导航信号的采集、同步和处理,对提出的方案及算法实现动态过程模拟,验证方案及算法的有效性。
Vehicular navigation is launched on its ways to intelligentization and visualization. The terms of GPS/INS integrated navigation is generally used on the conventional navigation plan whose theoretical approaches and applicational researches focus more on replacement or improvement of Kalman filtering algorithm only if the GPS and INS are both available. Subject to the coverage of the signal of GPS and the precision of the INS, however, how to improve the reliability and precision of the navigation system using low-cost system reconstruction scheme and intelligent information fusion algorithm is a research subject which needs urgent solution.
With the supports of the 863 Program‘Study on system reconstruction and intelligent information fusion algorithm of integrated navigation’, this dissertation deeply studies the technique of vehicular navigation system reconstruction and the algorithm of information fusion. The main contents of this dissertation are as follows.
Firstly, the technology of the fault detection and isolation of vehicular navigation is studied. The state signals of the sensors are conducted with the wavelet analysis in order to detect the malfunction in a short time, which is based on analyzing the problem of fault detection for the vehicular navigation system. Non-disturbance switch from the failure system to the non-fault system is executed using the fuzzy reasoning method, which can isolate the fault point, and then, the adaptive reconstruction of system is realized.
Secondly, the point to line P-L Simultaneous Localization and Mapping (SLAM) algorithm which is based on the outdoor environment is researched. For the conflict between the computational complexity and the information richness mapping Algorithm which transforms the point features of environmental signs into the line characteristics is proposed to form a new method to express the information of outdoor environment. As starting with reducing the uncertainties of observable information, the state vectors of SLAM algorithm are estimated using the constraints of roads, which can reduce the positioning error and increase the map accuracy, in order to enhance the adaptive ability of map creation.
Next, the issue of system reconstruction using low-cost compound mode when the signal of GPS is unavailable is worked. The system reconstruction programs based on the map building and synergic pseudo-satellite are designed and the feasibility is analyzed.
Then, the technologies of noise adaptive based on the multi-model and nonlinear noise coupling are investigated to increase the accuracy of estimation of system states. Neural network-based adaptive factors are designed, which incorporate the Kalman filtering algorithm with the artificial intelligence technology, to adjust filter gain and improve the filter stability.
Lastly, on the basis of the above research results, focusing on the procedure of the motor vehicle moving along a specific trajectory, the dynamic simulation is conducted, with acquiring, synchronizing and manipulating the signals of the satellite navigation and inertial navigation acquisition during vehicle moving, to illustrate the efficaciousness of the programs and algorithms which is proposed.
引文
1. F. A. Faruqi, K.J. Turner. Extended Kalman Filter Synthesis for Integrated Global Positioning/Inertial Navigation Systems. Applied Mathematics and Computation. 2000, 115(2):213~227
2. C. Hide, T. Moore, M. Smith. Adaptive Kalman Filtering Algorithms for Integrating GPS and Low Cost INS. Symposium of Position Location and Navigation. 2004(4): 227~233
3.王惠南. GPS导航原理与应用.北京:科学出版社. 2003:230~240
4. T. D. Kinght. Rapid Development of Tightly Coupled GPS/INS System. IEEE Aerospace and Electronic Systems Magazine. 1997, 12(4):14~19
5.徐中明,陈旭,贺岩松,文琍.智能交通系统(ITS)中的智能汽车技术.重庆大学学报. 2005, 28(8):17~21
6. M.A.P. Taylor. Intelligent Transport Systems: Emerging Technologies and Methods in Transportation and Traffic. Transportation Research. 2004, C(3-4):167~169
7. M. A. Quddus. High Integrity Map Matching Algorithms for Advanced Transport Telematics Applications. PhD Thesis of University of London. 2006:29~34
8.粘振华编译.美国信息战的现状与未来(连载一).情报指挥控制系统与仿真技术, 2003, (3):6~17
9.粘振华编译.美国信息战的现状与未来(连载二).情报指挥控制系统与仿真技术, 2003, (4):1~11
10.张国良,曾静.组合导航原理与技术.西安:西安交通大学出版社. 2008:108~110
11. O. Mezentsev, Y. Lu, G. Lachapelle & R. Klukas Vehicle Navigation in Urban Canyons Using a High Sensitivity GPS Receiver Augmented with a Low Cost Rate Gyro. In Proceedings of ION GPS 2000 Conference. Portland, OR, USA, September 2002:35~42
12. Peter. Stromback. Integrating GPS and INS with a Tightly Coupled Kalman Filter Using Proximity Information for Compensating Signal Loss. PhD Thesis,March 2003:63~70
13. K. W. Chiang. INS/GPS Integration Using Neural Networks for Land Vehicular Navigation Applications. PhD Thesis of University of Calgary, 2004:156~158
14. A. Noureldin, A. Osman, N. El-Sheimy. A Neuro-Wavelet Method for Multi-Sensor System Integration for Vehicular Navigation. J. Meas. Sci. Technol., 2004, 15(2):404~412
15. R. Sharaf, A. Noureldin, A. Osman, N. El-Sheimy. Online INS/GPS Integration with a Radial Basis Function Neural Network. IEEE Aerosp. Electron. Syst. Mag., 2005, 20(3): 8~14
16. L. Semeniuk, A. Noureldin. Bridging GPS Outages Using Neural Network Estimates of INS Position and Velocity Errors. J. Meas. Sci. Technol., 2006, 17:2783~2798
17. Z. H. Li, W. Chen. A New Approach to Map-Matching and Parameter Correcting for Vehicle Navigation System in the Area of Shadow of GPS Signal. Proceedings of the 8th International IEEE Conference on Intelligent Transportation Systems. Vienna, Austria, 2005:425~430
18. R. Smith, M. Self, P. Cheeseman. Estimating Uncertain Spatial Relationships in Robotics. Uncertainty in Artificial Intelligence. Elsevier Science, 1988(2):435~461
19.王璐,蔡自兴.未知环境中移动机器人并发建图与定位(CML)的研究进展.机器人. 2004, 26(4):380~384
20. E. Nobot. Simultaneous Localization and Mapping. 2002 Summer School, Australian Centre for Field Robotics. The University of Sydney. July 2002:231~237
21. Kwang Wee Lee, Sardha Wijesoma, Javier Ibanez Guzman. A Constrained SLAM Approach to Robust and Accurate Localization of Autonomous Ground Vehicles. Robotics and Autonomous Systems. 2007:1~14
22. J. Kim. Autonomous Navigation for Airborne Applications. PhD thesis, 2004:67~74
23.徐景硕,王维江.容错多传感器组合导航系统发展综述.航空电子技术. 2006, 37(3):25~28
24. M. M. Reda, A. Noureldin, N. El-Sheimy. Improving INS/GPS Positioning Accuracy during GPS Outages Using Fuzzy Logic. Proc.Inst.Nav.GPS/GNSS Conf. Sep., 2003:449~508
25.潘泉,于听,程咏梅,张洪才.信息融合理论的基本方法与进展.自动化学报. 2003, 29(4): 599~615
26. Y. M. Zhu et al. The Optimality for the Distributed Kalman Filtering Fusion with Feedback. Automatica. 2001, 37:1489~1493
27. V. Igor. Maslov, Izidor Gertner. Multi-sensor Fusion: an Evolutionary Algorithm Approach. Information Fusion. 2006(7):304~330
28.甄子洋,王志胜,王道波.基于信息融合最优估计的非线性离散系统预测控制.自动化学报. 2008(34):331~336
29. Wang Zhi-Sheng, Wang Dao-Bo, Zhen Zi-Yang. Primary Exploration of Nonlinear Information Fusion Control Theory. Science in China (Series F): Information Sciences. 2007, 50(5):686~696
30. S. J. Julier, J. K. Uhlmann. The Scaled Unscented Ttransformation. In Proc. American Control Conference. Anchorage, Alaska, USA. 2002:4555~4559
31. J. Simon Julier, K. Jeffrey Uhlmann. Unscented Filtering and Nonlinear Estimation. Proceedings of the IEEE. 2004(92):401~422
32. R. Karlsson, N. Bergman. Auxiliary Particle Filters for Tracking a Maneuvering Target. Proceedings of the 39th IEEE Conference on Decision and Control. Sydney, Australia. 2000:3891~3895
33. T李艳华,房建成.一种多模型自适应联邦滤波器及其在INS/CNS/GPS组合导航系统中的应用. T航天控制. 2003(1):33~38
34. R. Vander Merwe, A. Doucet, N. Freitas, E.A. Wan. The Unscented Particle Filter. Technical Report CUEDPF-INFENGPTR 380. Cambridge University, 2000:49~54
35. A. H. Mohamed, K.P. Schwarz. Adaptive Kalman Filtering for INS/GPS. Journal of Geodesy. 1999(73):193~203
36. J. Z. Sasiakek, Q. Wang, M.B. Zeremba. Fuzzy Adaptive Kalman Filtering for INS/GPS Data Fusion. Proceedings of the 15th IEEE Intelligent Control. GREECE, 2000:181~186
37.韩崇昭,朱洪艳等.多元信息融合.北京:清华大学出版社, 2006(4):60~ 62
38. N. A. Carlson. Federated Square Root Filter for Decentralized Parallel Processes. Proc of NAECON. Dayton, OH, 1987:1448~1456
39.耿延睿,崔中兴,张洪钺,房建成.衰减因子自适应滤波及在组合导航中的应用.北京航空航天大学学报. 2004, 30(5):434~437
40. T. Kirubarajan, Y. Bar-Shalom. Kalman Filter versus IMM Estimerator: When Do We Need the Latter. IEEE Transactions on Aerospace and Electronic Systems. 2003, 39(4):1452~1456
41. J. F. Ru, X.R. Li. Interacting Multiple Model Algorithm with Maximum Likelihood Estimation for FDI. International Symposium on Intelligent Control. Houston, Texas. 2003:661~666
42.臧荣春.基于信息融合的组合导航系统研究与移动信息平台设计.哈尔滨工业大学博士论文. 2007:80~85
43. K. W. Chiang, A. Noureldin, N. El-Sheimy. Multi-Sensors Integration Using Neuron Computing for Land Vehicle Navigation. GPS Solutions. Heidelberg, Germany:Springer-Verlag, 2003, 6(3):209~218
44. T. Rafael, A. Z. Miguel, F. G. Antonio. IMM-EKF Based Road Vehicle Navigation with Low Cost GPS/INS. IEEE Multisensor Fusion and Integration for Intelligent Systems Conference. Heidelberg, Germany. 2006:433~438
45.臧荣春,崔平远.马尔科夫参数自适应IFIMM算法研究.电子学报. 2006, 34(3):521~524
46.王子亮,房建成,全伟.基于遗传算法的多模型Kalman滤波算法及应用研究.北京航空航天大学学报. 2004, 30(8):748~782
47. M. Hassan, G. Salut, M. Singh, A. Titli. A Decentralized Computational Algorithm for the Global Kalman Filter. IEEE Trans. Automatic Control. 1978(23):262~268
48. K. W. Chiang. INS/GPS Integration Using Neural Networks for Navigation Applications. PhD Thesis, Department of Geomatics Engineering. University of Calgary. November 2004:36~43
49.何友,关欣,王国宏.多传感器信息融合研究进展与展望.宇航学报. 2005, 7(26):524~530
50.白宇骏,徐晓苏等.神经网络辅助卡尔曼滤波技术在组合导航系统中的应用研究.中国惯性技术学报. 2003, 11(2):40~43
51. A. Hiliuta, R. Landry, F. Gagnon. Fuzzy Corrections in a GPS/INS Hybrid Navigation System. IEEE Trans. Aerosp. Electron. Syst. 2004, 2(2):591~600
52. C. Leonard. Application of Neural Networks in Target Tracking Data Fusion. IEEE Trans. AES, 1994, 30(6):281~287
53.权太范.信息融合-神经网络-模糊推理理论与应用.北京:国防工业出版社. 2002:224~275
54.朱海,莫军.水下导航信息融合技术.北京:国防工业出版社. 2002:122~133
55. K. W. Chiang. INS/GPS Integration Using Neural Networks for Land Vehicular Navigation Applications. PhD Thesis of University of Calgary. 2004:156~185
56. N. El-Sheimy, A. H. Walid, G. Lachapelle. An Adaptive Neuro-Fuzzy Model For Bridging GPS Outages In MEMS-IMU/GPS Land Vehicle Navigation. Proceedings of ION GNSS 2004. Long Beach, CA, USA. 2004:1088~1095
57. K. W. Chiang, A. Noureldin, N. El-Sheimy. Multi-sensors Integration Using Neuron Computing for Land Vehicle Navigation. GPS Solutions. Springer-Verlag Heidelberg. March 2003:209~218
58. C. Leonard. Application of Neural Networks in Target Tracking Data Fusion. IEEE Trans. AES, 1994, 30(6):281~287
59. Anshuman Bhagwat, Rajagopalan Srinivasan, P. R. Krishnaswamy. Fault Detection During Process Transitions: A Model-Based Approach. Chemical Engineering Science. 2003(58):309~325
60. Z. Gao, Steven X. Ding.Actuator Fault Robust Estimation and Fault-tolerant Control for a Class of Nonlinear Descriptor Systems. Automatica. 2007(43) 912~920
61. T. W. Peter, Yang Wen-xian, H.Y. Tam. Machine Fault Diagnosis Through an Efective Exact Wavelet Analysis. Journal of Sound and Vibration. 2004, 11(5):1005~1024
62. A. Noureldin, A. Osman, N. El-Sheimy. A Neuro-Wavelet Method for Multi-Sensor System Integration for Vehicular Navigation. J. Meas. Sci. Technol., 2004, 15(2): 404~412
63. Y. Zhang, J. Jiang. Bibliographical Review on Reconfigurable Fault-tolerant Control Systems. Annual Reviews in Control 2008(32):229~252
64.李邦清,刘辉等.一种基于小波变换的故障诊断改进算法.中国惯性技术学报. 2007, 15(1):113~115
65. Yukihiro Kubo, Syohei Fujioka et al. Nonlinear Filtering Methods for the INS/GPS In-motion Alignment and Navigation. International Journal of Innovative Computing Information and Control. 2006(2):1137~1151
66. I. Daubechies. The Wavelet Transform Time-frequency Localization and Signal Analysis. IEEE Transactions on Information Theory. 1990, 36(5):961~970
67. J. Guivat, E. Nebot, H. Durrant-Whyte. Simultaneous Localization and Map Building Using natural Features in Outdoor Environments. In Proc.IAS-6 Intell. Auton. Syst., Italy, July 2000:581~586
68. S. Thrun, D. Koller. Simultaneous Mapping and Localization With Sparse Extended Information Filters: Theory and Initial Results. USA: Carnegie Mellon University. 2002:3~5
69. M. Di Marco, S. Garulli, S. Lacroix. A Set Theoretic Approach to the Simultaneous Localization and Map Building Problem. Proceedings of the 39th IEEE Conference on Decision and Control. Sidney, 2000:833~838
70. A. Elfes. Sonar-based Real-world Mapping and Navigation. IEEE Journal of Robotics and Automation. 1987, RA-3(3):249~265
71. S. Thrun, D. Koller, Z. Ghahramani, H. Durrant-Whyte, A. Y. Ng. Simultaneous Mapping and Localization with Sparse Extended Information Filter. Proc. of WAFR, 2002:233~242
72. H. Choset, K. Nagatani. Topological Simultaneous Localization and Mapping (SLAM): Toward Exact Localization Without Explicit Localization. IEEE Transactions on Robotics and Automation. 2001, 17(2):125~137
73. J. Guivant, E. Nebot. Optimization of the Simultaneous Localization and Map-Building Algorithm for Real-Time Implementation. IEEE Journal of Robotic and Automation. 2001, 11(3):242~257
74.罗荣华,洪炳镕.移动机器人同时定位与地图创建研究进展.机器人. 2004,26(2):182~186
75. R. L. French. Map Matching Origins. Approaches and Applications. Proc. of Second International Symposium on Land Vehicle Navigation. 1989:91~116
76.庄严,王伟等.移动机器入基于激光测距和单目视觉的室内同时定位和地图构建.自动化学报, 2005,32(1):925~933
77. Han Rui, Li Wen-Feng. Line-feature-based SLAM Algorithm. ActaAutomatica Sinica, 2006, 32(1):43~46
78. P. Cheeseman, R. Smith, M. Self. Estimating Uncertain spatial relationships in robotics in Uncertainty in Artificial Intelligence. Elsevier Science. 1988 (2):435~461
79. S. Y. Xu, T. W. Chen. Robust H∝Filtering for Uncertain Impulsive Stochastic Systems under Sampled Measurements. Automatica. 2003, 39(3):509~516
80. Y. S. Hung, F. W. Yang . Robust H∝Filtering with Error Variance Constraints for Discrete Time-varying Systems with Uncertainty. Automatica. 2003, 39(7):1185~1194
81. L. H Xie, L. L. Lu, D. Zhang, eta1. Improved Robust H_2 and H_∝Filtering for Uncertain Discrete-time Systems. Automatica, 2004,40(5):873~880
82. J. D. Tard′os, J. Neira, P. M. Newman, J. Leonard. Robust Mapping and Localization in Indoor Environments Using Sonar Data. International Journal of Vehicleics Research. 2002, 21(4):311~330
83. N. Tomatis, I. Nourbakhsh, R. Siegwart. Hybrid Simultaneous Localization and Map Building: a Natural Integration of Topological and Metric. Robotics and Autonomous Systems. 2003, 44(1):3~14
84.季秀才,郑志强,张辉. SLAM问题中机器人定位误差分析与控制.自动化学报. 2008(34):323~330
85. Dan Simon, Tie Li Chia. Kalman Filtering with State Equality Constraints. IEEE Transactions on Aerospace and Electronic Systems. 2002, 39(1):128~136
86. Kwang Wee Lee, Sardha Wijesoma. A Constrained SLAM Approach to Robust and Accurate Localisation of Autonomous Ground Vehicles. Robotics and Autonomous Systems. 2007(2):1~14
87. M. Montemerlo, S. Thrun. Simultaneous Localization and Mapping with Unknown Data Association Using FastSLAM. Proceedings of the IEEE International Conference on Robotics and Automation, 2003:1985~1991
88. Juan Pablo Gonzalez. Planning with Uncertainty in Position Using High-Resolution Maps. Carnegie Mellon University. 2006(10):17~47
89. Jonghyuk Kim, Salah Sukkarieh. 6DoF SLAM aided GNSS/INS Navigation in GNSS Denied and Unknown Environments. Journal of Global PositioningSystems. 2005(4):120~128
90. J. Kim. Autonomous Navigation for Airborne Applications . Australian Centre for Field Robotics. The University of Sydney, 2004:4~7
91. Giorgio Grisetti, Gian Diego Tipaldib. Fast and accurate SLAM with Rao-Blackwellized Particle Filters. Robotics and Autonomous Systems, 2006:1~9
92. D. Fox, W. Burgard, H. Kruppa, S. Thun. Collaborative Multi-Robot Localization. In proceedings of the 23rd German Conference on Artificial Intelligence. Springer Verlag, 1999:343~351
93. D. Fox, W. Burgard, H. Kruppa, S. Thun. A Probabilistic Approach to Collaborative Multi-Robot Localization. In Autonomous Robots. 2000 (8):325~344
94. Chris Hide, Terry Moore, Chris Hill, David Park. Low Cost High Accuracy Positioning in Urban Environments. The Journal of Navigation. 2006(59):365~379
95. J. K. Hedrick, J. Jang, A. Potier. Cooperative Multiple-Sensor Fusion for Automated Vehicle Control. California PATH Research Report. 2004(7):43~47
96.袁建平,罗建军,岳晓奎.卫星导航原理与应用.北京:中国宇航出版社. 2003:305~336
97. X. R. Li, Y. Bar-Shalom. Performance Prediction of the IMM Algorithms. IEEE Trans. on AES. 1993, 29(3):755~770
98.蔡洪.噪声统计的Bayes极大验后估计与系统自适滤波.国防科技大学学报. 1997(1):8~15
99. S. J. Julier, J. K. Uhlmann, H. F. Durrant-Whyte.A New Approach for Filtering Nonlinear System. Proceedings of the American Control Conference. USA, 1995: 628~1632
100.邓自立.自校正滤波理论及其应用.哈尔滨工业大学出版社. 2003:32~45
101. Y. Yi, D. A. Grejner-Brzezinska. Nonlinear Bayesian Filter: Alternative to the Extended Kalman Filter in the GPS/INS Fusion Systems. Proc. of the Institute of Navigation. ION GNSS 2005, Long Beach, CA, 2005:1391~1400
102. S. Park, J. Hwang, K. Rou, and E. Kim. A New Particle Filter Inspired by Biological Evolution: Genetic Filter. Transactions on Engineering, Computing and Technology. 2007(19):1305~5313
103. Z. L. Deng, R. B. Qi. Multi-Sensor Information Fusion Suboptimal Steady-State Kalman Filter. Chinese Science Abstracts. 2000, 6(2):183~184
104. J. D Gautier. GPS/INS Generalized Evaluation Tool (GIGET) for the Design and Testing of Integrated Navigation Systems. PhD Thesis of Stanford University. 2003:8~16
105.王胜标,王俊璞,倪静静等. GPS/INS组合导航算法性能评估平台.中国惯性技术学报. 2007, 15(2):181~184
106.邢广华,刘建业,孙永荣等.多信息融合组合导航半物理仿真系统设计与实现.航天控制. 2005, 23(2):64~68
107.张国良,曾静.惯性/卫星组合导航半实物仿真系统设计.导弹与航天运载技术. 2007, 9(4):202~203
108.徐田来.车载组合导航信息融合算法研究与系统实现.哈尔滨工业大学博士论文. 2008:90~95