Computing Invariant Reachable Sets through Sum-of-Squares Programming
Organizations: *The author is with the Department of Aerospace Engineering, University of Maryland, College Park, USA.
Abstract
Funnels, time-varying invariant sets around nominal trajectories, certify that a closed-loop system tracks its plan, and can be composed into verified motion plans. Their computation by sum-of-squares (SOS) programming is well established in formulation but not in practice: the result depends on implementation choices such as the initial guess, Lyapunov function normalization, and termination rule, which the literature documents only briefly. This paper presents a self-contained treatment of SOS-based funnel computation, implemented in the open-source package computeSOSFunnels. We propose a minimum-volume formulation with inlet and outlet constraints under which funnels with coinciding nominal endpoints compose by construction. Numerical experiments on a unicycle, with timing studies on a cart-pole and a 12-state quadrotor, characterize the pipeline: infeasible initial guesses are partly decidable before solving, the certificate shows no violations among 39,000 boundary samples per funnel under the true dynamics, and constructing the semidefinite program, not solving it, dominates computation time.
Figures & tables
| Parameter | Value |
|---|---|
| Dynamics | |
| , | , |
| 0.75 m/s, /2 rad/s | |
| , | 0.25 s, 40 |
| , | diag([0.1, 0.1]), 1 |
| , | diag([1, 1, 0.1]), diag([1, 0.5]) |
| 1 | 1.5 | 2 | 3 | |
|---|---|---|---|---|
| 0.02 | C | C | 0.152 2355 | – |
| 0.035 | C | 0.159 2407 | 0.153 2779 | – |
| 0.05 | 0.155 2205 | 0.157 2400 | – | – |
| 0.0625 | C | C | C | C |
| System | Gram size | PSD entries | L-step [s] | V-step [s] | |||
|---|---|---|---|---|---|---|---|
| Unicycle | 3 | 40 | 2 | 10 | 2401 / 2446 | 3.11 (0.029) | 4.73 (0.078) |
| Unicycle | 3 | 40 | 4 | 20 | 8446 / 8491 | 6.43 (0.078) | 9.11 (0.21) |
| Unicycle | 3 | 40 | 6 | 35 | 24826 / 24871 | 13.3 (0.26) | 17.7 (0.61) |
| Cart-pole | 4 | 25 | 2 | 15 | 3152 / 3186 | 2.87 (0.039) | 4.19 (0.11) |
| Cart-pole | 4 | 25 | 4 | 35 | 15392 / 15426 | 8.72 (0.26) | 12.1 (0.6) |
| Cart-pole | 4 | 25 | 6 | 70 | 59912 / 59946 | 29.5 (0.96) | 36.3 (2.3) |
Semidefinite Programming
Semidefinite programming optimizes linear objectives over positive semidefinite matrices to solve convex problems and build tractable relaxations and certificates.
See all 24 papers