Решение задачи коммивояжра, поиск кратчайшего пути

Нужно написать алгоритм и написать скрипт поиска оптимального кратчайшего пути  для OSM карт. входные данные 1)Координаты точек 2)Желаемое время прибытия (интервал времени) 3)Приоритет для каждой точки (от 1 до 5,   5 это высший приоритет). 4)по возможности собирать уже ранее просчитанные маршруты (их участки),  для ускоренеия пересчетов новых маршрутов.
Данные для расчета карта OSM в любом формате. По данному вопросу в интернет уже много есть готового в интернете, в том числе и с ИИ. Надо написать алгоритм а затем написать скрипт.