updated the code to account for replanning that occurs
if we try to park in the position where there is no place for us