Online Robust 3D Mapping Using Structure from Motion Cues