Adding proper covariance transform into EKF odometry step.