Removed legacy code in MultipleShootingInternal
Brought Collocation class to a working stage, #303
Added OCP_COST to OCPSolver signature
More conservative bounds on collocation points in Collocation, #303