The Invariant Rauch-Tung-Striebel Smoother (2403.00075v1)
Abstract: This paper presents an invariant Rauch-Tung- Striebel (IRTS) smoother applicable to systems with states that are an element of a matrix Lie group. In particular, the extended Rauch-Tung-Striebel (RTS) smoother is adapted to work within a matrix Lie group framework. The main advantage of the invariant RTS (IRTS) smoother is that the linearization of the process and measurement models is independent of the state estimate resulting in state-estimate-independent Jacobians when certain technical requirements are met. A sample problem is considered that involves estimation of the three dimensional pose of a rigid body on SE(3), along with sensor biases. The multiplicative RTS (MRTS) smoother is also reviewed and is used as a direct comparison to the proposed IRTS smoother using experimental data. Both smoothing methods are also compared to invariant and multiplicative versions of the Gauss-Newton approach to solving the batch state estimation problem.
- E. Lefferts, L. Markley, and M. Shuster, “Kalman Filtering for Spacecraft Attitude Estimation,” Journal of Guidance, Control, and Dynamics, vol. 5, no. 5, 1982.
- A. Barrau and S. Bonnabel, “The Invariant Extended Kalman Filter as a Stable Observer,” IEEE Transactions on Automatic Control, vol. 62, no. 4, pp. 1797–1812, 2016.
- ——, “Invariant Kalman Filtering,” Annual Review of Control, Robotics, and Autonomous Systems, vol. 1, pp. 237–257, 2018.
- J. Arsenault, “Practical Considerations and Extensions of the Invariant Extended Kalman Filtering Framework,” Master’s thesis, McGill University, 2019.
- G. Bourmaud, “Parameter Estimation on Lie Groups : Application to Mapping and Localization from a Monocular Camera,” PhD. Thesis, Université de Bordeaux, Nov. 2015.
- P. Chauchat, A. Barrau, and S. Bonnabel, “Invariant Smoothing on Lie Groups,” International Conference on Intelligent Robots and Systems (IROS), pp. 1703–1710, 2018.
- P. Chauchat, “Smoothing Algorithms for Navigation, Localisation and Mapping Based on High-grade Inertial Sensors,” Ph.D. dissertation, MINES ParisTech, 2020.
- A. Walsh, J. Arsenault, and J. R. Forbes, “Invariant Sliding Window Filtering for Attitude and Bias Estimation,” American Control Conference (ACC), pp. 3161–3166, 2019.
- T. D. Barfoot, “AER1513 Course Notes, Assignments, and Data Sets,” University of Toronto, Institute for Aerospace Studies, 2011.
- M. L. Psiaki, “Backward-Smoothing Extended Kalman Filter,” Journal of Guidance, Control, and Dynamics, vol. 28, no. 5, pp. 885–894, 2005.
- R. Aucoin, S. A. Chee, and J. R. Forbes, “Linear- and Linear-Matrix-Inequality-Constrained State Estimation for Nonlinear Systems,” IEEE Transactions on Aerospace and Electronic Systems, vol. 55, no. 6, pp. 3153–3167, 2019.
- S. Heo and C. G. Park, “Consistent EKF-Based Visual-Inertial Odometry on Matrix Lie Group,” IEEE Sensors Journal, vol. 18, no. 9, pp. 3780–3788, 2018.
- M. R. Hartley, “Contact-Aided State Estimation on Lie Groups for Legged Robot Mapping and Control,” Ph.D. dissertation, University of Michigan, 2019.