smarter planner - robot closest to waypoint
3 working planners, set by param in global planner launch
Merge branch 'master' of github.com:SquadCollaborativeRobotics/global_planner into shawn
statistics, rework of info structure, pre march 20 demo
Merge branch 'master' of github.com:SquadCollaborativeRobotics/global_planner into shawn