first version of yarpWholeBodyInterface working