977 research outputs found
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
The Reach-Avoid Problem for Constant-Rate Multi-Mode Systems
A constant-rate multi-mode system is a hybrid system that can switch freely
among a finite set of modes, and whose dynamics is specified by a finite number
of real-valued variables with mode-dependent constant rates. Alur, Wojtczak,
and Trivedi have shown that reachability problems for constant-rate multi-mode
systems for open and convex safety sets can be solved in polynomial time. In
this paper, we study the reachability problem for non-convex state spaces and
show that this problem is in general undecidable. We recover decidability by
making certain assumptions about the safety set. We present a new algorithm to
solve this problem and compare its performance with the popular sampling based
algorithm rapidly-exploring random tree (RRT) as implemented in the Open Motion
Planning Library (OMPL).Comment: 26 page
Admissible Velocity Propagation : Beyond Quasi-Static Path Planning for High-Dimensional Robots
Path-velocity decomposition is an intuitive yet powerful approach to address
the complexity of kinodynamic motion planning. The difficult trajectory
planning problem is solved in two separate, simpler, steps: first, find a path
in the configuration space that satisfies the geometric constraints (path
planning), and second, find a time-parameterization of that path satisfying the
kinodynamic constraints. A fundamental requirement is that the path found in
the first step should be time-parameterizable. Most existing works fulfill this
requirement by enforcing quasi-static constraints in the path planning step,
resulting in an important loss in completeness. We propose a method that
enables path-velocity decomposition to discover truly dynamic motions, i.e.
motions that are not quasi-statically executable. At the heart of the proposed
method is a new algorithm -- Admissible Velocity Propagation -- which, given a
path and an interval of reachable velocities at the beginning of that path,
computes exactly and efficiently the interval of all the velocities the system
can reach after traversing the path while respecting the system kinodynamic
constraints. Combining this algorithm with usual sampling-based planners then
gives rise to a family of new trajectory planners that can appropriately handle
kinodynamic constraints while retaining the advantages associated with
path-velocity decomposition. We demonstrate the efficiency of the proposed
method on some difficult kinodynamic planning problems, where, in particular,
quasi-static methods are guaranteed to fail.Comment: 43 pages, 14 figure
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
- …