Fixed bug introduced in previous commint in icubWholeBodyStatesLocal