using greedy_planner2