Combining Method of Alternating Projections and Augmented Lagrangian for Task Constrained Trajectory Optimization.