Path Planning with Forests of Random Trees: Parallelization with Super Linear Speedup ; CU-

We propose a new parallelized high-dimensional single-query path planning technique that uses a coupled forest of random trees (i.e., instead of a single tree). We present both theoretical and experimental results that show using forests of random trees can lead to expected super linear speedup, with respect to the number of trees in the forest. In other words, with T trees running in parallel, we expect to get a particular quality result in less than 1/T the time required by a single tree (this is also known as having efficiency greater than 1). Our algorithm works by linking the random sampling and pruning mechanisms of all trees in the forest to the length of the current best path found by any tree. This enables all trees to avoid sampling from large portions of the configuration space that cannot possibly lead to better solutions, and increases speed by enabling trees to prune obsolete nodes. The current best solution is also passed between trees, so that it may be improved by any tree in the forest. Given the potential of super linear speedup, we additionally propose a sequential version of the forest algorithm that works by dividing computation time between each of T trees. We perform a series of experiments and find that both the parallel and sequential versions of the forest algorithm perform well in practice (e.g., vs. a single tree or smaller forests). To demonstrate that our algorithm is generally applicable, experiments are performed using two different state-of-the-art random tree algorithms for the underlying random trees. Theoretical analysis suggest that these results can be duplicated for any random tree path planning algorithm that meets a few requirements stated in the paper.

[1]  Anthony Stentz,et al.  Anytime, Dynamic Planning in High-dimensional Search Spaces , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[2]  Nils J. Nilsson,et al.  A Formal Basis for the Heuristic Determination of Minimum Cost Paths , 1968, IEEE Trans. Syst. Sci. Cybern..

[3]  Nancy M. Amato,et al.  Probabilistic roadmap methods are embarrassingly parallel , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[4]  Anthony Stentz,et al.  Anytime RRTs , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Stephen M. Rock,et al.  Dynamic Networks for Motion Planning in Multi-Robot Space Systems , 2003 .

[6]  John H. Reif,et al.  Complexity of the mover's problem and generalizations , 1979, 20th Annual Symposium on Foundations of Computer Science (sfcs 1979).

[7]  Mark H. Overmars,et al.  A probabilistic learning approach to motion planning , 1995 .

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

[9]  Jean-Claude Latombe,et al.  Using a PRM planner to compare centralized and decoupled planning for multi-robot systems , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[10]  Nikolaus Correll,et al.  Any-Com Multi-robot Path-Planning: Maximizing Collaboration for Variable Bandwidth , 2010, DARS.

[11]  Emilio Frazzoli,et al.  Incremental Sampling-based Algorithms for Optimal Motion Planning , 2010, Robotics: Science and Systems.

[12]  J. Schwartz,et al.  On the Complexity of Motion Planning for Multiple Independent Objects; PSPACE- Hardness of the "Warehouseman's Problem" , 1984 .

[13]  Leo Breiman,et al.  Random Forests , 2001, Machine Learning.

[14]  Sven Koenig,et al.  Improved fast replanning for robot navigation in unknown terrain , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[15]  Jean-Claude Latombe,et al.  On Delaying Collision Checking in PRM Planning: Application to Multi-Robot Coordination , 2002, Int. J. Robotics Res..

[16]  Anthony Stentz,et al.  Optimal and efficient path planning for partially-known environments , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[17]  Nidhi Kalra,et al.  Replanning with RRTs , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[18]  Anthony Stentz,et al.  Using interpolation to improve path planning: The Field D* algorithm , 2006, J. Field Robotics.

[19]  Jean-Claude Latombe,et al.  On multi-arm manipulation planning , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[20]  Edsger W. Dijkstra,et al.  A note on two problems in connexion with graphs , 1959, Numerische Mathematik.

[21]  Steven M. LaValle,et al.  Rapidly-Exploring Random Trees: Progress and Prospects , 2000 .