423 research outputs found
Probabilistic completeness of RRT for geometric and kinodynamic planning with forward propagation
The Rapidly-exploring Random Tree (RRT) algorithm has been one of the most
prevalent and popular motion-planning techniques for two decades now.
Surprisingly, in spite of its centrality, there has been an active debate under
which conditions RRT is probabilistically complete. We provide two new proofs
of probabilistic completeness (PC) of RRT with a reduced set of assumptions.
The first one for the purely geometric setting, where we only require that the
solution path has a certain clearance from the obstacles. For the kinodynamic
case with forward propagation of random controls and duration, we only consider
in addition mild Lipschitz-continuity conditions. These proofs fill a gap in
the study of RRT itself. They also lay sound foundations for a variety of more
recent and alternative sampling-based methods, whose PC property relies on that
of RRT
Optimal Sampling-Based Motion Planning under Differential Constraints: the Drift Case with Linear Affine Dynamics
In this paper we provide a thorough, rigorous theoretical framework to assess
optimality guarantees of sampling-based algorithms for drift control systems:
systems that, loosely speaking, can not stop instantaneously due to momentum.
We exploit this framework to design and analyze a sampling-based algorithm (the
Differential Fast Marching Tree algorithm) that is asymptotically optimal, that
is, it is guaranteed to converge, as the number of samples increases, to an
optimal solution. In addition, our approach allows us to provide concrete
bounds on the rate of this convergence. The focus of this paper is on mixed
time/control energy cost functions and on linear affine dynamical systems,
which encompass a range of models of interest to applications (e.g.,
double-integrators) and represent a necessary step to design, via successive
linearization, sampling-based and provably-correct algorithms for non-linear
drift control systems. Our analysis relies on an original perturbation analysis
for two-point boundary value problems, which could be of independent interest
Generalizing Informed Sampling for Asymptotically Optimal Sampling-based Kinodynamic Planning via Markov Chain Monte Carlo
Asymptotically-optimal motion planners such as RRT* have been shown to
incrementally approximate the shortest path between start and goal states. Once
an initial solution is found, their performance can be dramatically improved by
restricting subsequent samples to regions of the state space that can
potentially improve the current solution. When the motion planning problem lies
in a Euclidean space, this region , called the informed set, can be
sampled directly. However, when planning with differential constraints in
non-Euclidean state spaces, no analytic solutions exists to sampling
directly.
State-of-the-art approaches to sampling in such domains such as
Hierarchical Rejection Sampling (HRS) may still be slow in high-dimensional
state space. This may cause the planning algorithm to spend most of its time
trying to produces samples in rather than explore it. In this paper,
we suggest an alternative approach to produce samples in the informed set
for a wide range of settings. Our main insight is to recast this
problem as one of sampling uniformly within the sub-level-set of an implicit
non-convex function. This recasting enables us to apply Monte Carlo sampling
methods, used very effectively in the Machine Learning and Optimization
communities, to solve our problem. We show for a wide range of scenarios that
using our sampler can accelerate the convergence rate to high-quality solutions
in high-dimensional problems
Sampling-based optimal kinodynamic planning with motion primitives
This paper proposes a novel sampling-based motion planner, which integrates
in RRT* (Rapidly exploring Random Tree star) a database of pre-computed motion
primitives to alleviate its computational load and allow for motion planning in
a dynamic or partially known environment. The database is built by considering
a set of initial and final state pairs in some grid space, and determining for
each pair an optimal trajectory that is compatible with the system dynamics and
constraints, while minimizing a cost. Nodes are progressively added to the tree
{of feasible trajectories in the RRT* by extracting at random a sample in the
gridded state space and selecting the best obstacle-free motion primitive in
the database that joins it to an existing node. The tree is rewired if some
nodes can be reached from the new sampled state through an obstacle-free motion
primitive with lower cost. The computationally more intensive part of motion
planning is thus moved to the preliminary offline phase of the database
construction at the price of some performance degradation due to gridding. Grid
resolution can be tuned so as to compromise between (sub)optimality and size of
the database. The planner is shown to be asymptotically optimal as the grid
resolution goes to zero and the number of sampled states grows to infinity
- …