added velocity covariance to motion model