Vector3WithCovariance position Quaternion quaternion Vector3 rpy_covariance