[Cvazimodo]

Вот это совпадение
Вот, моя недавняя реализация этого алгоритма, но на большой карте тормозит
http://vl.nn.ru/graf/test_graf.html

Сейчас тружусь на поиском более быстрых алгоритмов.