Added proper covariance update for prediction step without odometry.