Visual-inertial navigation, mapping and localization: A scalable real-time causal approach