Safe Multi-Robot Coordination via VLM-LLM Reasoning and Reachability Analysis
Authors: Mohamed Dwedar, Ahmad Hafez, Alexander Jesser, Amr Alanwar
Organizations: TUM School of Computation, Information, and Technology (CIT), Technical University of Munich (TUM), Heilbronn, Germany. · Institute for Intelligent Cyber-Physical Systems (ICPS), Heilbronn University of Applied Science, Heilbronn, Germany.
Safe coordination in heterogeneous machine-to-machine (M2M) robotic systems is challenging when robots differ in sensing capabilities, environmental awareness, and motion execution roles. This paper presents a centralized safety-aware M2M framework for cooperative goal-directed navigation in a heterogeneous mobile robot team comprising a vision-capable quadruped and a camera-less robotic vehicle. The objective is to guide both platforms toward a goal region while avoiding static and dynamic obstacles and preventing unsafe inter-robot interactions. Under the principle of shared perception, the vision-capable robot provides semantic environmental awareness through a centralized server over an MQTT broker, enabling the camera-less platform to navigate using this shared scene representation alongside its own odometry, IMU, and state feedback. A vision-language model (VLM) interprets the visual stream, and the extracted semantic data is mapped into conservative metric geometric constraints, including inflated obstacle sets, safe corridors, and goal regions. A large language model (LLM) proposes high-level task allocations, while physical command authority is restricted to a robot-specific zonotope reachability gate. This verification engine propagates independent reachable tubes to evaluate obstacle avoidance, safe-corridor containment, and inter-robot separation predicates before approving commands. Online experiments across clear-path and dynamic-obstacle scenarios show that the pipeline reliably approves safe motion, triggers conservative replanning or holding maneuvers upon constraint violation, and enforces a strict architectural separation between advisory semantic reasoning and formally verified motor execution.
Figures & tables
Fig. 1 : Simplified view of the proposed method. Shaded blocks are gates; light blocks are advisory and carry no command authority. Semantic evidence produced by the Go2 propagates to SVEA, but command authority does not: Gate 4 is evaluated independently for each robot.
Capability axis
System
Category
SEM
SYM
GATE
MR
XFER
INT
Safety mechanism reported
Language-model planning and vision–language–action models
SayCan [ 6 ]
LLM planning
✓
✓
✗
✗
✗
✗
Affordance scoring; no kinodynamic verification.
PaLM-E [ 11 ]
VLA model
✓
✓
✗
✗
✗
✗
End-to-end; safety implicit in training data.
RT-2 [ 40 ]
VLA model
✓
(✓)
✗
✗
✗
✗
Co-trained action tokens; no runtime gate.
Code-as-Policies [ 23 ]
LLM code generation
✓
✓
✗
✗
✗
✗
Programmatic guards written by the model itself.
TABLE I : Capability comparison against representative systems from the three literatures the proposed pipeline draws on. ✓ provided; (✓) partial, offline, or informal; ✗ not provided. The final row tallies how many of the twelve prior systems cover each axis.
Odometry, IMU, and state messages; used for robot-specific reachability evaluation.
None; receives approved commands only.
Mosquitto MQTT
Asynchronous M2M transport for telemetry, status messages, and approved command packets.
Routed state messages, server status, and verified commands.
None; transport layer only.
Qwen2.5-VL via Ollama
Semantic interpretation of Go2 camera frames.
Schema-validated JSON scene output with labels, regions, and confidence values.
None; perception evidence only.
Qwen3 via Ollama
Symbolic task-level reasoning from validated scene context and robot states.
Symbolic task proposal for downstream reachability verification.
None; symbolic guidance only.
Python zonotope module
CORA-style set propagation; robot-specific predicate evaluation.
Safety flag σk,i and approved command uk,isafe .
Sole command-approval authority.
TABLE II : System components, pipeline roles, and command authority.
Fig. 3 : Online clear-path validation from the Go2 camera stream.
Fig. 4 : Corridor-containment in the local workspace.
Fig. 5 : Online dynamic-obstacle validation from the Go2 camera stream.
Fig. 6 : Reachability under dynamic-obstacle interaction.
Fig. 7 : Reconstructed Go2 and SVEA planar trajectories.
Fig. 8 : Confidence, reprojection error, and safety-radius surface.
Fig. 9 : VLM confidence versus conservative safety radius.
ID
Scenario
Cycles
Duration (s)
Objective
Predicate stressed
S1
Office room, goal approach
720
24.0
Establish nominal acceptance: verify the gate approves motion when a traversable corridor and a goal cue are both present and no dynamic obstacle is in the workspace.
ηobs , ηcor
S2
Stairwell, non-traversable hazard
361
12.0
Establish maximal rejection: verify that a region which is geometrically open but not traversable is excluded by corridor containment even though no obstacle intersection occurs.
ηcor (isolated)
S3
Corridor, pedestrian entry
421
14.0
Verify dynamic-obstacle handling: compound inflation of a moving human footprint and redirection of the candidate path through the remaining traversable corridor.
ηobs
S4
Sustained human tracking
451
15.0
Verify sustained operation under continuous re-planning at close range, including decision stability and clearance maintenance.
ηobs , ηcor
Total
1,953
65.1
17,577 verified candidate arcs, N=15 steps each
TABLE III : Test matrix: evaluation scenarios, objectives, and the safety predicate each is designed to exercise.
Volume
Gate outcome (%)
Internal safety state (%)
ID
Scenario
Cycles
Arcs
Approved
Withheld
Safe
Warning
Unsafe
Mean risk
S1
Office, goal approach
720
6,480
56.4
43.6
92.2
7.8
0.0
0.187±0.092
S2
Stairwell hazard
361
3,249
0.0
100.0
48.5
51.5
0.0
0.341±0.126
S3
Corridor, pedestrian
421
3,789
47.7
52.3
78.9
17.1
4.0
0.272±0.186
S4
Sustained tracking
451
4,059
37.9
62.1
18.8
12.6
68.5
0.678±0.230
All scenarios
1,953
17,577
39.8
60.2
64.3
19.0
16.7
0.347±0.248
TABLE IV : Gate behavior per evaluation scenario. Approval and withholding are reported as fractions of decision cycles; the internal safety state is the fraction of cycles spent in each condition; risk is the mean cycle-level score ± one standard deviation.
Decision
Cycles
Share
Mean risk
Clearance (m)
Motion approved
PROCEED
247
12.6%
0.155
2.43
AVOID + PROCEED
201
10.3%
0.737
0.92
TURN LEFT
170
8.7%
0.300
1.70
TURN RIGHT
160
8.2%
0.167
1.56
Motion withheld
TABLE V : Statistics conditioned on the decision issued by the gate. Clearance is the mean distance to the closest detected obstacle in cycles carrying that decision.
Class
Detections
Confidence
Range (m)
Min (m)
Person
456
0.870±0.068
0.91±0.26
0.51
Chair
404
0.842±0.083
3.19±2.94
0.99
Cabinet
113
0.613±0.086
1.00±0.42
0.64
All
973
0.844±0.095
1.86±2.21
0.51
Unresolved confidence: 89 ( 9.1% ), treated as maximum uncertainty.
Dynamic: 456 ( 46.9% ); static: 517 ( 53.1% ).
TABLE VI : Perception statistics over the 973 detections admitted to geometric conversion.
Condition
Active Predicate(s)
Decision
Status
All predicates satisfied
ηobs∧ηcor∧ηint
PROCEED
Approved
Obstacle present; alt. path available
ηobs∧ηcor∧ηint (after redirect)
AVOID+PROCEED
Approved
Obstacle-free; corridor violated
ηobs∧¬ηcor∧ηint
REPLAN
Withheld
Obstacle intersection
¬ηobs
STOP/HOLD
Withheld
Inter-robot overlap
¬ηint
HOLD
Withheld
Synchronization failure
Gate 1 (Eq. ( 2 ))
HOLD/STOP
Withheld
TABLE VII : Reachability gate decision logic.
Pipeline Stage
Symbol
Range (ms)
Budget (ms)
Rationale
MQTT transport
TMQTT
5–25
15
Local LAN or loopback broker; single-hop, low contention.
Synchronization & validation
Tsync
1–8
5
Timestamp-pair checking, alignment, duplicate and out-of-order rejection.
VLM inference & JSON validation
TVLM
350–1200
750
Qwen2.5-VL via Ollama; range depends on GPU availability, image resolution, and prompt complexity.
Semantic-to-geometric conversion
Tgeo
5–35
20
Homography projection, Minkowski inflation, corridor and goal-region construction.
LLM symbolic reasoning
TLLM
120–600
300
Qwen3 via Ollama processing compact JSON scene context and robot states.
Reachability propagation ( ×2 )
Treach
20–160
100
Short-horizon zonotope propagation and three-predicate evaluation per robot; 50ms×2 .
TABLE VIII : Representative per-cycle design-time latency budget.
ID
Condition
Pipeline Modification
Isolated Contribution
B1
No reachability gate
Reachability module disabled; LLM proposals published without geometric verification.
Role of the reachability gate in preventing unsafe command execution.
B2
No VLM perception
VLM removed; geometric conversion receives no semantic scene evidence.
Role of online semantic perception in constructing obstacle sets, safe corridors, and goal regions.
B3
VLM + LLM without reachability
Both language models retained; reachability gate removed.
Whether language-model outputs alone suffice for safe command publication.
B4
No shared perception for SVEA
SVEA does not receive Go2-derived scene evidence and relies only on its own state feedback.
Role of shared perception for the camera-less robot’s safety constraint construction.
A1
Obstacle inflation sweep
rsafe varied; remaining pipeline unchanged.
Sensitivity of command approval rate to obstacle buffering.
A2
Perception uncertainty sweep
rperc varied with VLM confidence.
Sensitivity to semantic uncertainty in the safety-margin model.
TABLE IX : Baseline and ablation evaluation conditions.
Safe robot navigation develops methods for reaching goals while avoiding collisions and managing uncertainty, dynamic obstacles, and environmental hazards.
Department of Mechanical Science and Engineering, University of Illinois Urbana-Champaign, Urbana, IL, USA · Department of Mechanical Engineering, University of Nevada, Reno, NV, USA
Department of Electrical Engineering and Computer Science, University of California, Irvine · Department of Mechanical and Aerospace Engineering at the University of Florida · Torch Technologies, LLC in Shalimar, FL +1