First version of iDynTree that compiles