Revert "Trimmed the branch to only the semantic_map sub directory"

This reverts commit aed56fb716e78586ceeb360739f63e8b2e0746f7.
Rebase from 'upstream'
Trimmed the branch to only the semantic_map sub directory