Semantic mapping for scene understanding