Numerical Methods for Optimal Control Problems