Pathfinding Bug Fixes