Dijstra求任意两点间最短路径并输出

Description

用迪杰斯特拉算法求一点到其余所有结点的最短路径。

Input

先输入一个小于100的正整数n，然后输入图的邻接矩阵（10000表示无穷大，即两点之间没有边），最后输入两个0到n-1的整数表示两个点。

Output

先用迪杰斯特拉算法求给定的第一个点到其余所有结点的最短路径。
然后再输出给定的两个点之间的最短路径（按顺序输出最短路径上的每一个点，每个数据占一行）。

• Sample Input 

  4
  0 2 10 10000
  2 0 7 3
  10 7 0 6
  10000 3 6 0
  0 2

• Sample Output

  0
  1
  2

#include

#define max 10000;

int arcs[100][100]; //保存邻接矩阵
int d[100]; //记录源点到各节点的最短路径
int fina[100]; //记录节点是否已经判断过，1代表已经运算过(在集合s中)
int n; //邻接矩阵的边数
int v0, v1; // 表示起始点和终点
int p[100]; //记录路径
 
void dijkstra()
{
	int v, k;
	int min;
	for(v = 0;v < n;v++) //初始化
	{
		fina[v] = 0;
		d[v] = arcs[v0][v];
	}
	d[v0] = 0;
	fina[v0] = 1;
	//主循环
	for(int i = 1;i < n;i++)
	{
		min = max;
		//选出权值最小的点
		for(k = 0;k < n;k++)
		{
			if(fina[k] == 0) //k点在v-s中，尚未进行处理
			{
				if(d[k] < min)
				{
					v = k;
					min = d[k];
				}
			}
		}
		fina[v] = 1; //表示已经处理过，加入集合s
		for(k = 0;k < n;k++)
		{
			if(fina[k] == 0 && (min+arcs[v][k] < d[k]))
			{
				p[k] = v;
				d[k] = min + arcs[v][k];
			}
		}
	}
}

void print(int sec,int n)       //sec为出发节点，n表示图中节点总数  
{  
    int i,j;  
	int m, p2[100] = {0};
	int t = 0, k;
	j = v1;
	while(p[j] != -1)
	{
		p2[t++] = p[j];
		j = p[j];
	}
	printf("%d\n",v0);
	for(k = 0;k < t;k++)
	{
		printf("%d\n",p2[k]);
	}
	printf("%d\n",v1);
}  

int main()
{
	scanf("%d",&n);
	//输入邻接矩阵
	for(int i = 0;i < n;i++)
	{
		for(int j = 0;j < n;j++)
		{
			scanf("%d",&arcs[i][j]);
		}
	}
	scanf("%d%d",&v0,&v1);
	for(int i = 0;i < 100;i++) //路径初始化为-1
	{
		p[i] = -1;
	}
	dijkstra();
	print(v0,n);
	return 0;
}