Extended Kalman Filtering with Nonlinear Equality Constraints: a Geometric Approach - Archive ouverte HAL Accéder directement au contenu
Article Dans Une Revue IEEE Transactions on Automatic Control Année : 2020

Extended Kalman Filtering with Nonlinear Equality Constraints: a Geometric Approach

Axel Barrau
  • Fonction : Auteur
  • PersonId : 941948

Résumé

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.
Fichier principal
Vignette du fichier
main.pdf (791.38 Ko) Télécharger le fichier
Origine : Fichiers produits par l'(les) auteur(s)
Loading...

Dates et versions

hal-02129552 , version 1 (15-05-2019)
hal-02129552 , version 2 (25-07-2019)
hal-02129552 , version 3 (26-07-2019)
hal-02129552 , version 4 (30-07-2019)

Identifiants

Citer

Axel Barrau, Silvère Bonnabel. Extended Kalman Filtering with Nonlinear Equality Constraints: a Geometric Approach. IEEE Transactions on Automatic Control, 2020, ⟨10.1109/TAC.2019.2929112⟩. ⟨hal-02129552v2⟩
423 Consultations
1855 Téléchargements

Altmetric

Partager

Gmail Facebook X LinkedIn More