Significantly improved pathfinding