dijkstra算法

1.C++实现，可指定源点，可获得到各点最短路径以及路径。
2.用vector实现，节点数可自行调节，可实现有向图无向图，容错率高。
3.注意：

• 节点下标从1到n。
• 输入时为矩阵输入，存储时为邻接矩阵，n为节点数，s为源点

#include<iostream>
#include<algorithm>
#include<vector>
using namespace std;
const int maxn=500;
const long long INF=1<<30;
struct Node{
	int id;
	int wgt;
};
vector< vector<Node> > G(maxn);//图 
int n;//节点数 
int visit[maxn]={false};//访问标记 
long long d[maxn];//最短距离存储
vector< vector<int> >path(maxn);//路径存储 
void dijkstra(int s)
{
	for(int i=1;i<=n;++i)//做初始化工作。 
	{
		path[i].push_back(s);
	}
	fill(d,d+maxn,INF);//做初始化工作。 
	d[s]=0;

	for(int i=0;i<n;++i)//接下来最多n轮查找 
	{
		int u=-1;//存储每一轮找到的id 
		long long MIN=INF;
		for(int j=1;j<=n;j++)
			if(!visit[j]&&d[j]<MIN) 
			{
				MIN=d[j];
				u=j; 
			} 
		if(-1==u)//当全部遍历完，或者s到其余的点没有路径时(即路径长度INF),返回. 
			return ;
		visit[u]=true;
		
		if(u!=s)
			path[u].push_back(u);//找到了到u的最短路径，加入最后一个节点u进入路径
		for(int j=0;j<G[u].size();++j)//开始对u的相邻点松弛。
		{
			Node adj=G[u][j];
			if(visit[adj.id])//已经遍历过，不管 
				continue;
			if(d[u]+adj.wgt<d[adj.id])//对u的相邻点以u为跳板进行松弛 
				{	
					d[adj.id]=d[u]+adj.wgt;//找到当前更近的路径，更新距离与路径 
					path[adj.id]=path[u];//更新路径时暂时不存储最后一个点，等找到最短路径时在加入。 
				}		
		 } 
		
	}
}


int main()
{
	int s,w;
	Node N;
	cin>>n>>s;
	for(int i=1;i<=n;++i)
		for(int j=1;j<=n;++j)
		{
			cin>>w;
			N.id=j;
			N.wgt=w;
			if(w)
				G[i].push_back(N);
		 }
	dijkstra(s+1);
	for(int i=1;i<=n;++i)
		if(d[i]<INF&&d[i])
			{cout<<d[i]<<'\n';
			for(int j=0;j<path[i].size();++j)
				cout<<path[i][j]<<" ";
				cout<<'\n'; 
			} 
		else if(d[i])
			cout<<-1<<'\n';
	
	return 0;
 }