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.
Original language | English |
---|---|
Title of host publication | IROS 2013: New Horizon, Conference Digest - 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems |
Pages | 556-563 |
Number of pages | 8 |
DOIs | |
Publication status | Published - 2013 |
Event | 2013 26th IEEE/RSJ International Conference on Intelligent Robots and Systems: New Horizon: IROS 2013 - Tokyo, Japan Duration: 3 Nov 2013 → 8 Nov 2013 |
Conference
Conference | 2013 26th IEEE/RSJ International Conference on Intelligent Robots and Systems: New Horizon |
---|---|
Country/Territory | Japan |
City | Tokyo |
Period | 3/11/13 → 8/11/13 |
ASJC Scopus subject areas
- Control and Systems Engineering
- Software
- Computer Vision and Pattern Recognition
- Computer Science Applications