448 research outputs found
Asymptotically near-optimal RRT for fast, high-quality, motion planning
We present Lower Bound Tree-RRT (LBT-RRT), a single-query sampling-based
algorithm that is asymptotically near-optimal. Namely, the solution extracted
from LBT-RRT converges to a solution that is within an approximation factor of
1+epsilon of the optimal solution. Our algorithm allows for a continuous
interpolation between the fast RRT algorithm and the asymptotically optimal
RRT* and RRG algorithms. When the approximation factor is 1 (i.e., no
approximation is allowed), LBT-RRT behaves like RRG. When the approximation
factor is unbounded, LBT-RRT behaves like RRT. In between, LBT-RRT is shown to
produce paths that have higher quality than RRT would produce and run faster
than RRT* would run. This is done by maintaining a tree which is a sub-graph of
the RRG roadmap and a second, auxiliary graph, which we call the lower-bound
graph. The combination of the two roadmaps, which is faster to maintain than
the roadmap maintained by RRT*, efficiently guarantees asymptotic
near-optimality. We suggest to use LBT-RRT for high-quality, anytime motion
planning. We demonstrate the performance of the algorithm for scenarios ranging
from 3 to 12 degrees of freedom and show that even for small approximation
factors, the algorithm produces high-quality solutions (comparable to RRG and
RRT*) with little running-time overhead when compared to RRT
Informed RRT*: Optimal Sampling-based Path Planning Focused via Direct Sampling of an Admissible Ellipsoidal Heuristic
Rapidly-exploring random trees (RRTs) are popular in motion planning because
they find solutions efficiently to single-query problems. Optimal RRTs (RRT*s)
extend RRTs to the problem of finding the optimal solution, but in doing so
asymptotically find the optimal path from the initial state to every state in
the planning domain. This behaviour is not only inefficient but also
inconsistent with their single-query nature.
For problems seeking to minimize path length, the subset of states that can
improve a solution can be described by a prolate hyperspheroid. We show that
unless this subset is sampled directly, the probability of improving a solution
becomes arbitrarily small in large worlds or high state dimensions. In this
paper, we present an exact method to focus the search by directly sampling this
subset.
The advantages of the presented sampling technique are demonstrated with a
new algorithm, Informed RRT*. This method retains the same probabilistic
guarantees on completeness and optimality as RRT* while improving the
convergence rate and final solution quality. We present the algorithm as a
simple modification to RRT* that could be further extended by more advanced
path-planning algorithms. We show experimentally that it outperforms RRT* in
rate of convergence, final solution cost, and ability to find difficult
passages while demonstrating less dependence on the state dimension and range
of the planning problem.Comment: 8 pages, 11 figures. Videos available at
https://www.youtube.com/watch?v=d7dX5MvDYTc and
https://www.youtube.com/watch?v=nsl-5MZfwu
Sampling-based Algorithms for Optimal Motion Planning
During the last decade, sampling-based path planning algorithms, such as
Probabilistic RoadMaps (PRM) and Rapidly-exploring Random Trees (RRT), have
been shown to work well in practice and possess theoretical guarantees such as
probabilistic completeness. However, little effort has been devoted to the
formal analysis of the quality of the solution returned by such algorithms,
e.g., as a function of the number of samples. The purpose of this paper is to
fill this gap, by rigorously analyzing the asymptotic behavior of the cost of
the solution returned by stochastic sampling-based algorithms as the number of
samples increases. A number of negative results are provided, characterizing
existing algorithms, e.g., showing that, under mild technical conditions, the
cost of the solution returned by broadly used sampling-based algorithms
converges almost surely to a non-optimal value. The main contribution of the
paper is the introduction of new algorithms, namely, PRM* and RRT*, which are
provably asymptotically optimal, i.e., such that the cost of the returned
solution converges almost surely to the optimum. Moreover, it is shown that the
computational complexity of the new algorithms is within a constant factor of
that of their probabilistically complete (but not asymptotically optimal)
counterparts. The analysis in this paper hinges on novel connections between
stochastic sampling-based path planning algorithms and the theory of random
geometric graphs.Comment: 76 pages, 26 figures, to appear in International Journal of Robotics
Researc
- …