$SE_2(3)$ based Extended Kalman Filtering and Smoothing Framework for Inertial-Integrated Navigation
Preprint
Abstract
This paper proposes an $SE_2(3)$ based extended Kalman filtering (EKF) framework for the inertial-integrated state estimation problem. The error representation using the straight difference of two vectors in the inertial navigation system may not be reasonable as it does not take the direction difference into consideration. Therefore, we choose to use the $SE_2(3)$ matrix Lie group to represent the state of the inertial-integrated navigation system which consequently leads to the common frame error representation. With the new velocity and position error definition, we leverage the group affine dynamics with the autonomous error properties and derive the error state differential equation for the inertial-integrated navigation on the north-east-down (NED) navigation frame and the earth-centered earth-fixed (ECEF) frame, respectively, the corresponding EKF, terms as $SE_2(3)$ based EKF has also been derived. It provides a new perspective on the geometric EKF with a more sophisticated formula for the inertial-integrated navigation system. Furthermore, we design two new modified error dynamics on the NED frame and the ECEF frame respectively by introducing new auxiliary vectors. Finally the equivalence of the left-invariant EKF and left $SE_2(3)$ based EKF have been shown in navigation frame and ECEF frame.
Keywords
All Related Versions
This publication has 8 references indexed in Scilit:
- Associating Uncertainty to Extended Poses for on Lie Group IMU Preintegration With Rotating EarthIEEE Transactions on Robotics, 2021
- The Invariant Rauch-Tung-Striebel SmootherIEEE Robotics and Automation Letters, 2020
- Relative Inertial Navigation Employing a Common Frame Error Definition2020
- Consistent ST-EKF for Long Distance Land Vehicle Navigation Based on SINS/OD IntegrationIEEE Transactions on Vehicular Technology, 2019
- Common Frame Based Unscented Quaternion Estimator for Inertial-Integrated NavigationIEEE/ASME Transactions on Mechatronics, 2018
- State transformation extended Kalman filter for GPS/SINS tightly coupled integrationGPS Solutions, 2018
- The Invariant Extended Kalman Filter as a Stable ObserverIEEE Transactions on Automatic Control, 2016
- Principles of GNSS, inertial, and multisensor integrated navigation systems, 2nd edition [Book review]IEEE Aerospace and Electronic Systems Magazine, 2015