Towards Robust Visual-Inertial Slam