Signal Temporal Logic Motion Planning via Graphs of Convex Sets
About
This paper investigates continuous-time motion planning under Signal Temporal Logic (STL) specifications. The goal is to generate smooth robot trajectories that satisfy high-level logical and timing requirements while respecting low-level motion constraints. To this end, we propose an efficient framework that combines timed-automata reasoning with graphs of convex sets (GCS). An STL specification is first represented by a timed automaton, which is then coupled with a convex decomposition of the configuration space to form a joint transition system encoding both task progress and region occupancy. Based on this joint transition system, the STL motion-planning problem is reformulated as a shortest-path problem over a GCS, whose solution induces a smooth B\'ezier-spline trajectory satisfying the STL specification, smoothness requirements, and velocity bounds. We establish the soundness of the proposed formulation and analyze its computational complexity, showing that, once the timed automaton and convex decomposition are fixed, the convex relaxation scales polynomially with the configuration-space dimension and the B\'ezier degree. We further develop a compact timed-automaton construction for an expressive STL fragment using dedicated templates and Boolean composition. Numerical experiments on low-dimensional benchmarks, a $3$-D quadrotor, a $30$-DoF humanoid, and a hardware experiment on a UR-3 robot arm demonstrate that the proposed method efficiently solves complex STL motion-planning problems and produces smooth executable trajectories.
Related benchmarks
| Task | Dataset | Result | Rank | |
|---|---|---|---|---|
| Trajectory Optimization | Quadrotor | -- | 10 | |
| Trajectory Optimization | puzzle-1 | Overall Solve Time (s)4.5 | 3 | |
| Trajectory Optimization | Rover | Overall Solve Time (s)3.86 | 3 | |
| Trajectory Optimization | stlcg | Total Solve Time (s)0.39 | 3 | |
| Trajectory Optimization | puzzle-2 | Solve time (s)33.1 | 2 | |
| Trajectory Optimization | DeLiVER | Overall Solve Time (s)2.76 | 2 | |
| Trajectory Optimization | either-or | Solve Time (s)1.86 | 2 | |
| Trajectory Optimization | Humanoid | STL-to-TA Time (s)0.001 | 1 | |
| Trajectory Optimization | manipulator | STL-to-TA Time (s)0.002 | 1 |