Second order method

Control functions are substituted by piecewise constant controls. The control problem becomes then a semi-infinite programming problem.