Merge pull request #66 from Jailander/hydro-devel

Now action server returns cancelled when the target node is not found on...
Adding Topological_map_manager