Vision-language-action (VLA) models can generate task-oriented robot actions, but they do not guarantee safe execution in obstacle-rich manipulation scenes. Although CBF-QP safety filters can locally project unsafe actions into a safe set, such correction may push the robot away from the learned task trajectory and leave the VLA policy without a reliable recovery direction. We propose Route-Guided CBF-QP Repair, a post-hoc repair module that uses the short-horizon action chunk predicted by the VLA to detect blocked nominal trajectories and generate entry-exit-rejoin guidance around obstacles. The selected route is added to the CBF-QP objective as a soft guidance term, while the CBF safety constraint remains hard. On SafeLIBERO, our method improves collision avoidance, task success, and SafeSuccess compared with AEGIS. Our project page is available at GitHub.
Figures & tables
Fig. 1: Overview of Route-Guided CBF-QP Repair. The method uses the VLA action chunk to estimate a nominal future trajectory and detect obstacle-induced blockage. When the nominal trajectory is blocked, it generates an entry-exit-rejoin route around the obstacle and adds the selected route to the CBF-QP objective as soft guidance. The CBF constraint remains hard, so the repaired action preserves safety while following a recoverable route toward task completion.
Fig. 2: Qualitative comparison on SafeLIBERO. Task : pick up the chocolate pudding and place it in the basket. Top row : AEGIS (Success, Collision). Bottom row : Ours (Success, Collision-free).
Method
Metric
SafeLIBERO Suite
Average
Spatial
Goal
Object
Long
AEGIS
CAR ↑ (%)
63.75
83.75
56.25
55.00
64.69
TSR ↑ (%)
60.00
85.00
67.50
38.75
62.81
SafeSuccess ↑ (%)
52.50
73.75
41.25
21.25
47.19
ETS ↓
85.61
104.33
67.68
181.85
109.87
Route-Guided CBF-QP (Ours)
CAR ↑ (%)
66.25
81.25
76.25
52.50
69.06
TABLE I: Quantitative results on the SafeLIBERO benchmark.
Components
Average Performance
Path
Gate
Score
Rejoin
CAR (%)
TSR (%)
SafeSucc. (%)
ETS
×
×
×
×
64.69
62.81
47.19
109.87
✓
✓
✓
×
67.12
63.95
47.92
112.50
✓
✓
×
✓
65.88
63.10
48.15
114.12
✓
✓
✓
✓
69.06
65.00
49.69
118.45
TABLE II: Ablation study of route-guided CBF-QP components.
Nanjing University, Nanjing, China · The Hong Kong University of Science and Technology (Guangzhou), Guangdong, China · Beijing University of Technology, Beijing, China