Sparse Roadmap Spanners

Asymptotically optimal planners like prm* guarantee that solutions approach optimal as iterations increase. Roadmaps with this property, however, may grow too large. If optimality is relaxed, asymptotically near-optimal solutions produce sparser graphs by not including all edges. The idea stems from graph spanners, which produce sparse subgraphs that guarantee near-optimal paths. Existing asymptotically optimal and near-optimal planners, however, include all sampled configurations as roadmap nodes, meaning only infinite graphs have the desired properties. This work proposes an approach, called spars, that provides the following asymptotic properties: (a) completeness, (b) near-optimality and (c) the probability of adding nodes to the spanner converges to zero as iterations increase, which suggests that finite-size data structures may exist that have near-optimality properties. The method brings together ideas from various planners but deviates from existing integrations of prm* with graph spanners. Simulations for rigid bodies show that spars indeed provides small roadmaps and results in faster query resolution. The rate of node addition is shown to decrease over time and the quality of solutions is even better than the theoretical bounds.

[1]  Thierry Siméon,et al.  Path Deformation Roadmaps , 2006, WAFR.

[2]  Nancy M. Amato,et al.  Algorithmic Foundations of Robotics XIV, Proceedings of the Fourteenth Workshop on the Algorithmic Foundations of Robotics, WAFR 2021, Oulu, Finland, June 21-23, 2021 , 2021, WAFR.

[3]  S. LaValle,et al.  Randomized Kinodynamic Planning , 2001 .

[4]  B. Faverjon,et al.  Probabilistic Roadmaps for Path Planning in High-Dimensional Con(cid:12)guration Spaces , 1996 .

[5]  Daniel Vallejo,et al.  OBPRM: an obstacle-based PRM for 3D workspaces , 1998 .

[6]  Jean-Claude Latombe,et al.  Randomized Kinodynamic Motion Planning with Moving Obstacles , 2002, Int. J. Robotics Res..

[7]  Emilio Frazzoli,et al.  Sampling-based algorithms for optimal motion planning , 2011, Int. J. Robotics Res..

[8]  Dinesh Manocha,et al.  Star-shaped Roadmaps - A Deterministic Sampling Approach for Complete Motion Planning , 2005, Robotics: Science and Systems.

[9]  Didier Wolf,et al.  Capture of homotopy classes with probabilistic road map , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Mark H. Overmars,et al.  Useful cycles in probabilistic roadmap graphs , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[11]  Maja J. Mataric,et al.  Motion planning using dynamic roadmaps , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[12]  Jean-Claude Latombe,et al.  A Single-Query Bi-Directional Probabilistic Roadmap Planner with Lazy Collision Checking , 2001, ISRR.

[13]  Lydia E. Kavraki,et al.  Measure theoretic analysis of probabilistic path planning , 2004, IEEE Transactions on Robotics and Automation.

[14]  Dan Halperin,et al.  Sampling-Diagram Automata: A Tool for Analyzing Path Quality in Tree Planners , 2010, WAFR.

[15]  Lydia E. Kavraki,et al.  On finding narrow passages with probabilistic roadmap planners , 1998 .

[16]  Kostas E. Bekris,et al.  Learning approximate cost-to-go metrics to improve sampling-based motion planning , 2011, 2011 IEEE International Conference on Robotics and Automation.

[17]  Thierry Siméon,et al.  Visibility-based probabilistic roadmaps for motion planning , 2000, Adv. Robotics.

[18]  Kostas E. Bekris,et al.  Asymptotically Near-Optimal Is Good Enough for Motion Planning , 2011, ISRR.

[19]  Dan Halperin,et al.  A Little More, a Lot Better: Improving Path Quality by a Path-Merging Algorithm , 2011, IEEE Transactions on Robotics.

[20]  Mark H. Overmars,et al.  Creating High-quality Roadmaps for Motion Planning in Virtual Environments , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Alejandro A. Schäffer,et al.  Graph spanners , 1989, J. Graph Theory.

[22]  Jean-Daniel Boissonnat,et al.  Algorithmic Foundations of Robotics V, Selected Contributions of the Fifth International Workshop on the Algorithmic Foundations of Robotics, WAFR 2002, Nice, France, December 15-17, 2002 , 2004, WAFR.

[23]  Sandeep Sen,et al.  A simple and linear time randomized algorithm for computing sparse spanners in weighted graphs , 2007 .

[24]  Nancy M. Amato,et al.  Incremental Map Generation (IMG) , 2006, WAFR.

[25]  Kostas E. Bekris,et al.  Towards small asymptotically near-optimal roadmaps , 2012, 2012 IEEE International Conference on Robotics and Automation.

[26]  Sandeep Sen,et al.  A simple and linear time randomized algorithm for computing sparse spanners in weighted graphs , 2007, Random Struct. Algorithms.

[27]  Lydia E. Kavraki,et al.  Analysis of probabilistic roadmaps for path planning , 1996, Proceedings of IEEE International Conference on Robotics and Automation.