You can find the algorithm online in C or C ++ and manipulate it to enter your list type, and display the shortest list of waypoints, so you do not need to implement the actual algorithm, just manipulate the set of code that already exists.
trumpetlicks
source share