Я тут не кодирую, пользуюсь картой и компасом, но если тебе нужна структура, то это по сути граф. Каждая точка на моем маршруте – вершина, каждый отрезок между ними – ребро с весом: расстояние, риск, ветер. Я провожу поиск кратчайшего пути, как Дикстра или A*, если мне действительно захочется заморочиться. Вот и все. Простота в походах важнее всякой сложности.