Feature based graph SLAM with high level representation using rectangles
Robot Task Planning using Semantic Maps