Adding Execute Policy server to topological_navigation.launch