Robust multimodal dense SLAM