FaSTrack: a Modular Framework for Real-Time Motion Planning and Guaranteed Safe Tracking

by   Mo Chen, et al.

Real-time, guaranteed safe trajectory planning is vital for navigation in unknown environments. However, real-time navigation algorithms typically sacrifice robustness for computation speed. Alternatively, provably safe trajectory planning tends to be too computationally intensive for real-time replanning. We propose FaSTrack, Fast and Safe Tracking, a framework that achieves both real-time replanning and guaranteed safety. In this framework, real-time computation is achieved by allowing any trajectory planner to use a simplified planning model of the system. The plan is tracked by the system, represented by a more realistic, higher-dimensional tracking model. We precompute the tracking error bound (TEB) due to mismatch between the two models and due to external disturbances. We also obtain the corresponding tracking controller used to stay within the TEB. The precomputation does not require prior knowledge of the environment. We demonstrate FaSTrack using Hamilton-Jacobi reachability for precomputation and three different real-time trajectory planners with three different tracking-planning model pairs.


page 1

page 16


KinoJGM: A framework for efficient and accurate quadrotor trajectory generation and tracking in dynamic environments

Unmapped areas and aerodynamic disturbances render autonomous navigation...

Robust Tracking with Model Mismatch for Fast and Safe Planning: an SOS Optimization Approach

In the pursuit of real-time motion planning, a commonly adopted practice...

External Forces Resilient Safe Motion Planning for Quadrotor

Adaptive autonomous navigation with no prior knowledge of extraneous dis...

Real-time Funnel Generation for Restricted Motion Planning

In autonomous systems, a motion planner generates reference trajectories...

Agent Prioritization for Autonomous Navigation

In autonomous navigation, a planning system reasons about other agents t...

Rapid Motion-Planning for Dubins Vehicles under Environmental Drifts

This paper presents a rapid (i.e., (near) real time) solution to the min...

Improved Safe Real-time Heuristic Search

A fundamental concern in real-time planning is the presence of dead-ends...