Dijkstra算法

#define MAXVEX 9
#define INFINITY 65535
typedef int Pathmatirx[MAXVEX];              //用于存储最短路径下标的数组
typedef int ShortPathTable[MAXVEX];          //用于存储到各点最短路径的权值和
											 //Dijkstra算法，求有向网G的v0顶点到其余顶点v最短路径P[v]及带权长度D[v]
											 //P[v]的值为前驱顶点下标，D[v]表示 v0 到 v 的最短路径长度和
void ShortestPath_Dijkstra(MGraph G, int v0, Pathmatirx *P, ShortPathTable *D)
{
	int v, w, k, min;
	int final[MAXVEX];      //final[w] = 1 表示求得顶点 v0 至 vw 的最短路径
	for (v = 0; v < G.numVertexes; v++)       //初始化数据
	{
		final[v] = 0;                   //全部顶点初始化为未知最短路径状态
		(*D)[v] = G.matirx[v0][v];      //将与 v0 点有连线的顶点加上权值
		(*P)[v] = 0;                    //初始化路径数组 P 为 0
	}
	(*D)[v0] = 0;                  //v0 至 v0 路径为 0
	final[v0] = 1;                 //v0 至 v0 不需要求路径
	
	//开始主循环，每次求得v0到某个v顶点的最短路径
	for (v = 1; v < G.numVertexes; v++)
	{
		min = INFINITY;              //当前所知离v0顶点的最近距离
		for (w = 0; w < G.numVertexes; w++)       //寻找离v0最近的顶点
		{
			if (!final[w] && (*D)[w] < min)
			{
				k = w;
				min = (*D)[w];           //w顶点离v0顶点更近
			}
		}

		final[k] = 1;                 //将目前找到的最近的顶点置为 1
		for (w = 0; w < G.numVertexes; w++)      //修正当前最短路径及距离
		{
			//如果经过 v 顶点的路径比现在这条路径的长度短的话
			if (!final[w] && (min + G.matirx[k][w] < (*D)[w]))
			{
				//说明找到了更短的路径，修改 D[w] 和 P[w]
				(*D)[w] = min + G.matirx[k][w];       //修改当前路径长度
				(*P)[w] = k;
			}
		}
	}

}