Exactly Sparse Delayed State Filter based robust SLAM with Stereo Vision

Conference: ISR/ROBOTIK 2010 - ISR 2010 (41st International Symposium on Robotics) and ROBOTIK 2010 (6th German Conference on Robotics)
06/07/2010 - 06/09/2010 at Munich, Germany

Proceedings: ISR/ROBOTIK 2010

Pages: 7Language: englishTyp: PDF

Personal VDE Members are entitled to a 10% discount on this title

Kitanov, Andreja; Petrovi?, Ivan (Faculty of Electrical Engineering and Computing, University of Zagreb, Croatia)

This paper presents a new SLAM solution based on Exactly Sparse Delayed State Filter and data association by a novel robust stereo vision image registration constrained geometrically with odometry inputs. The proposed constrained image registration algorithm is robust to high uncertainty of odometry inputs and high percentage of data association outliers and achieves fast convergence. Extended Information Filter (i.e. the dual of the Extended Kalman Filter) is used to estimate the mobile robot’s pose history, because information matrix then exhibits exactly sparse structure with Markov process model which yields efficient filtering. Computationally most demanding operations - mean and covariance recovery that are needed in data association and filter motion update - can be recovered in linear time by solving system of sparse equations. Although our solution is tested on 2D stereo vision based SLAM benchmarking problem taken from Rawseeds database, it can solve general 3D SLAM problem.