iDynTree/OptimalControl.h file