Fast planar surface 3D SLAM using LIDAR
Feature based graph SLAM with high level representation using rectangles