π€ AI Summary
Existing flow matching (FM)-based planning methods lack formal guarantees regarding state and action constraints, as well as dynamical consistency, resulting in unsafe, infeasible, or physically unrealizable trajectories. To address this, we propose SAD-Flowerβa novel FM framework that, for the first time, integrates nonlinear control theory into the FM architecture. By introducing virtual control inputs, SAD-Flower enables explicit modeling of hard constraints while ensuring dynamic consistency throughout trajectory generation. Crucially, it supports zero-shot generalization to previously unseen constraints at test time without retraining. Evaluated across multiple robotic planning tasks, SAD-Flower significantly outperforms generative baselines: constraint satisfaction rates improve markedly, while generated trajectories remain provably safe, dynamically feasible, and physically executable.
π Abstract
Flow matching (FM) has shown promising results in data-driven planning. However, it inherently lacks formal guarantees for ensuring state and action constraints, whose satisfaction is a fundamental and crucial requirement for the safety and admissibility of planned trajectories on various systems. Moreover, existing FM planners do not ensure the dynamical consistency, which potentially renders trajectories inexecutable. We address these shortcomings by proposing SAD-Flower, a novel framework for generating Safe, Admissible, and Dynamically consistent trajectories. Our approach relies on an augmentation of the flow with a virtual control input. Thereby, principled guidance can be derived using techniques from nonlinear control theory, providing formal guarantees for state constraints, action constraints, and dynamic consistency. Crucially, SAD-Flower operates without retraining, enabling test-time satisfaction of unseen constraints. Through extensive experiments across several tasks, we demonstrate that SAD-Flower outperforms various generative-model-based baselines in ensuring constraint satisfaction.