Fixed msckf augmentation;