$SE_2(3)$ based Extended Kalman Filter and Smoothing for Inertial-Integrated Navigation
Preprint
Abstract
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 proposed 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 local-level navigation frame and the earth-centered earth-fixed frame, respectively, the corresponding extending Kalman filter (EKF), terms as $SE_2(3)$-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 propose a $SE_2(3)$-based smoothing algorithm based on the $SE_2(3)$-based EKF.
Keywords
All Related Versions
This publication has 7 references indexed in Scilit:
- Strapdown Inertial Navigation System Initial Alignment Based on Group of Double Direct Spatial IsometriesIEEE Sensors Journal, 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