made the planner warn only if the original goal is in collision