[path_planning] when replanning put initial point 1m behind vehicle