A fast streaming spanner algorithm for incrementally constructing sparse roadmaps

Sampling-based probabilistic roadmap algorithms such as PRM and PRM* have been shown to be effective at solving certain motion planning problems, but the large graphs generated to express the connectivity and a metric on the configuration space may require much storage space and be expensive to search. Recent work by Marble and Bekris [14], [19] applied spanner algorithms to PRM* these algorithms prune some edges in a dense graph, while guaranteeably maintaining an approximation to the metric. In this paper, we apply (and improve) a state-of-the-art streaming spanner algorithm to prune PRM* roadmaps. The algorithm we present has the main advantage of computational speed; when applied to PRM*, the processing time per vertex is independent of the number of sampled vertices, n, as compared to O(nlog2 nloglogn) in [19]. In practice, the algorithm we present prunes a graph with about 20 million edges in less than 20 seconds on a modern desktop computer; compared to the time required for generating such a roadmap, this additional processing time is essentially trivial. In fact, because the combination of this algorithm with PRM* avoids the need for many collision detections, the combination runs several times faster than PRM*alone.

[1]  S. LaValle Rapidly-exploring random trees : a new tool for path planning , 1998 .

[2]  Steven M. LaValle,et al.  Quasi-randomized path planning , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[3]  Mark de Berg,et al.  Computational geometry: algorithms and applications , 1997 .

[4]  Joan Feigenbaum,et al.  Graph distances in the streaming model: the value of space , 2005, SODA '05.

[5]  Edith Cohen Fast algorithms for constructing t-spanners and paths with stretch t , 1993, FOCS.

[6]  Jose Augusto Ramos Soares,et al.  Graph Spanners: a Survey , 1992 .

[7]  Michael Elkin,et al.  Streaming and fully dynamic centralized algorithms for constructing and maintaining sparse spanners , 2007, TALG.

[8]  J. Schwartz,et al.  On the “piano movers'” problem I. The case of a two‐dimensional rigid polygonal body moving amidst polygonal barriers , 1983 .

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

[10]  John Canny,et al.  The complexity of robot motion planning , 1988 .

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

[12]  Surender Baswana,et al.  Streaming algorithm for graph spanners - single pass and constant processing time per edge , 2008, Inf. Process. Lett..

[13]  Arnab Bhattacharyya,et al.  Improved Approximation for the Directed Spanner Problem , 2011, ICALP.

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

[15]  J. T. Shwartz,et al.  On the Piano Movers' Problem : III , 1983 .

[16]  Tomás Lozano-Pérez,et al.  Spatial Planning: A Configuration Space Approach , 1983, IEEE Transactions on Computers.

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

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

[19]  Soumojit Sarkar,et al.  Fully dynamic randomized algorithms for graph spanners , 2012, TALG.

[20]  Michiel H. M. Smid,et al.  Robust geometric spanners , 2012, SoCG '13.

[21]  Kostas E. Bekris,et al.  Asymptotically Near-Optimal Planning With Probabilistic Roadmap Spanners , 2013, IEEE Transactions on Robotics.

[22]  Lydia E. Kavraki,et al.  The Open Motion Planning Library , 2012, IEEE Robotics & Automation Magazine.

[23]  Liam Roditty Fully Dynamic Geometric Spanners , 2007, SCG '07.

[24]  Kostas E. Bekris,et al.  Computing spanners of asymptotically optimal probabilistic roadmaps , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[26]  Mikkel Thorup,et al.  Roundtrip spanners and roundtrip routing in directed graphs , 2002, SODA '02.