Fix in closing of icubWholeBodyModel