迪加斯特拉

#define NUM 100
#define maxint 10000
//顶点个数n，源点v，有向图的邻接矩阵为c
//数组dist保存从源点v到每个顶点的最短特殊路径长度
//数组prev保存每个顶点在最短特殊路径上的前一个结点
void dijkstra(int n, int v, int dist[], int prev[], int c[][NUM])
{
	int i, j;
	bool s[NUM];     //集合S
					 //初始化数组
	for (i = 1; i <= n; i++)
	{
		dist[i] = c[v][i];
		s[i] = false;
		if (dist[i]>maxint) prev[i] = 0;
		else prev[i] = v;
	}
	//初始化源结点
	dist[v] = 0;
	s[v] = true;
	//其余顶点
	for (i = 1; i<n; i++)
	{
		//在数组dist中寻找未处理结点的最小值
		int tmp = maxint;
		int u = v;
		for (j = 1; j <= n; j++)
			if (!(s[j]) && (dist[j]<tmp))//dist是之前的最短路，tmp每次都更新成当前最短路，如果此时的dist比tmp短，tmp替换成dist，记录这个点
			{
				u = j;
				tmp = dist[j];
			}
		s[u] = 1;          //结点u加入s中
						   //利用结点u更新数组dist
		for (j = 1; j <= n; j++)
			if (!(s[j]) && c[u][j]<maxint)//存在路又没有走过
			{
				//newdist为从源点到该点的最短特殊路径
				int newdist = dist[u] + c[u][j];
				if (newdist<dist[j])//dist[j]为之前走到j点的最短距离，newdist为现在的，两相比较取短
				{
					//修正最短距离
					dist[j] = newdist;
					//记录j的前一个结点
					prev[j] = u;
				}
			}
	}
}