We propose an online single-query sampling-based feedback motion re-planning algorithm using finite-time invariant sets, “funnels". We combine concepts from nonlinear systems analysis, sampling-based motion planning, and graph-search methods to create a single framework that enables feedback motion planning/replanning for general nonlinear dynamical systems in a dynamic workspace. We introduce a novel graph data structure to represent a network of volumetric funnels, enabling the use of quick graph-replanning techniques. The use of incremental search techniques and a pre-computed library of motion-primitives ensure that our method can be used for quick on-the-fly rewiring of controllable motion plans in response to changes in the environment. We validate our approach on a simulated 6DOF quadrotor platform operating in a maze, and random forest environment.
PiP-X: Funnel-Based Online Feedback Motion Planning/Replanning in Dynamic Environments
Springer Proceedings in Advanced Robotics
International Workshop on the Algorithmic Foundations of Robotics ; 2022 ; , MD, USA June 22, 2022 - June 24, 2022
2022-12-15
17 pages
Article/Chapter (Book)
Electronic Resource
English
NTRS | 1988
|HST Servicing Mission Planning and Replanning Tool
NTRS | 1992
|Trajectory Planning Framework Combining Replanning and Hierarchical Planning
Transportation Research Record | 2023
|