/Efficient high-quality motion planning by fast all-pairs r-nearest-neighbors

Efficient high-quality motion planning by fast all-pairs r-nearest-neighbors

Michal Kleinbort, Oren Salzman and Dan Halperin
Conference Paper, IEEE International Conference on Robotics and Automation (ICRA), pp. 2985-2990, May, 2015

Download Publication (PDF)

Copyright notice: This material is presented to ensure timely dissemination of scholarly and technical work. Copyright and all rights therein are retained by authors or by other copyright holders. All persons copying this information are expected to adhere to the terms and constraints invoked by each author’s copyright. These works may not be reposted without the explicit permission of the copyright holder.


Sampling-based motion-planning algorithms typically rely on nearest-neighbor (NN) queries when constructing a roadmap. Recent results suggest that in various settings NN queries may be the computational bottleneck of such algorithms. Moreover, in several asymptotically-optimal algorithms these NN queries are of a specific form: Given a set of points and a radius r report all pairs of points whose distance is at most r. This calls for an application-specific NN data structure tailored to efficiently answering this type of queries. Randomly transformed grids (RTG) were recently proposed by Aiger et al. [1] as a tool to answer such queries in Euclidean spaces and have been shown to outperform common implementations of NN data structures for this type of queries. In this work we employ RTG for sampling-based motion-planning algorithms and describe an efficient implementation of the approach. We show that for motion planning, RTG allow for faster convergence to high-quality solutions when compared to existing NN data structures. Additionally, RTG enable significantly shorter construction times for batched-PRM variants; specifically, we demonstrate a speedup by a factor of two to three for some scenarios.

BibTeX Reference
author = {Michal Kleinbort and Oren Salzman and Dan Halperin},
title = {Efficient high-quality motion planning by fast all-pairs r-nearest-neighbors},
booktitle = {IEEE International Conference on Robotics and Automation (ICRA)},
year = {2015},
month = {May},
pages = {2985-2990},