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