Recent road trials have shown that guaranteeing the safety of driving decisions is essential for wider adoption autonomous vehicle technology. One promising direction to pose requirements as planning constraints in nonlinear, nonconvex optimization problems motion synthesis. However, many implementations this approach are limited by uncertain convergence and local optimality solutions achieved,...