Implementation of icubWholeBodyModelInterface using iDynTree