Estimator initialization in vision-aided inertial navigation with unknown camera-IMU calibration
A Multi-State Constraint Kalman Filter for Vision-aided Inertial Navigation