[Pathfinding] Fixed bottleneck in obstructed goals.