Updated pose_to_estimate