路径规划算法系列：(Dijkstra)

---

---

前言

​本系列文章主要记录学习路径规划算法过程中的一些知识点；
​主要学习视频源自B站大学 小黎的Ally 的 《路径规划与轨迹跟踪系列算法》，视频链接如下：视频链接
文章参考：链接一、链接二

---

一、迪杰斯特拉(Dijkstra)

算法介绍

• 迪杰斯特拉(Dijkstra)算法是典型最短路径算法，用于计算一个节点到其他节点的最短路径。

主要特点：

• 是以起始点为中心向外层层扩展(广度优先搜索思想)，直到扩展到终点为止。
• Dijkstra算法使用了广度优先搜索解决赋权有向图或者无向图的单源最短路径问题。

基本思想

通过Dijkstra计算图中的最短路径时，需要指定起点s(即从源点s开始计算)。
此外，引进两个集合S和U。S的作用是记录已求出最短路径的顶点(以及相应的最短路径长度)，而U则是记录还未求出最短路径的顶点(以及该顶点到起点s的距离)。
初始时，S中只有起点s；
U中是除s之外的顶点，并且U中顶点的路径是"起点s到该顶点的路径"。
然后，从U中找出路径最短的顶点，并将其加入到S中；
接着，更新U中的顶点和顶点对应的路径。
然后，再从U中找出路径最短的顶点，并将其加入到S中；
接着，更新U中的顶点和顶点对应的路径。
…
重复该操作，直到遍历完所有顶点。

操作步骤

(1) 初始时，S只包含起点s；U包含除s外的其他顶点，且U中顶点的距离为"起点s到该顶点的距离"
[例如，U中顶点v的距离为(s,v)的长度，然后s和v不相邻，则v的距离为∞]。
(2) 从U中选出"距离最短的顶点k"，并将顶点k加入到S中；同时，从U中移除顶点k。
(3) 更新U中各个顶点到起点s的距离。之所以更新U中顶点的距离，是由于上一步中确定了k是求出最短路径的顶点，从而可以利用k来更新其它顶点的距离；例如，(s,v)的距离可能大于(s,k)+(k,v)的距离。
(4) 重复步骤(2)和(3)，直到遍历完所有顶点。
单纯的看上面的理论可能比较难以理解，下面通过实例来对该算法进行说明。

二、图解

初始状态：S是已计算出最短路径的顶点集合，U是未计算除最短路径的顶点的集合！

第1步：选取源点

选取源点D加入S集中。
此时，S={D(0)}, U={A(∞),B(∞),C(3),E(4),F(∞),G(∞)}。 注:C(3)表示C到起点D的距离是3；∞表示未知距离。

第2步：找出最短距离点，加入S集，并更新U集

从U集中选出距离最短的节点C
将节点C加入到S集中，同时从U集中删除C。
上一步操作之后，U中节点C到源点D的距离最短；因此，将C加入到S中，同时更新U中节点的距离。以节点F为例，之前F到D的距离为∞；但是将C加入到S之后，F到D的距离为9=(F,C)+(C,D)。
此时，S={D(0),C(3)}, U={A(∞),B(23),E(4),F(9),G(∞)}。

第3步：选取U集最小距离点，加入S集，更新U集

将节点E加入到S中。
上一步操作之后，U中节点E到源点D的距离最短；因此，将E加入到S中，同时更新U中节点的距离。还是以节点F为例，之前F到D的距离为9；但是将E加入到S之后，F到D的距离为6=(F,E)+(E,D)。因此更新F点距离；
此时，S={D(0),C(3),E(4)}, U={A(∞),B(13),F(6),G(12)}。

第4步：选取U集最小距离点，加入S集，更新U集

将节点F加入到S中。
此时，S={D(0),C(3),E(4),F(6)}, U={A(22),B(13),G(12)}。

第5步：选取U集最小距离点，加入S集，更新U集

将节点G加入到S中。
此时，S={D(0),C(3),E(4),F(6),G(12)}, U={A(22),B(13)}。

第6步：选取U集最小距离点，加入S集，更新U集

将节点B加入到S中。
此时，S={D(0),C(3),E(4),F(6),G(12),B(13)}, U={A(22)}。

第7步：选取U集最小距离点，加入S集，更新U集

将节点A加入到S中。
此时，S={D(0),C(3),E(4),F(6),G(12),B(13),A(22)}。U={空集}
此时，源点D到各个节点的最短距离就计算出来了：A(22) B(13) C(3) D(0) E(4) F(6) G(12)。即D→A的最优路径为D→E→F→A最短距离为22

三、编程实现

代码如下：

#include<iostream>
#include<string>
using namespace std;

const int MAX = 10; //限定最大的顶点数
const int _INFINITY = 65535; //定义无穷大
class Graph
{
   
   
private:
	int vertex_num; //顶点数
	int edge_num; //边数
	int weight; //权值
	string vertex[MAX]; //顶点数组
	int edge[MAX][MAX]; //邻接矩阵
	int locate(string ch); //定位
	int *final; //标识是否已纳入最短路径，置为1表示纳入
	int *distance; //存放最短路径的权值和
	string *path;  //存放最短路径字符串

public:
	Graph(int v_n, int e_n