Pathfinding fixed