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

This reverts commit 64dead92de0b973dbd670cda43e0f47783c1ace8.
Rebase from 'upstream'
Trimmed the branch to only the topological_map_manager sub directory