Search papers, labs, and topics across Lattice.
This paper introduces Model-Based Diffusion Optimal Control (MDOC), a novel approach to multi-robot motion planning that generates dynamically feasible and collision-free trajectories without the need for extensive demonstration datasets. By integrating known dynamics models with Control Barrier Function-constrained projections, MDOC effectively enforces safety constraints while leveraging Conflict-Based Search to scale across multiple robots. Experimental results demonstrate that MDOC significantly outperforms traditional planners in terms of sample efficiency, geometric smoothness, success rate, and computation time.
MDOC achieves collision-free multi-robot trajectories with unprecedented efficiency and safety, all without relying on large datasets.
Multi-Robot Motion Planning in continuous environments, where robots must generate dynamically feasible, collision-free trajectories, is challenging due to the combinatorial growth of the joint trajectory space and the difficulty of enforcing dynamic feasibility and hard safety constraints. Recent approaches recast trajectory planning as probabilistic inference, sampling from a posterior over trajectories using diffusion models whose score functions are learned from demonstration data. While showing promising performance, these approaches are limited: they often rely on sizable demonstration datasets and struggle to rigorously enforce dynamics and hard safety constraints during sampling. To this end, we introduce Model-Based Diffusion Optimal Control (MDOC), a model-based diffusion planner that efficiently produces dynamically feasible trajectories without relying on data. Crucially, we show that MDOC's safety mechanism -- combining known dynamics models with Control Barrier Function-constrained projections -- naturally scales to multi-robot planning settings through Conflict-Based Search. Across simulation experiments, this integrated method consistently outperforms representative baseline planners in sample efficiency, geometric smoothness, and success rate, while reducing computation time and producing collision-free trajectories.