On-Manifold Strategies for Reactive Dynamical System Modulation with Nonconvex Obstacles

In this work, we present a novel, reactive, modulated control strategy based on dynamical systems (DS) for planning in the context of multiple non-convex obstacles. Our DS modulation strategy leverages an on-manifold planning methodology and provides several methods for real-time on-manifold navigation around non-convex obstacles. We introduce a sample-based obstacle representation for complex, non-convex obstacles, as well as a projection-based method for representing surfaces such as tables, cylinders, and ellipsoids. These representations can be combined to represent multiple obstacles and obstacle types (sample- or projection-based) with a single, continuously differentiable function. We validate our approach in several real-world scenarios, including navigation within (simulated) constrained environments, as well as reactive control of a real 7DoF manipulator with dynamic obstacles (including humans) while utilizing a 1 kHz control loop rate. Using our samplebased representation, we can calculate the obstacle representation function in less than 1 ms with up to 35k points using a CPU implementation, and up to 600k points with a GPU implementation.