Multi-Agent Feedback Motion Planning using Probably Approximately Correct Nonlinear Model Predictive Control
Mark Gonzales, Adam Polevoy, Marin Kobilarov, Joseph Moore
TL;DR
The paper tackles the challenge of coordinating multiple robots with nonlinear stochastic dynamics in cluttered environments by introducing a distributed receding-horizon PAC-NMPC framework that accounts for model and state measurement uncertainty. A gyroscopic obstacle-avoidance-inspired terminal cost and a policy-sharing scheme enable probabilistically-safe formation control, with simulations showing performance comparable to centralized methods and improved robustness to measurement noise. Key contributions include: (1) a scalable distributed PAC-NMPC formulation for multi-agent formation in obstacle fields, (2) a gyroscopic terminal cost to mitigate local minima, and (3) comprehensive simulations demonstrating robustness, scalability to higher dimensions, and favorable trade-offs against RA-MPPI. The approach holds practical potential for robust, scalable multi-robot collaboration in uncertain, real-world settings.
Abstract
For many tasks, multi-robot teams often provide greater efficiency, robustness, and resiliency. However, multi-robot collaboration in real-world scenarios poses a number of major challenges, especially when dynamic robots must balance competing objectives like formation control and obstacle avoidance in the presence of stochastic dynamics and sensor uncertainty. In this paper, we propose a distributed, multi-agent receding-horizon feedback motion planning approach using Probably Approximately Correct Nonlinear Model Predictive Control (PAC-NMPC) that is able to reason about both model and measurement uncertainty to achieve robust multi-agent formation control while navigating cluttered obstacle fields and avoiding inter-robot collisions. Our approach relies not only on the underlying PAC-NMPC algorithm but also on a terminal cost-function derived from gyroscopic obstacle avoidance. Through numerical simulation, we show that our distributed approach performs on par with a centralized formulation, that it offers improved performance in the case of significant measurement noise, and that it can scale to more complex dynamical systems.
