smarter planner - robot closest to waypoint
3 working planners, set by param in global planner launch