[pr2] Add messages for torso control