Observability-constrained Vision-aided Inertial Navigation
scalable recognition with a vocabulary tree .