A nonlinear observer approach for concurrent estimation of pose, IMU bias and camera-to-IMU rotation
visual - inertial sensor fusion : localization , mapping and sensor - to - sensor self - calibration .