結果 : practical methods for optimal control and estimation using nonlinear programming third edition