Multi-Robot Trajectory Planning via Constrained Bayesian Optimization and Local Cost Map Learning with STL-Based Conflict Resolution
Organizations: Department of Computer Science, University of New Orleans, New Orleans, LA 70148, USA · Knight Foundation School of Computing and Information Sciences, Florida International University, Miami, FL 33199, USA · Providence College, Department of Mathematics & Computer Science, Providence, RI 02918, USA
Abstract
We address multi-robot motion planning under Signal Temporal Logic (STL) specifications with kinodynamic constraints. Exact approaches face scalability bottlenecks and limited adaptability, while conventional sampling-based methods require excessive samples to construct optimal trajectories. We propose a two-stage framework integrating sampling-based online learning with formal STL reasoning. At the single-robot level, our constrained Bayesian Optimization-based Tree search (cBOT) planner uses a Gaussian process as a surrogate model to learn local cost maps and feasibility constraints, generating shorter collision-free trajectories with fewer samples. At the multi-robot level, our STL-enhanced Kinodynamic Conflict-Based Search (STL-KCBS) algorithm incorporates STL monitoring into conflict detection and resolution, ensuring specification satisfaction while maintaining scalability and probabilistic completeness. Benchmarking demonstrates improved trajectory efficiency and safety over existing methods. Real-world experiments with autonomous surface vehicles validate robustness and practical applicability in uncertain environments. The STLcBOT Planner will be released as an open-source package, and videos of real-world and simulated experiments are available at https://stlbot.github.io/.
Figures & tables
| Method | Multirobot | STL Spec | Learning | Kinodynamic Constraints |
|---|---|---|---|---|
| MILP [ 9 ] | ✓ | ✓ | ||
| STL-RRT* [ 20 , 6 ] | ✓ | |||
| ST-GCS [ 26 ] | ✓ | ✓ | ||
| MPC [ 4 ] | ✓ | ✓ | ||
| GCBF [ 10 ] | ✓ | ✓ | ✓ | |
| K-CBS [ 27 ] | ✓ | ✓ |