added covariance matrix to odometry