Probabilistic 3D Multilabel Real-time Mapping for Multi-object Manipulation (IROS2017) - View it on GitHub