modified the path_planning_srv feature