[icubWholeBodyModel] fix bug in getCentroidalMomentum, thanks @andreadelprete