Probabilistic data association for semantic SLAM
SLAM++: Simultaneous Localisation and Mapping at the Level of Objects