Constrained Differential Dynamic Programming: A primal-dual augmented Lagrangian approach