CSymPlan: Certified Symbolic Planning and Control for High-DOF Manipulators
Organizations: Mohamed bin Zayed University of Artificial Intelligence (MBZUAI), Abu Dhabi, United Arab Emirates · Learning Systems and Robotics Lab, Technical University of Munich, Germany · Ludwig Maximilian University of Munich, Munich, Germany · New York University Abu Dhabi, Abu Dhabi, United Arab Emirates
Abstract
Robot manipulators are commonly engineered around a decoupled motion-generation stack: a planner computes a collision-free path and a lower-level controller tracks the resulting reference. This separation is computationally convenient, but it can produce references that are difficult to execute under actuator limits, tracking error, model mismatch, and small obstacle clearances. We present CSymPlan, a certified symbolic planning and control framework for high-DOF manipulators with two complementary implementations: an offline implementation that precomputes certified reach-avoid feedback policies for known workspaces; and an online implementation that synthesizes or updates symbolic policies at runtime from changing task and perception information using parallelization. The offline implementation reduces the manipulator dynamics to a sampled perturbed double-integrator model in operational space through feedback linearization, treats torque-realization errors, modeling inaccuracies, and measurement uncertainty as bounded disturbances, and refines the synthesized symbolic policy to the Franka FR3 through a quantization--lookup--torque realization pipeline. The online implementation uses the same abstraction and refinement interface, but replaces the precomputed policy table with a runtime pFaces request--synthesis--execution loop. In randomized simulated benchmarks and perception-driven Franka FR3 experiments, both implementations complete reach-avoid tasks with zero safety violations; whenever no certified action exists, the robot holds, replans, or stops safely instead of executing an uncertified command.
Figures & tables
| Method | Success (%) | Violation (%) | (s) | (m) | Smoothness | Effort | CPU/step (ms) |
| CSymPlan | 100 | 0.0 | 2.3 | 1.25 | 0.90 | 1.05 | 0.05 / 0.08 |
| RRT + tracker | 76 | 10.0 | 3.9 | 1.42 | 1.25 | 1.18 | 120 / 240 |
| LQR-RRT ⋆ + tracker | 83 | 6.0 | 3.6 | 1.33 | 0.62 | 1.02 | 170 / 340 |
| MPPI | 95 | 4.5 | 2.5 | 1.17 | 0.52 | 0.98 | 18.1 / 19.0 |
| Neural MPC | 93 | 3.5 | 2.6 | 1.14 | 0.38 | 0.92 | 3.6 / 4.4 |
| Metric | Definition | Interpretation |
| Success | Trials that reach and hold the final target without leaving the safe set. | |
| Violation | Trials with collision, inflated-obstacle entry, workspace exit, or limit violation. | |
| Safe stop / timeout | Trials that terminate without collision because no certified action is available, a command becomes stale, or the task times out. | |
| Safe resolution | Trials that either succeed or terminate conservatively without a safety violation. | |
| Time to goal | Elapsed time from motion start to final target hold. | |
| Path length | Length of the executed end-effector trajectory. |
| Task family | Trials | Success (%) | Safe stop / timeout (%) | Violation (%) | Safe resolution (%) | (s) | (m) | (cm) | pFaces mean / 95p (ms) |
| Shelf reach-avoid | 50 | 98 | 2 | 0.0 | 100 | 84 / 190 | |||
| 3D maze | 50 | 94 | 6 | 0.0 | 100 | 210 / 510 | |||
| Moving obstacle | 50 | 90 | 10 | 0.0 | 100 | 170 / 430 | |||
| All online simulation | 150 | 94 | 6 | 0.0 | 100 | 155 / 430 |
| Task family | Replans / trial | Buffer underruns / trial | Stale rejects / trial | Dominant safe-stop cause |
| Shelf reach-avoid | 0.1 | 0.2 | Timeout near shelf lip or conservative grid boundary. | |
| 3D maze | 0.8 | 1.1 | No winning action in a narrow passage for the requested horizon. | |
| Moving obstacle | 1.2 | 1.6 | Obstacle update invalidates the currently buffered segment. | |
| All online simulation | 0.7 | 1.0 | Certified hold, re-request, or timeout without collision. |
| Task | Trials | Success | Safe stop | Violation | Safe resolution | (s) | (cm) | Stop cause |
| High-speed reach | 10 | 10 / 10 | 0 / 10 | 0 / 10 | 10 / 10 | – | none | |
| Dynamic-obstacle reach-avoid | 10 | 9 / 10 | 1 / 10 | 0 / 10 | 10 / 10 | no certified action | ||
| Dynamic maze | 10 | 8 / 10 | 2 / 10 | 0 / 10 | 10 / 10 | stale / no solution | ||
| All hardware | 30 | 27 / 30 | 3 / 30 | 0 / 30 | 30 / 30 | certified stops |
| Task | Tracking error mean / max (cm) | pFaces mean / 95p (ms) | DNVblox age mean / 95p (ms) | Replans / trial | Underruns / trial | Stale rejects / trial |
| High-speed reach | 1.1 / 3.2 | 65 / 150 | – | 0.0 | 0.0 | |
| Dynamic-obstacle reach-avoid | 1.6 / 4.8 | 135 / 330 | 70 / 125 | 0.4 | 0.8 | |
| Dynamic maze | 2.1 / 6.0 | 260 / 680 | 85 / 150 | 1.7 | 2.1 | |
| All hardware | 1.6 / 6.0 | 153 / 410 | 78 / 139 | 0.7 | 1.0 |
| Method | Success (%) | Violation (%) | Safe stop / timeout (%) | Safe resolution (%) | Solve mean / 95p (ms) | Comment |
| CSymPlan online | 94 | 0.0 | 6.0 | 100.0 | 155 / 430 | Certified actions; no-solution cases become safe stops. |
| NMPC | 91 | 3.3 | 5.7 | 96.7 | 38 / 74 | Fast deterministic optimization, but no symbolic winning-set certificate. |
| MPPI | 88 | 5.3 | 6.7 | 94.7 | 22 / 31 | Aggressive sampling-based behavior with lower clearance near obstacles. |
| RRT-Connect + tracker | 74 | 9.3 | 16.7 | 90.7 | 210 / 460 | Plan–then–track mismatch in dynamic scenes. |
| CBF-QP | 83 | 1.3 | 15.7 | 98.7 | 3.1 / 6.5 | Very fast local safety filter, but can get stuck in maze-like tasks. |
| Neural MPC | 86 | 6.0 | 8.0 | 94.0 | 1.4 / 2.2 | Fastest runtime, but weaker safety under distribution shift. |
Robotic Control
Robotic control studies how machines use sensing and computation to produce reliable movement and interaction in changing environments.
See all 584 papers