Optimization Algorithm for Kalman Filter Exploiting the Numerical Characteristics of SINS/GPS Integrated Navigation Systems

Aiming at addressing the problem of high computational cost of the traditional Kalman filter in SINS/GPS, a practical optimization algorithm with offline-derivation and parallel processing methods based on the numerical characteristics of the system is presented in this paper. The algorithm exploits the sparseness and/or symmetry of matrices to simplify the computational procedure. Thus plenty of invalid operations can be avoided by offline derivation using a block matrix technique. For enhanced efficiency, a new parallel computational mechanism is established by subdividing and restructuring calculation processes after analyzing the extracted “useful” data. As a result, the algorithm saves about 90% of the CPU processing time and 66% of the memory usage needed in a classical Kalman filter. Meanwhile, the method as a numerical approach needs no precise-loss transformation/approximation of system modules and the accuracy suffers little in comparison with the filter before computational optimization. Furthermore, since no complicated matrix theories are needed, the algorithm can be easily transplanted into other modified filters as a secondary optimization method to achieve further efficiency.

[1]  C. Boncelet,et al.  An extension of the SRIF Kalman filter , 1987 .

[2]  Michail Papazoglou,et al.  Integrated SAR /GPS / INS for Target Geolocation Improvement , 2014 .

[3]  Arthur G. O. Mutambara,et al.  Decentralized Estimation and Control for Multisensor Systems , 2019 .

[4]  Gerald J. Bierman,et al.  Measurement updating using the U-D factorization , 1975, 1975 IEEE Conference on Decision and Control including the 14th Symposium on Adaptive Processes.

[5]  D. W. Brown,et al.  The design of parallel square-root covariance Kalman filters using algorithm engineering , 1995, Integr..

[6]  Yongyuan Qin,et al.  A Rapid Computation Method for Kalman Filtering in Vehicular SINS/GPS Integrated System , 2012 .

[7]  Guanrong Chen,et al.  Kalman Filtering with Real-time Applications , 1987 .

[8]  Mohinder S. Grewal,et al.  Global Navigation Satellite Systems, Inertial Navigation, and Integration , 2013 .

[9]  Fabio Dovis,et al.  A Comparison between Different Error Modeling of MEMS Applied to GPS/INS Integrated Systems , 2013, Sensors.

[10]  Juan I. Giribet,et al.  An approach to benchmarking of loosely coupled low-cost navigation systems , 2015 .

[11]  J. Farrell,et al.  The global positioning system and inertial navigation , 1999 .

[12]  G. Bierman,et al.  Efficient time propagation of U-D covariance factors , 1980, 1980 19th IEEE Conference on Decision and Control including the Symposium on Adaptive Processes.

[13]  Adriano Solimeno,et al.  Low-Cost INS/GPS Data Fusion with Extended Kalman Filter for Airborne Applications , 2007 .

[14]  Yongqi Chen,et al.  A reduced-order model for integrated GPS/INS , 1998 .

[15]  G. Bierman.  A Comparison of Discrete Linear Filtering Algorithms , 1973, IEEE Transactions on Aerospace and Electronic Systems.

[16]  Fabio Dovis,et al.  Performance Analysis of Constrained Loosely Coupled GPS/INS Integration Solutions , 2012, Sensors.

[17]  Maria V. Kulikova,et al.  State Sensitivity Evaluation Within UD Based Array Covariance Filters , 2013, IEEE Transactions on Automatic Control.

[18]  G. Bierman,et al.  UDU/T/ covariance factorization for Kalman filtering , 1980 .

[19]  David W. Murray,et al.  An O(N²) Square Root Unscented Kalman Filter for Visual Simultaneous Localization and Mapping , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[20]  Pierre Manneback,et al.  Kalman filter algorithm based on singular value decomposition , 1992, [1992] Proceedings of the 31st IEEE Conference on Decision and Control.

[21]  Youmin Tang,et al.  A practical scheme of the sigma‐point Kalman filter for high‐dimensional systems , 2014 .

[22]  Alexander Medvedev,et al.  Parallelization of the Kalman filter on multicore computational platforms , 2013 .

[23]  Jihua Huang,et al.  A Low-Order DGPS-Based Vehicle Positioning System Under Urban Environment , 2006, IEEE/ASME Transactions on Mechatronics.