added covariance to motion model