Fixed bug introduced in icubWholeBodyStatesLocal