Adapted human_aware_navigation to be used as navigation action server in topological map.