Path Planning with Pose SLAM

Technical Report (2010)

IRI code



Download the digital copy of the doc pdf document


The probabilistic belief networks that result from standard feature-based simultaneous localization and map building (SLAM) approaches cannot be directly used to plan trajectories. The reason is that they produce a sparse graph of landmark estimates and their probabilistic relations, which is of little value to find collision free paths for navigation. In contrast, we argue in this work that Pose SLAM graphs can be directly used as belief roadmaps (BRMs). The original BRM algorithm assumes a known model of the environment from which probabilistic sampling generates a roadmap. In our work, the roadmap is built on-line by the Pose SLAM algorithm. The result is a hybrid BRM-Pose SLAM method that devises optimal navigation strategies on-line by searching for the path with lowest accumulated uncertainty for the robot pose. The method is validated over synthetic data and standard SLAM datasets.


mobile robots.

Author keywords

Path Planning, SLAM

Scientific reference

R. Valencia, J. Andrade-Cetto and J.M. Porta. Path Planning with Pose SLAM. Technical Report IRI-DT-10-03, Institut de Robòtica i Informàtica Industrial, CSIC-UPC, 2010.