Observability Analysis and Adaptive Information Fusion for Integrated Navigation of Unmanned Ground Vehicles

Integrated navigation of unmanned ground vehicles (UGV) is significant for many advanced intelligent transportation system applications. Adaptive information fusion technique based on observability analysis has a great potential to enhance UGV integrated navigation systems for the capability of high-precision positioning and navigation. In an integrated navigation system, the tolerance against unknown and time-varying observation conditions is a key factor to satisfy the specific requirements of high-precision, self-adaption, and high reliability. Thus, a novel adaptive federated Kalman filter (FKF) is proposed with time-varying information sharing factors based on the criteria for the degree of observability. In addition, an error-state cascaded integration architecture is designed for UGV integrated navigation. Simulation with real datasets gathered from road tests in urban areas showed that the new adaptive integrated navigation system can autonomously update FKF information sharing factors according to the measurement quality and the observability of each navigation error-state. Therefore, the accuracy, robustness, and fault-tolerance ability of the whole system can be effectively improved in a high dynamic environment.

[1]  Yong Li,et al.  Optimal Data Fusion Algorithm for Navigation Using Triple Integration of PPP-GNSS, INS, and Terrestrial Ranging System , 2015, IEEE Sensors Journal.

[2]  F. Ham,et al.  Observability, Eigenvalues, and Kalman Filtering , 1983, IEEE Transactions on Aerospace and Electronic Systems.

[3]  Agus Budiyono,et al.  Principles of GNSS, Inertial, and Multi-sensor Integrated Navigation Systems , 2012 .

[4]  Huiping Li,et al.  Receding Horizon Formation Tracking Control of Constrained Underactuated Autonomous Underwater Vehicles , 2017, IEEE Transactions on Industrial Electronics.

[5]  Fakhri Karray,et al.  Multisensor data fusion: A review of the state-of-the-art , 2013, Inf. Fusion.

[6]  Weigong Zhang,et al.  An Adaptive Fault-Tolerant Multisensor Navigation Strategy for Automated Vehicles , 2010, IEEE Transactions on Vehicular Technology.

[7]  Yuanqing Xia,et al.  Estimation of Information Sharing Error by Dynamic Deformation Between Inertial Navigation Systems , 2014, IEEE Transactions on Industrial Electronics.

[8]  Hong Cheng.  Autonomous Intelligent Vehicles - Theory, Algorithms, and Implementation , 2011, Advances in Computer Vision and Pattern Recognition.

[9]  Kai Shen,et al.  Quantifying Observability and Analysis in Integrated Navigation , 2018 .

[10]  Naser El-Sheimy,et al.  A New Federated Kalman Filter for Integrated Navigation System Based on SINS , 2007 .

[11]  Yuanqing Xia,et al.  Observability analysis of Mars entry integrated navigation , 2015 .

[12]  Éloi Bossé,et al.  Information Quality in Information Fusion and Decision Making , 2019, Information Fusion and Data Science.

[13]  Xiaofeng Wang,et al.  Networked Strong Tracking Filtering with Multiple Packet Dropouts: Algorithms and Applications , 2014, IEEE Transactions on Industrial Electronics.

[14]  Wei Jiang,et al.  A Multisensor Navigation System Based on an Adaptive Fault-Tolerant GOF Algorithm , 2017, IEEE Transactions on Intelligent Transportation Systems.

[15]  Vibhor L. Bageshwar,et al.  Stochastic Observability Test for Discrete-Time Kalman Filters , 2009 .

[16]  Frank Dellaert,et al.  Information fusion in navigation systems via factor graph based incremental smoothing , 2013, Robotics Auton. Syst..

[17]  Kojiro Takeyama,et al.  Improvement of Dead Reckoning in Urban Areas Through Integration of Low-Cost Multisensors , 2017, IEEE Transactions on Intelligent Vehicles.

[18]  Bin Li,et al.  Multi-sensor fusion methodology for enhanced land vehicle positioning , 2019, Inf. Fusion.

[19]  Yuanxin Wu,et al.  INS/GPS Integration: Global Observability Analysis , 2009, IEEE Trans. Veh. Technol..

[20]  Shengying Zhu,et al.  Observability-Based Beacon Configuration Optimization for Mars Entry Navigation , 2015 .

[21]  Steven Liu,et al.  Fusion Estimation for Sensor Networks With Nonuniform Estimation Rates , 2014, IEEE Transactions on Circuits and Systems I: Regular Papers.

[22]  Chang Liu,et al.  Measurement Dissemination-Based Distributed Bayesian Filter Using the Latest-In-and-Full-Out Exchange Protocol for Networked Unmanned Vehicles , 2017, IEEE Transactions on Industrial Electronics.

[23]  I. Bar-Itzhack,et al.  Observability analysis of piece-wise constant systems. I. Theory , 1992 .

[24]  Meiling Wang,et al.  Multi-sensor performance evaluation and management in integrated navigation based on observability analysis , 2019, 2019 Chinese Control And Decision Conference (CCDC).

[25]  Paul D. Groves,et al.  Principles of GNSS, Inertial, and Multi-sensor Integrated Navigation Systems , 2012 .

[26]  N. A. Carlson.  Federated square root filter for decentralized parallel processors , 1990 .

[27]  Yuanqing Xia,et al.  Distributed Federated Kalman Filter Fusion Over Multi-Sensor Unreliable Networked Systems , 2016, IEEE Transactions on Circuits and Systems I: Regular Papers.

[28]  Wen-an Zhang,et al.  Distributed Fusion Estimation With Missing Measurements, Random Transmission Delays and Packet Dropouts , 2014, IEEE Transactions on Automatic Control.