Remove debug info
Global Planner Debugged
Add cycles completion to A*
Neater potential publishing
Remove strong dependency on costmap2dros