最短路径 Dijkstra算法

typedef struct MGraph{
    int vexnum,arcnum;
    int AdjMatrix[vertex_num][vertex_num];
    int vertex[vertex_num];
}MGraph;//图的存储结构使用邻接矩阵表示
vector<vector<int>> ShortestPath_DIJ(MGraph G)
{
	int flag[vertex_num];//记录当前节点是不是已经加入最短路径
	vector<vector<int>>p;
	int D[vertex_num];//记录当前最短路径集合到其余各点的最短路径
	for (int v=0;v<G.vexnum;v++)
	{//初始化
		flag[v]=false;
		D[v]=G.AdjMatrix[0][v];
		vector<int> temp_vec;
		p.push_back(temp_vec);
		if (D[v]<MaxInt)
		{
			p[v].push_back(0);
			p[v].push_back(v);
		}
	}
	D[0]=0;
	flag[0]=true;
	int select_v;
	for (int i=0;i<G.vexnum;i++)
	{
		int min_len=MaxInt;
		for (int w=0;w<G.vexnum;w++)
		{
			if (!flag[w])
			{
				if (D[w]<min_len)
				{//当前D中最小的路径长度，作为下一个候选节点加入到最短路径中
					select_v=w;
					min_len=D[w];
				}
			}
		}
		flag[select_v]=true;
		for (int w=0;w<G.vexnum;w++)
		{
			if (!flag[w]&&(min_len+G.AdjMatrix[select_v][w]<D[w]))
			{
				D[w]=min_len+G.AdjMatrix[select_v][w];
				p[w]=p[select_v];
				p[w].push_back(w);
			}
		}
	}
	return p;
}