Dynamic Pose Graph SLAM: Long-term Mapping in Low Dynamic Environments

Aisha Walcott-Bryant, Michael Kaess, Hordur Johannsson and John J. Leonard
Conference Paper, IEEE/RSJ Intl. Conf. on Intelligent Robots and Systems, IROS, pp. 1871-1878, October, 2012

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.


Maintaining a map of an environment that changes over time is a critical challenge in the development of persistently autonomous mobile robots. Many previous ap- proaches to mapping assume a static world. In this work we incorporate the time dimension into the mapping process to enable a robot to maintain an accurate map while operating in dynamical environments. This paper presents Dynamic Pose Graph SLAM (DPG-SLAM), an algorithm designed to enable a robot to remain localized in an environment that changes sub- stantially over time. Using incremental smoothing and mapping (iSAM) as the underlying SLAM state estimation engine, the Dynamic Pose Graph evolves over time as the robot explores new places and revisits previously mapped areas. The approach has been implemented for planar indoor environments, using laser scan matching to derive constraints for SLAM state estimation. Laser scans for the same portion of the environment at different times are compared to perform change detection; when sufficient change has occurred in a location, the dynamic pose graph is edited to remove old poses and scans that no longer match the current state of the world. Experimental results are shown for two real-world dynamic indoor laser data sets, demonstrating the ability to maintain an up-to-date map despite long-term environmental changes.

author = {Aisha Walcott-Bryant and Michael Kaess and Hordur Johannsson and John J. Leonard},
title = {Dynamic Pose Graph SLAM: Long-term Mapping in Low Dynamic Environments},
booktitle = {IEEE/RSJ Intl. Conf. on Intelligent Robots and Systems, IROS},
year = {2012},
month = {October},
pages = {1871-1878},
} 2017-09-13T10:39:36-04:00