Exploiting Symmetries to Design EKFs with Consistency Properties for Navigation and SLAM - Archive ouverte HAL Access content directly
Reports (Research Report) Year : 2019

Exploiting Symmetries to Design EKFs with Consistency Properties for Navigation and SLAM

Martin Brossard
  • Function : Author
  • PersonId : 1016519
Axel Barrau
  • Function : Author
  • PersonId : 776804
  • IdRef : 194303462

Abstract

The Extended Kalman Filter (EKF) is both the historical algorithm for multi-sensor fusion and still state of the art in numerous industrial applications. However, it may prove inconsistent in the presence of unobservability under a group of transformations. In this paper we first build an alternative EKF based on an alternative nonlinear state error. This EKF is intimately related to the theory of the Invariant EKF (IEKF). Then, under a simple compatibility assumption between the error and the transformation group, we prove the linearized model of the alternative EKF automatically captures the unobservable directions, and many desirable properties of the linear case then directly follow. This provides a novel fundamental result in filtering theory. We apply the theory to multi-sensor fusion for navigation, when all the sensors are attached to the vehicle and do not have access to absolute information, as typically occurs in GPS-denied environments. In the context of Simultaneous Localization And Mapping (SLAM), Monte-Carlo runs and comparisons to OC-EKF, robocentric EKF, and optimization-based smoothing algorithms (iSAM) illustrate the results. The proposed EKF is also proved to outperform standard EKF and to achieve comparable performance to iSAM on a publicly available real dataset for multi-robot SLAM.
Fichier principal
Vignette du fichier
main.pdf (626.34 Ko) Télécharger le fichier
Origin : Files produced by the author(s)

Dates and versions

hal-02064782 , version 1 (12-03-2019)

Identifiers

Cite

Martin Brossard, Axel Barrau, Silvère Bonnabel. Exploiting Symmetries to Design EKFs with Consistency Properties for Navigation and SLAM. [Research Report] CAOR - Centre de Robotique. 2019. ⟨hal-02064782⟩
107 View
170 Download

Altmetric

Share

Gmail Facebook Twitter LinkedIn More