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

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