Depth enhanced visual-inertial odometry based on Multi-State Constraint Kalman Filter
visual - inertial sensor fusion : localization , mapping and sensor - to - sensor self - calibration .