智能驾驶，算法，路径规划求解~

Question

求解图中关于智能驾驶方面的3个路径规划问题，这个问题是我学习的一套智能驾驶课程的课后习题，寻找有缘人，非常感谢

Answer 1

最短路径算法，最经典的有Dijkstra算法、Floyd算法等。
如果是使用matlab编程，可以应用shortestpath命令直接求最短路径，这是官方文档：
https://ww2.mathworks.cn/help/matlab/ref/graph.shortestpath.html
下面是参考的思路：
1.首先把你的图的顶点和边权重标注出来，问题就变成了求一个无向图(因为没有规定行进方向)中节点1到节点25的最短路径：

2.使用matlab编程求解，完整代码如下：

start_nodes = [1    1    2    2    3    3    4    4    5    6    6    7    7    8    8    9    9    10    11    11    12    12    13    13    14    14    15    16    16    17    17    18    18    19    19    20    21    22    23    24];
end_nodes = [2    6    3    7    4    8    5    9    10    7    11    8    12    9    13    10    14    15    12    16    13    17    14    18    15    19    20    17    21    18    22    19    23    20    24    25    22    23    24    25];
weights = [1    1    1    1    1    1    1    1    1    1    1    0.5    1    0.5    1    1    1    1    1    0.5    1    1    1    1    1    1    1    1    1    1    1    1    0.5    1    1    1    1    1    1    0.5];
G = graph(start_nodes,end_nodes,weights);
plot(G,'EdgeLabel',G.Edges.Weight)
[P,d] = shortestpath(G,1,25)

3.运行结果如下

表示最短路径为1→2→7→8→9→14→19→24→25，最短距离为6.5

4.码字不易，有用望采纳