Densification Strategies for Anytime Motion Planning over Large Dense Roadmaps

TL;DR

This paper introduces densification strategies that improve anytime motion planning over large dense roadmaps by progressively increasing graph density, enabling efficient shortest path computation in high-dimensional, dense environments.

Contribution

It proposes novel densification strategies for exploring dense subgraphs in motion planning roadmaps, enhancing anytime search efficiency and convergence to optimal paths.

Findings

Strategies outperform baseline in large dense graphs

Effective in high-dimensional and manipulation scenarios

Hybrid approach offers robust performance across difficulties

Abstract

We consider the problem of computing shortest paths in a dense motion-planning roadmap $\mathcal{G}$. We assume that~$n$, the number of vertices of $\mathcal{G}$, is very large. Thus, using any path-planning algorithm that directly searches $\mathcal{G}$, running in $O(V\textrm{log}V + E) \approx O(n^2)$ time, becomes unacceptably expensive. We are therefore interested in anytime search to obtain successively shorter feasible paths and converge to the shortest path in $\mathcal{G}$. Our key insight is to provide existing path-planning algorithms with a sequence of increasingly dense subgraphs of $\mathcal{G}$. We study the space of all ($r$-disk) subgraphs of $\mathcal{G}$. We then formulate and present two densification strategies for traversing this space which exhibit complementary properties with respect to problem difficulty. This inspires a third, hybrid strategy which has favourable properties regardless of problem difficulty. This general approach is then demonstrated and analyzed using the specific case where a low-dispersion deterministic sequence is used to generate the samples used for $\mathcal{G}$. Finally we empirically evaluate the performance of our strategies for random scenarios in $\mathbb{R}^{2}$ and $\mathbb{R}^{4}$ and on manipulation planning problems for a 7 DOF robot arm, and validate our analysis.