Multi-Robot Trajectory Planning via Constrained Bayesian Optimization and Local Cost Map Learning with STL-Based Conflict Resolution
Sourav Raxit, Abdullah Al Redwan Newaz, Jose Fuentes, Paulo Padrao, Ana Cavalcanti ,, Leonardo Bobadilla · 2026
Read Multi-Robot Trajectory Planning via Constrained Bayesian Optimization and Local Cost Map Learning with STL-Based Conflict Resolution by Sourav Raxit, Abdullah Al Redwan Newaz, Jose Fuentes, Paulo Padrao, Ana Cavalcanti ,, Leonardo Bobadilla (2026) in the Tower of Babel, a free online library of public-domain works preserved in clean, searchable text. No sign-up. The full text is served as a plain-text file at a predictable URL, where text is present: https://antarctic-labs.com/tower-of-babel/arxiv-2603-05767.txt.
Introduction
Raxit and team address multi-robot motion planning under time logic. Exact methods face growth blocks, while sampling methods need too many samples. They propose a two-stage framework joining online learning with time logic thinking. At the single-robot level, their Tree search planner learns cost maps via a Gaussian process. It makes shorter paths using fewer samples. At the multi-robot level, their Conflict-Based Search code uses time logic watching in conflict settling. Tests show improved speed and safety. Real-world tests with surface craft back toughness.
Catalog record
| CREATOR | Sourav Raxit, Abdullah Al Redwan Newaz, Jose Fuentes, Paulo Padrao, Ana Cavalcanti ,, Leonardo Bobadilla |
|---|---|
| YEAR | 2026 |
| COLLECTION | PAPERS |
| FORMAT | TXT |
| FILE SIZE | 41283 |
| LICENSE | http://creativecommons.org/licenses/by/4.0/ |
| RIGHTS | CC BY |
| SOURCE | arXiv |
Source: https://arxiv.org/abs/2603.05767
Browse the full library · About the Tower of Babel
Full text
The opening of the work, from the library's hosted text:
Multi-Robot Trajectory Planning via Constrained Bayesian Optimization and Local Cost Map Learning with STL-Based Conflict Resolution Sourav Raxit, Abdullah Al Redwan Newaz, Jose Fuentes, Paulo Padrao, Ana Cavalcanti ,, Leonardo Bobadilla 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/ . I Introduction A central challenge in multi-robot systems lies in generating dynamically feasible trajectories that permit robots to simultaneously reach their target regions without colliding with obstacles or with one another. Conventional methods typically rely on explicitly encoding large sets of low-level constraints, leading to brittle solutions with limited adaptability to real-world conditions. Signal Temporal Logic (STL) [ 18 ] , by contrast, offers a powerful declarative formalism that enables high-level specification of temporal and logical requirements, supporting sophisticated behaviors such as International Regulations for Preventing Collisions at Sea (COLREGs), coordinated motion through intersections, and adaptive responses to environmental changes. Early STL-based planning approaches frequently employed model predictive control (MPC) [ 28 , 23 , 13 ] , which proved effective but computationally expensive when tackling complex formulas and long horizons. To improve scalability, STL constraints have been incorporated into sampling-based planners such as RRT* and its real-time extensions, with robustness metrics guiding the search toward specification-compliant solutions [ 14 ] . Multi-layered frameworks have since integrated kinodynamic constraints and STL through biased exploration and robustness-driven costs, enabling sequential satisfaction of tasks with greater efficiency [ 2 ] . More recently, reinforcement learning has been combined with STL semantics to address the reward-shaping problem, producing task-aware and robust policies [ 9 , 21 ] . These efforts highlight STL’s potential in single-agent contexts, but extending such capabilities to multi-robot systems introduces substantial new challenges. Scaling STL to multi-robot motion planning (MRMP) requires addressing task allocation, inter-agent coordination, and nonlinear or nonholonomic dynamics [ 26 , 5 ] . Centralized approaches often encode multi-agent STL specifications as mixed-integer linear programs (MILP), allowing implicit task assignment and collision avoidance [ 26 , 16 ] . While effective, MILP formulations face scalability bottlenecks inherent to their solvers. Decentralized alternatives have thus emerged: barrier-function-based feedback controllers ensure continuous-time STL satisfaction across agents [ 15 , 7 ] , while distributed MPC relaxes infeasible constraints to guarantee recursive feasibility under conflicting tasks [ 29 ] . Complementing these methods, differentiable STL robustness has enabled graph neural planners to handle heterogeneous teams and cluttered environments with up to 32 robots [ 5 ] , offering improved scalability over centralized MPC baselines. Beyond STL-specific work, broader MRMP research provides valuable insights through multi-agent path finding (MAPF) extensions [ 24 , 17 , 1 ] and sampling-based methods that offer flexibility through collision checking alone. While coupled approaches explore joint state spaces, their synchronized action requirements restrict time optimality, and spatiotemporal variants like Time-Based RRT [ 25 ] , Temporal PRM [ 8 ] , and ST-RRT* [ 6 ] enhance temporal reasoning but struggle in narrow corridors, limiting scalability. Graphs of Convex Sets (GCS) provide a geometry-driven alternative by constructing collision-free convex regions directly, with applications in UAV navigation, non-Euclidean motion planning, and temporal-logic tasks [ 19 , 4 , 11 ] , while multi-robot extensions show efficiency improvements [ 3 , 20 ] despite dynamic coordination challenges that motivate developments like ST-GCS [ 27 ] . Kinodynamic Conflict-Based Search (K-CBS) [ 10 ] decomposes planning into high-level coordination and low-level trajectory generation, achieving probabilistic completeness and scalability but struggling with path optimization due to RRT-based planning and cost map neglect. Though not designed for STL, these methods could be augmented with temporal-logic constraints, bridging discrete conflict resolution and decentralized STL planning. Table I summarizes a qualitative comparison of the related methods. Method Multirobot STL Spec Learning Kinodynamic Constraints MILP [ 26 ] ✓ ✓ \times \times STL-RRT* [ 6 , 2 ] \times ✓ \times \times ST-GCS [ 27 ] ✓ ✓ \times \times MPC [ 13 ] \times ✓ ✓ \times GCBF [ 5 ] ✓ ✓ ✓ \times K-CBS [ 10 ] ✓ \times \times ✓ Ours ✓ ✓ ✓ ✓ TABLE I : Qualitative comparison of the related methods. Contributions. The main contributions of this paper are as follows: ( i ) We propose a constrained Bayesian optimization–based tree search (cBOT) algorithm for computing collision-free trajectories for individual robots. The cBOT framework incorporates a local cost map modeled with a Gaussian process (GP) and learns individual constraints using separate GPs. This enables the planner to generate shorter trajectories with fewer samples compared to conventional RRT-based approaches. ( ii ) We introduce the STL-enhanced Kinodynamic Conflict-Based Search (STL-KCBS) algorithm, which efficiently computes multi-robot trajectories by combining the decoupled, sampling-based cBOT planner with a conflict tree. STL-KCBS inherits the decentralized and scalable properties of the K-CBS framework [ 10 ] , while also providing probabilistic completeness guarantees. ( iii ) We present a comprehensive benchmarking study against existing approaches, demonstrating the advantages of the proposed STL-KCBS planner. A qualitative comparison of related methods is summarized in Table I . ( iv ) We validate the real-world applicability of the STL-KCBS planner through experiments with autonomous surface vehicles operating in a lake environment. II Problem Formulation Consider a team of N robots operating in a d -dimensional workspace W\subset\mathbb{R}^{d} , which represents the geometric space of spatial positions , with the free space defined as W_{\text{f}}=X_{\text{f}}=X\setminus X_{\text{obs}} , where X_{\text{obs}}\subset X\subseteq\mathbb{R}^{d} represents obstacles. Each robot is initialized at a designated position \mathbf{x}_{i}^{\text{init}}\in W , \Pi_{i}(\mathbf{x}_{i,\text{init}})=p_{i}^{\text{init}} ; \Pi_{i}:X_{i}\to W is the projection function that maps the robot’s state into its position. The team’s navigation objective is specified by the multi-agent signal temporal logic (MA-STL) formula \Psi (cf. Definition 2 ), which encodes desired collective behaviors over time. Given a real-valued function \mu:W\to\mathbb{R} , an atomic predicate is defined as \pi^{\mu} , where a point \mathbf{x}\in W satisfies \mathbf{x}\models\pi^{\mu} if \mu(\mathbf{x})\geq 0 . We present notations used throughout: \mathbb{R} , \mathbb{R}_{\geq 0} , and \mathbb{N} denote the sets of real, non-negative real, and natural numbers, respectively. We write \mathbb{R}^{n} for the n -dimensional Euclidean space and \mathbb{R}^{n\times m} for the space of real matrices with n rows and m columns. For a\leq b , [a,b] denotes a time interval, and t+[a,b]:=[t+a,t+b] . We denote the set of all functions from X to Y by Y^{X} . Definition 1 (Signal Temporal Logic (STL) Semantics) Let M\subset\mathbb{R}^{d} , S=M^{\mathbb{R}_{\geq 0}} denotes the set