Use Vector3 instead of Pose2D for reporting roll pitch yaw.