Алгоритм Дейкстры находит кратчайший путь в графе.

ДРАКОН-схема алгоритма Дейкстры на гибридном языке ДРАКОН-Python:

Скачать исходник в формате DRAKON Editor: http://sourceforge.net/projects/drakon-editor/files/examples/dijkstra.drn/download Из этого файла можно сгенерировать работающий скрипт на Python.