Successive Convexification for Trajectory Optimization with Continuous-time Satisfaction of Signal Temporal Logic Specifications

Abstract

This paper presents a successive convexification framework for trajectory optimization under continuous-time Signal Temporal Logic (CT-STL) specifications. The framework employs generalized mean-based robustness (GMSR), a smooth and exact parameterization of discrete-time STL, as a logical building block for constructing differentiable CT-STL constraints in optimal control. It is integrated with time-dilation for free-final-time problems, finite-dimensional control parameterization, multiple-shooting discretization of the dynamics, and a convergence-guaranteed sequential convex programming method, prox-convex, to solve the nonconvex program. The main CT-STL realization embeds temporal aggregation into augmented continuous-time dynamics. This augmentation-based construction is largely transcription-independent, can be incorporated into existing optimal-control pipelines with minimal structural changes, and enables smooth CT-STL parameterizations with accuracy controlled by a user-selected regularization parameter. We also discuss a complementary dense-time realization that evaluates CT-STL formulas directly on the integration subnodes used for dynamics discretization, yielding a smooth and exact parameterization on the numerical trajectory representation, up to the accuracy of the integration scheme. The proposed GMSR-based formulations mitigate the locality and gradient-masking behavior of standard quantitative semantics and therefore provide a favorable landscape for gradient-based trajectory optimization. The framework is demonstrated through trajectory-optimization examples for a double-integrator system with continuous-time \always{}, \eventually{}, and \until{} specifications, and a 6-DoF quadrotor flight problem with combined \always{}, \implication{}, and \eventually{}-type specifications. The implementation is available at https://github.com/UW-ACL/TrajOpt_CT-STL.