Skip to Main content Skip to Navigation
Journal articles

Extended Kalman Filtering with Nonlinear Equality Constraints: a Geometric Approach

Abstract : In this paper, we focus on extended Kalman filtering (EKF), in the difficult case where a function of the state has been perfectly observed, and is thus known with certainty, while the full state still has unobserved degrees of freedom. In the linear case, the Kalman filter perfectly handles such constraints, which result in the state being in an affine subspace. Yet, in the nonlinear case, the EKF poorly handles such type of constraints. As a remedy, we propose a novel general methodology of EKF based on an (arbitrary) nonlinear error e. And we prove that under compatibility of the error e with the constraints, the EKF based on e perfectly handles the constraints. Furthermore, when the state space is a Lie group, we prove the EKF based on invariant errors is exactly the invariant EKF (IEKF), and we prove further properties. The theory is applied to the problem of simultaneous localization and mapping (SLAM), where the IEKF is shown to perfectly handle some partial deterministic information about the map. As a byproduct, the theory is also shown to readily allow devising EKFs on state spaces defined by a class of equality constraints.
Complete list of metadata

Cited literature [27 references]  Display  Hide  Download
Contributor : Silvere Bonnabel Connect in order to contact the contributor
Submitted on : Tuesday, July 30, 2019 - 8:11:32 AM
Last modification on : Wednesday, November 17, 2021 - 12:31:07 PM


Files produced by the author(s)



Axel Barrau, Silvère Bonnabel. Extended Kalman Filtering with Nonlinear Equality Constraints: a Geometric Approach. IEEE Transactions on Automatic Control, Institute of Electrical and Electronics Engineers, 2020, ⟨10.1109/TAC.2019.2929112⟩. ⟨hal-02129552v4⟩



Les métriques sont temporairement indisponibles