EGP-CDKF for Performance Improvement of the SINS/GNSS Integrated System

Position and orientation system (POS), which typically integrates strapdown inertial navigation system (SINS) and global navigation satellite system (GNSS), serves as a key sensor in airborne remote sensing, mobile mapping, and vehicle localization. POS can provide reliable, high-frequency and high-precision motion parameters using nonlinear Kalman Filter models based on fusion methods, such as extended Kalman filter, unscented Kalman filter, central difference Kalman filter (CDKF), and square root CDKF (SR-CDKF). Although the nonlinear parametric models are of high efficiency, there are also limitation on their capabilities of prediction and estimation, as it is often impossible to model all aspects of POS. In this paper, Gaussian processes (GP)-based is presented to enhance the capabilities of prediction and estimation for parametric CDKF. On one hand, it can estimate the state vector of POS with the nonlinear parametric CDKF on condition that trained data is limited; on the other hand, GP can take both the noise and the uncertainty in the nonlinear parametric CDKF into consideration. Consequently, the incorporation of GP into CDKF can result in further performance improvement. The proposed approach is verified in the real experiment, and shows that large performance benefits are achieved through applying the enhanced GP-CDKF(EGP-CDKF) into the SINS/GNSS integrated system.

[1]  Dieter Fox,et al.  GP-UKF: Unscented kalman filters with Gaussian process prediction and observation models , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Dieter Fox,et al.  GP-BayesFilters: Bayesian filtering using Gaussian process prediction and observation models , 2008, IROS.

[3]  Qing Wang,et al.  Map Matching in Road Crossings of Urban Canyons Based on Road Traverses and Linear Heading-Change Model , 2007, IEEE Transactions on Instrumentation and Measurement.

[4]  Aboelmagd Noureldin,et al.  Performance Enhancement of MEMS-Based INS/GPS Integration for Low-Cost Navigation Applications , 2009, IEEE Transactions on Vehicular Technology.

[5]  Christopher K. I. Williams,et al.  Gaussian Processes for Machine Learning (Adaptive Computation and Machine Learning) , 2005 .

[6]  Nanning Zheng,et al.  A SLAM algorithm based on the central difference Kalman filter , 2009, 2009 IEEE Intelligent Vehicles Symposium.

[7]  Martin M. Andreasen Non-Linear DSGE Models and the Central Difference Kalman Filter , 2011 .

[8]  Youan Zhang,et al.  Central Difference Particle Filter Applied to Transfer Alignment for SINS on Missiles , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[9]  H.F. Durrant-Whyte,et al.  A new approach for filtering nonlinear systems , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[10]  Carl E. Rasmussen,et al.  Gaussian Processes for Data-Efficient Learning in Robotics and Control , 2015, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[11]  C. Karen Liu,et al.  Learning physics-based motion style with nonlinear inverse optimization , 2005, ACM Trans. Graph..

[12]  Kai-Wei Chiang,et al.  A Feasibility Analysis of Land-Based SINS/GNSS Gravimetry for Groundwater Resource Detection in Taiwan , 2015, Sensors.

[13]  Jiancheng Fang,et al.  A Hybrid Prediction Method for Bridging GPS Outages in High-Precision POS Application , 2014, IEEE Transactions on Instrumentation and Measurement.

[14]  C. Rasmussen,et al.  Gaussian Process Priors with Uncertain Inputs - Application to Multiple-Step Ahead Time Series Forecasting , 2002, NIPS.

[15]  Jiancheng Fang,et al.  A Modified Nonlinear Two-Filter Smoothing for High-Precision Airborne Integrated GPS and Inertial Navigation , 2015, IEEE Transactions on Instrumentation and Measurement.

[16]  Martin P. Mintchev,et al.  Accuracy limitations of FOG-based continuous measurement-while-drilling surveying instruments for horizontal wells , 2002, IEEE Trans. Instrum. Meas..

[17]  Tao Zhang,et al.  A Kalman Filter for SINS Self-Alignment Based on Vector Observation , 2017, Sensors.

[18]  Ryosuke Shibasaki,et al.  UAV-Borne 3-D Mapping System by Multisensor Integration , 2009, IEEE Transactions on Geoscience and Remote Sensing.

[19]  Niels Kjølstad Poulsen,et al.  New developments in state estimation for nonlinear systems , 2000, Autom..

[20]  P. Vanicek,et al.  DOES A NAVIGATION ALGORITHM HAVE TO USE A KALMAN FILTER , 1999 .

[21]  Rudolph van der Merwe,et al.  Sigma-point kalman filters for probabilistic inference in dynamic state-space models , 2004 .

[22]  V. Agarwal,et al.  Design and Development of a Real-Time DSP and FPGA-Based Integrated GPS-INS System for Compact and Low Power Applications , 2009, IEEE Transactions on Aerospace and Electronic Systems.

[23]  Kazufumi Ito,et al.  Gaussian filters for nonlinear filtering problems , 2000, IEEE Trans. Autom. Control..

[24]  Liang Zhong,et al.  Boresight Calibration of Airborne LiDAR System Without Ground Control Points , 2012, IEEE Geosci. Remote. Sens. Lett..

[25]  Seong Yun Cho,et al.  Robust positioning technique in low-cost DR/GPS for land navigation , 2006, IEEE Transactions on Instrumentation and Measurement.

[26]  T. Hashizume,et al.  A study of precise road feature localization using mobile mapping system , 2007, 2007 IEEE/ASME international conference on advanced intelligent mechatronics.

[27]  Chen He,et al.  Boresight Calibration of Airborne LiDAR System Without Ground Control Points , 2012, IEEE Geoscience and Remote Sensing Letters.

[28]  Dieter Fox,et al.  Learning GP-BayesFilters via Gaussian process latent variable models , 2009, Auton. Robots.

[29]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.