After planner found a path, let the goal point be changeable. The goal point needs to choose a new best parent within a goal radius.