Robust And Efficient Robotic Mapping