Now publishes statistics over ros topic /TopologicalNavigation/Statistics and bug fixes
changing topic name
Merge pull request #26 from Jailander/hydro-devel

Now publishes statistics over ros topic and bug fixes