Constrained Optimization and Optimal Control for