some debugging info in global_planner
Merge branch 'hydro-devel' of github.com:ct2034/navigation into hydro-devel