Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing

Frank Dellaert and Michael Kaess
Journal Article, Intl. J. of Robotics Research, IJRR, Vol. 25, No. 12, pp. 1181-1204, December, 2006

View Publication

Copyright notice: This material is presented to ensure timely dissemination of scholarly and technical work. Copyright and all rights therein are retained by authors or by other copyright holders. All persons copying this information are expected to adhere to the terms and constraints invoked by each author's copyright. These works may not be reposted without the explicit permission of the copyright holder.


Solving the SLAM problem is one way to enable a robot to explore, map, and navigate in a previously unknown environment. We investigate smoothing approaches as a viable alternative to extended Kalman filter-based solutions to the problem. In particular, we look at approaches that factorize either the associated information matrix or the measurement Jacobian into square root form. Such techniques have several significant advantages over the EKF: they are faster yet exact, they can be used in either batch or incremental mode, are better equipped to deal with non-linear process and measurement models, and yield the entire robot trajectory, at lower cost for a large class of SLAM problems. In addition, in an indirect but dramatic way, column ordering heuristics automatically exploit the locality inherent in the geographic nature of the SLAM problem. In this paper we present the theory underlying these methods, along with an interpretation of factorization in terms of the graphical model associated with the SLAM problem. We present both simulation results and actual SLAM experiments in large-scale environments that underscore the potential of these methods as an alternative to EKF-based approaches.

author = {Frank Dellaert and Michael Kaess},
title = {Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing},
journal = {Intl. J. of Robotics Research, IJRR},
year = {2006},
month = {December},
volume = {25},
number = {12},
pages = {1181-1204},
} 2018-11-12T13:01:42-04:00