Алгоритм Дейкстры. Быстрый.

Нажмите на ссылку https://e-maxx.ru/algo/dijkstra_sparse, чтобы открыть ресурс.