Online three-dimensional SLAM by registration of large planar surface segments and closed-form pose-graph relaxation

K. Pathak, A. Birk, N. Vaskevicius, M. Pfingsthorn, S. Schwertfeger and J. Poppinga.
Journal of Field Robotics, Special Issue: Three-Dimensional Mapping, Part 3, Volume 27, Issue 1, pages 52–84, January 2010.


A fast pose-graph relaxation technique is presented for enhancing the consistency of three-dimensional (3D) maps created by registering large planar surface patches. The surface patches are extracted from point clouds sampled from a 3D range sensor. The plane-based registration method offers an alternative to the state-of-the-art algorithms and provides advantages in terms of robustness, speed, and storage. One of its features is that it results in an accurate determination of rotation, although a lack of predominant surfaces in certain directions may result in translational uncertainty in those directions. Hence, a loop-closing and relaxation problem is formulated that gains significant speed by relaxing only the translational errors and utilizes the full-translation covariance determined during pairwise registration. This leads to a fast 3D simultaneous localization and mapping suited for online operations. The approach is tested in two disaster scenarios that were mapped at the NIST 2008 Response Robot Evaluation Exercise in Disaster City, Texas. The two data sets from a collapsed car park and a flooding disaster consist of 26 and 70 3D scans, respectively. The results of these experiments show that our approach can generate 3D maps without motion estimates by odometry and that it outperforms iterative closest point–based mapping with respect to speed and robustness.


@article {ROB:ROB20322,
  author = {Pathak, Kaustubh and Birk, Andreas and Vaskevicius, Narunas and Pfingsthorn, Max and Schwertfeger, Sören and Poppinga, Jann},
  title = {Online three-dimensional SLAM by registration of large planar surface segments and closed-form pose-graph relaxation},
  journal = {Journal of Field Robotics},
  volume = {27},
  number = {1},
  publisher = {Wiley Subscription Services, Inc., A Wiley Company},
  issn = {1556-4967},
  url = {},
  doi = {10.1002/rob.20322},
  pages = {52--84},
  year = {2010},
© 2015-2019 Max Pfingsthorn. Made with Hugo, Bootstrap, and FontAwesome.