fix local yarpWholeBodyStates