Merge pull request #26 from Jailander/hydro-devel

Now publishes statistics over ros topic and bug fixes
Topological Navigation now works using message store proxy