Improve pathfinding quality