Add brief sanity check for iDynTree