Solution of highly constrained optimal control problems using nonlinear programming