Enhanced Autonomous Vehicle Positioning Using a Loosely Coupled INS/GNSS-Based Invariant-EKF Integration

High-precision navigation solutions are a main requirement for autonomous vehicle (AV) applications. Global navigation satellite systems (GNSSs) are the prime source of navigation information for such applications. However, some places such as tunnels, underpasses, inside parking garages, and urban high-rise buildings suffer from GNSS signal degradation or unavailability. Therefore, another system is required to provide a continuous navigation solution, such as the inertial navigation system (INS). The vehicle’s onboard inertial measuring unit (IMU) is the main INS input measurement source. However, the INS solution drifts over time due to IMU-associated errors and the mechanization process itself. Therefore, INS/GNSS integration is the proper solution for both systems’ drawbacks. Traditionally, a linearized Kalman filter (LKF) such as the extended Kalman filter (EKF) is utilized as a navigation filter. The EKF deals only with the linearized errors and suppresses the higher orders using the Taylor expansion up to the first order. This paper introduces a loosely coupled INS/GNSS integration scheme using the invariant extended Kalman filter (IEKF). The IEKF state estimate is independent of the Jacobians that are derived in the EKF; instead, it uses the matrix Lie group. The proposed INS/GNSS integration using IEKF is applied to a real road trajectory for performance validation. The results show a significant enhancement when using the proposed system compared to the traditional INS/GNSS integrated system that uses EKF in both GNSS signal presence and blockage cases. The overall trajectory 2D-position RMS error reduced from 19.4 m to 3.3 m with 82.98% improvement and the 2D-position max error reduced from 73.9 m to 14.2 m with 80.78% improvement.

[1]  Gaofeng Nie,et al.  Cognitive AmBC-NOMA IoV-MTS Networks With IQI: Reliability and Security Analysis , 2023, IEEE Transactions on Intelligent Transportation Systems.

[2]  M. Korenberg,et al.  A Review of Sensor System Schemes for Integrated Navigation , 2022, 2022 5th International Conference on Communications, Signal Processing, and their Applications (ICCSPA).

[3]  Walid Farid Abdelfatah,et al.  Radar-Based Multisensor Fusion for Uninterrupted Reliable Positioning in GNSS-Denied Environments , 2022, IEEE Transactions on Intelligent Transportation Systems.

[4]  Lubin Chang,et al.  Log-Linear Error State Model Derivation Without Approximation for INS , 2022, IEEE Transactions on Aerospace and Electronic Systems.

[5]  Liang Li,et al.  Precise and robust sideslip angle estimation based on INS/GNSS integration using invariant extended Kalman filter , 2022, Proceedings of the Institution of Mechanical Engineers, Part D: Journal of Automobile Engineering.

[6]  Xu Ru,et al.  MEMS Inertial Sensor Calibration Technology: Current Status and Future Trends , 2022, Micromachines.

[7]  Ahmed E. Mahdi,et al.  IMU-Error Estimation and Cancellation Using ANFIS for Improved UAV Navigation , 2022, 2022 13th International Conference on Electrical Engineering (ICEENG).

[8]  Ahmed E. Mahdi,et al.  A Machine Learning Approach for an Improved Inertial Navigation System Solution , 2022, Sensors.

[9]  Yaohua Liu,et al.  A Novel Sensor Fusion Method Based on Invariant Extended Kalman Filter for Unmanned Aerial Vehicle , 2021, 2021 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[10]  Aboelmagd Noureldin,et al.  A Novel Multi-Level Integrated Navigation System for Challenging GNSS Environments , 2021, IEEE Transactions on Intelligent Transportation Systems.

[11]  Aboelmagd Noureldin,et al.  Implementation of Parallel Cascade Identification at Various Phases for Integrated Navigation System , 2021, Future Internet.

[12]  V. A. Vasiliev,et al.  Polynomial Filtering Algorithm Applied to Navigation Data Processing under Quadratic Nonlinearities in System and Measurement Equations. Part 1. Description and Comparison with Kalman Type Algorithms , 2021, Gyroscopy and Navigation.

[13]  Abbas Chatraei,et al.  INS/GPS Sensor Fusion based on Adaptive Fuzzy EKF with Sensitivity to Disturbances , 2021, IET Radar, Sonar & Navigation.

[14]  Wenqi Wu,et al.  Lie group based nonlinear state errors for MEMS-IMU/GNSS/magnetometer integrated navigation , 2021, Journal of Navigation.

[15]  Yuanxin Wu,et al.  A Trident Quaternion Framework for Inertial-Based Navigation—Part II: Error Models and Application to Initial Alignment , 2021, IEEE Transactions on Aerospace and Electronic Systems.

[16]  Bingbing Gao,et al.  Unscented kalman filter with process noise covariance estimation for vehicular ins/gps integration system , 2020, Inf. Fusion.

[17]  Aboelmagd Noureldin,et al.  Enhanced Land Vehicles Navigation by Fusing Automotive Radar and Speedometer Data , 2020 .

[18]  Guoliang Wei,et al.  Protocol-Based Unscented Kalman Filtering in the Presence of Stochastic Uncertainties , 2020, IEEE Transactions on Automatic Control.

[19]  Aboelmagd Noureldin,et al.  Improving the RISS/GNSS Land-Vehicles Integrated Navigation System Using Magnetic Azimuth Updates , 2020, IEEE Transactions on Intelligent Transportation Systems.

[20]  A. Kılıçman,et al.  Fractional Riccati Equation and Its Applications to Rough Heston Model Using Numerical Methods , 2020, Symmetry.

[21]  Hossam S. Hassanein,et al.  Integrated Positioning for Connected Vehicles , 2020, IEEE Transactions on Intelligent Transportation Systems.

[22]  Proceedings of the 32nd International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2019) , 2019 .

[23]  Michael J. Korenberg,et al.  Leveraging FMCW-Radar for Autonomous Positioning Systems: Methodology and Application in Downtown Toronto , 2019, Proceedings of the 32nd International Technical Meeting of the Satellite Division of The Institute of Navigation (ION GNSS+ 2019).

[24]  Manish Yadav,et al.  A Comparison between Nonlinear Estimation based Algorithms for Mobile Robot Localizations , 2019, 2019 IEEE 1st International Conference on Energy, Systems and Information Processing (ICESIP).

[25]  Saeed Rafee Nekoo,et al.  Tutorial and Review on the State-dependent Riccati Equation , 2019, Journal of Applied Nonlinear Dynamics.

[26]  Guoquan Huang,et al.  Visual-Inertial Navigation: A Concise Review , 2019, 2019 International Conference on Robotics and Automation (ICRA).

[27]  J. Grizzle,et al.  Contact-aided invariant extended Kalman filtering for robot state estimation , 2019, Int. J. Robotics Res..

[28]  Xin Sui,et al.  A Modified Extended Kalman Filter for a Two-Antenna GPS/INS Vehicular Navigation System , 2018, Sensors.

[29]  In Ho Choi,et al.  Features of Invariant Extended Kalman Filter Applied to Unmanned Aerial Vehicle Navigation , 2018, Sensors.

[30]  Rustam B. Rustamov,et al.  Multifunctional Operation and Application of GPS , 2018 .

[31]  Aboelmagd Noureldin,et al.  GNSSs, Signals, and Receivers , 2018, Multifunctional Operation and Application of GPS.

[32]  Axel Barrau,et al.  Invariant smoothing on Lie Groups , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[33]  Haichao Gui,et al.  Quaternion Invariant Extended Kalman Filtering for Spacecraft Attitude Estimation , 2017 .

[34]  Axel Barrau,et al.  Three examples of the stability properties of the invariant extended Kalman filter , 2017 .

[35]  Gamini Dissanayake,et al.  Convergence and Consistency Analysis for a 3-D Invariant-EKF SLAM , 2017, IEEE Robotics and Automation Letters.

[36]  Philippe Bonnifait,et al.  Road invariant Extended Kalman Filter for an enhanced estimation of GPS errors using lane markings , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

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

[38]  François Goulette,et al.  Invariant EKF Design for Scan Matching-Aided Localization , 2015, IEEE Transactions on Control Systems Technology.

[39]  Axel Barrau,et al.  The Invariant Extended Kalman Filter as a Stable Observer , 2014, IEEE Transactions on Automatic Control.

[40]  G. Chang Loosely Coupled INS/GPS Integration with Constant Lever Arm using Marginal Unscented Kalman Filter , 2013, Journal of Navigation.

[41]  Axel Barrau,et al.  Intrinsic Filtering on Lie Groups With Applications to Attitude Estimation , 2013, IEEE Transactions on Automatic Control.

[42]  Aboelmagd Noureldin,et al.  Fundamentals of Inertial Navigation, Satellite-based Positioning and their Integration , 2012 .

[43]  Fredrik Gustafsson,et al.  Some Relations Between Extended and Unscented Kalman Filters , 2012, IEEE Transactions on Signal Processing.

[44]  P. Groves Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[45]  Silvere Bonnabel,et al.  Left-invariant extended Kalman filter and attitude estimation , 2007, 2007 46th IEEE Conference on Decision and Control.

[46]  Peter Corke,et al.  An Introduction to Inertial and Visual Sensing , 2007, Int. J. Robotics Res..

[47]  Aboelmagd Noureldin,et al.  Sensor Integration for Satellite-Based Vehicular Navigation Using Neural Networks , 2007, IEEE Transactions on Neural Networks.

[48]  N. El-Sheimy,et al.  Online INS/GPS integration with a radial basis function neural network , 2005, IEEE Aerospace and Electronic Systems Magazine.

[49]  P. Savage STRAPDOWN INERTIAL NAVIGATION INTEGRATION ALGORITHM DESIGN. PART 2: VELOCITY AND POSITION ALGORITHMS , 1998 .

[50]  N. Ko,et al.  Lie Group Approach to Dynamic-model-aided Navigation of Multirotor Unmanned Aerial Vehicles , 2022, IEEE Access.

[51]  Xin Su,et al.  A Localization Based on Unscented Kalman Filter and Particle Filter Localization Algorithms , 2020, IEEE Access.

[52]  Aboelmagd Noureldin,et al.  GPS/INS integration utilizing dynamic neural networks for vehicular navigation , 2011, Inf. Fusion.

[53]  James Diebel,et al.  Representing Attitude : Euler Angles , Unit Quaternions , and Rotation Vectors , 2006 .

[54]  John,et al.  Strapdown Inertial Navigation Technology - 2nd Edition , 2005 .

[55]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .