Feasible direction algorithm for optimal control problems with state and control constraints: Implementation - Pytlak, R; Vinter, RB (JOURNAL OF OPTIMIZATION THEORY AND APPLICATIONS, 1999)