Account for modifications in iDynTree