Robust pose-graph loop-closures with expectation-maximization

Gim Hee Lee, Friedrich Fraundorfer, Marc Pollefeys

Publikation: Beitrag in Buch/Bericht/KonferenzbandBeitrag in einem KonferenzbandForschungBegutachtung

Abstract

In this paper, we model the robust loop-closure pose-graph SLAM problem as a Bayesian network and show that it can be solved with the Classification Expectation-Maximization (EM) algorithm. In particular, we express our robust pose-graph SLAM as a Bayesian network where the robot poses and constraints are latent and observed variables. An additional set of latent variables is introduced as weights for the loop-constraints. We show that the weights can be chosen as the Cauchy function, which are iteratively computed from the errors between the predicted robot poses and observed loop-closure constraints in the Expectation step, and used to weigh the cost functions from the pose-graph loop-closure constraints in the Maximization step. As a result, outlier loop-closure constraints are assigned low weights and exert less influences in the pose-graph optimization within the EM iterations. To prevent the EM algorithm from getting stuck at local minima, we perform the EM algorithm multiple times where the loop constraints with very low weights are removed after each EM process. This is repeated until there are no more changes to the weights. We show proofs of the conceptual similarity between our EM algorithm and the M-Estimator. Specifically, we show that the weight function in our EM algorithm is equivalent to the robust residual function in the M-Estimator. We verify our proposed algorithm with experimental results from multiple simulated and real-world datasets, and comparisons with other existing works.

Originalspracheenglisch
TitelIROS 2013: New Horizon, Conference Digest - 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems
Seiten556-563
Seitenumfang8
DOIs
PublikationsstatusVeröffentlicht - 2013
Veranstaltung2013 26th IEEE/RSJ International Conference on Intelligent Robots and Systems: New Horizon, IROS 2013 - Tokyo, Japan
Dauer: 3 Nov 20138 Nov 2013

Konferenz

Konferenz2013 26th IEEE/RSJ International Conference on Intelligent Robots and Systems: New Horizon, IROS 2013
LandJapan
OrtTokyo
Zeitraum3/11/138/11/13

    Fingerprint

ASJC Scopus subject areas

  • !!Control and Systems Engineering
  • Software
  • !!Computer Vision and Pattern Recognition
  • !!Computer Science Applications

Dieses zitieren

Lee, G. H., Fraundorfer, F., & Pollefeys, M. (2013). Robust pose-graph loop-closures with expectation-maximization. in IROS 2013: New Horizon, Conference Digest - 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems (S. 556-563). [6696406] https://doi.org/10.1109/IROS.2013.6696406