Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age
A Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation