Solver interface for finite horizon optimal control problems

Requirements:

returns an optimal controller. These can be different controller types, feedforward only, feedforward-feedback, feedback only, therefore it is templated on the controller type