First version of icubWholeBodyStatesLocal compiling