Разработка алгоритмов маршрутизации, Разработка алгоритма маршрутизации Дейкстры