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 Bi-directional Fast Marching Tree for Optimal Motion Planning in Complex Cluttered Environments

Informed Anytime Fast Marching Tree for Asymptotically Optimal Motion Planning

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

Obstacle Based Fast Marching Tree for Global Motion Planning.

Heuristic Bidirectional Fast Marching Tree for Optimal Motion Planning

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

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

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

Asymptotically-Optimal Motion Planning using Lower Bounds on Cost

A Region-Specific Hybrid Sampling Method for Optimal Path Planning

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

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

Flexible Informed Trees (FIT*): Adaptive Batch-Size Approach in Informed Sampling-Based Path Planning

Adaptively Informed Trees (AIT) and Effort Informed Trees (EIT): Asymmetric bidirectional sampling-based path planning

Intelligent bidirectional rapidly-exploring random trees for optimal motion planning in complex cluttered environments

Potentially guided bidirectionalized RRT* for fast optimal path planning in cluttered environments

RBI-RRT*: Efficient Sampling-based Path Planning for High-dimensional State Space

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

Adaptively Informed Trees (AIT*): Fast Asymptotically Optimal Path Planning through Adaptive Heuristics

BABIT: a Bidirectional Advanced BIT for Fast Path Planning with Implicit Random Geometric Graph

IBBT: Informed Batch Belief Trees for Motion Planning Under Uncertainty