Trajectory optimization using regularized variables.