Fixed bug when stopping after obstructing door