​​Мы уже рассмотрели алгоритм Дейкстры, но оина не является самым оптимальным алгоритмом.
И так...
Реализация алгоритма A*
Поиск по графам — это семейство схожих алгоритмов. Существует множество вариаций алгоритов и их реализаций. Относитесь к коду этой статьи как к отправной точке, а не окончательной версии алгоритма, подходящей ко всем ситуациям.
Статья с разбором.

Oбсудить пост можно в нашем чате.