Merge request for changes to robot driver, teleop code and interface panels

Duplicate of get_tcb_pose