icubWholeBodyModel now includes a block for the mass matrix