Numerical methods of nonlinear optimal control based on mathematical programming - Ito, Satoshi.