Removed dependecy on the semantic_map package