When 2.5D is not enough: Simultaneous reconstruction, segmentation and recognition on dense SLAM
SLAM++: Simultaneous Localisation and Mapping at the Level of Objects