RGB-D Inertial Odometry for Indoor Robot via Keyframe-based Nonlinear Optimization
A Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation