Pathfinding verbesserung