Towards consistent visual-inertial navigation
Good features to track