Added path_planning_new  node