Имея некоторую карту и некоторый корень, мы хотели бы следовать, какой стандартный алгоритм поможет в создании пути?

У нас есть некоторый набор точек (каждая точка имеет свои X и Y) и множественное отображение корней [точка, точка]. Мы можем двигаться по корням из любой точки в любую в любом возможном направлении. Нам дан некоторый путь из 2-х точек, по которому мы хотим следовать как можно ближе:

как рассчитать такой путь:

, который будет максимально похож на заданный путь? Какие полезные алгоритмы могут делать такие вещи (и они реализованы в Boost Geometry или Graph или любой другой распространенной библиотеке C ++ с открытым исходным кодом)?