Multiple relative pose graphs for robust cooperative mapping

Abstract— This paper describes a new algorithm for cooperative and persistent simultaneous localization and mapping (SLAM) using multiple robots. Recent pose graph representations have proven very successful for single robot mapping and localization. Among these methods, incremental smoothing and mapping (iSAM) gives an exact incremental solution to the SLAM problem by solving a full nonlinear optimization problem in real-time. In this paper, we present a novel extension to iSAM to facilitate online multi-robot mapping based on multiple pose graphs. Our main contribution is a relative formulation of the relationship between multiple pose graphs that avoids the initialization problem and leads to an efficient solution when compared to a completely global formulation. The relative pose graphs are optimized together to provide a globally consistent multi-robot solution. Efficient access to covariances at any time for relative parameters is provided through iSAM, facilitating data asso...

• Type: Journal
• Year: 2010
• Where: ICRA
• Authors: Been Kim, Michael Kaess, Luke Fletcher, John J. Leonard, Abraham Bachrach, Nicholas Roy, Seth J. Teller
• Keywords: ICRA 2010, ISAM, Pose Graph Representations, Pose Graphs, Robotics