Pathfinding changes to tie in facing