Abstract:In this paper we present a novel probabilistic sampling-based motion planning algorithm called the Fast Marching Tree algorithm (FMT*). The algorithm is specifically aimed at solving complex motion planning problems in high-dimensional configuration spaces. This algorithm is proven to be asymptotically optimal and is shown to converge to an optimal solution faster than its state-of-the-art counterparts, chiefly PRM* and RRT*. The FMT* algorithm performs a "lazy" dynamic programming recursion on a predetermined number of probabilistically-drawn samples to grow a tree of paths, which moves steadily outward in cost-to-arrive space. As a departure from previous analysis approaches that are based on the notion of almost sure convergence, the FMT* algorithm is analyzed under the notion of convergence in probability: the extra mathematical flexibility of this approach allows for convergence rate bounds--the first in the field of optimal sampling-based motion planning. Specifically, for a certain selection of tuning parameters and configuration spaces, we obtain a convergence rate bound of order $O(n^{-1/d+\rho})$, where $n$ is the number of sampled points, $d$ is the dimension of the configuration space, and $\rho$ is an arbitrarily small constant. We go on to demonstrate asymptotic optimality for a number of variations on FMT*, namely when the configuration space is sampled non-uniformly, when the cost is not arc length, and when connections are made based on the number of nearest neighbors instead of a fixed connection radius. Numerical experiments over a range of dimensions and obstacle configurations confirm our theoretical and heuristic arguments by showing that FMT*, for a given execution time, returns substantially better solutions than either PRM* or RRT*, especially in high-dimensional configuration spaces and in scenarios where collision-checking is expensive.

Informed Anytime Fast Marching Tree for Asymptotically Optimal Motion Planning

Informed Anytime Bi-directional Fast Marching Tree for Optimal Motion Planning in Complex Cluttered Environments

Obstacle Based Fast Marching Tree for Global Motion Planning.

A Batch Informed Sampling-Based Algorithm for Fast Anytime Asymptotically-Optimal Motion Planning in Cluttered Environments

Fast Marching Tree: a Fast Marching Sampling-Based Method for Optimal Motion Planning in Many Dimensions

Nearest-Neighbourless Asymptotically Optimal Motion Planning with Fully Connected Informed Trees (FCIT*)

A Reachability-Based Spatio-Temporal Sampling Strategy for Kinodynamic Motion Planning.

Heuristic Bidirectional Fast Marching Tree for Optimal Motion Planning

Sampling-Based Motion Planning for Free-Floating Space Robot Without Inverse Kinematics

Asymptotically-Optimal Motion Planning using Lower Bounds on Cost

ST-FMT*: A Fast Optimal Global Motion Planning for Mobile Robot

Dual Fast Marching Tree Algorithm for Human-Like Motion Planning of Anthropomorphic Arms with Task Constraints

A Region-Specific Hybrid Sampling Method for Optimal Path Planning

An Asymptotically-Optimal Sampling-Based Algorithm for Bi-directional Motion Planning

A Fast Marching Gradient Sampling Strategy for Motion Planning Using an Informed Certificate Set.

An Adaptive Multi-Rrt Approach for Robot Motion Planning

Fast Anytime Motion Planning in Point Clouds by Interleaving Sampling and Interior Point Optimization

Asymptotically Optimal Lazy Lifelong Sampling-based Algorithm for Efficient Motion Planning in Dynamic Environments

Fast Convergence Rrt For Asymptotically-Optimal Motion Planning

Adaptive Space Expansion for Fast Motion Planning

IBBT: Informed Batch Belief Trees for Motion Planning Under Uncertainty