Efficient And Accurate Visual-Inertial Localization And Mapping