NUMERICAL METHODS FOR OPTIMAL CONTROL PROBLEMS WITH STATE CONTRAINTS - PYTLAK, Radoslaw (McGraw-Hill Interamericana, S.A., 1999)