Added code for an example controller identification using direct collocation.