update_relative_pose() now returns Pose3&