Попробуем вечерком привязать этот алгоритм к схеме. Полагаю, что он будет работать в качестве базового, а старый способ будет включаться только тогда, когда фактического пути найти не удалось.