Provably Feasible and Stable White-Box Trajectory Optimization