Reduced the variance on the first state since the biases were getting messed up and we're using ground truth anyway. With ground-truth landmark positions and no max window size (i.e. features get added only when they go out of view), the filter now does better than dead-reckoning.