C++实现Dijkstra算法

原文链接：https://blog.csdn.net/chengonghao/article/details/52347050

//graph为n*n的矩阵，graph[i][j]表示从i到j的成本,不可达的点由INT_MAX填充
int Dijkstra(vector<vector<int>>& graph, int src, int dst) {
	int n=graph.size();
	vector<bool> visited(n,false);//true表示顶点被选中，false表示顶点未被选中
	int v0=src;
	visited[v0]=true;//选中初始顶点
	vector<int> cost(n,INT_MAX);//记录src到每个顶点的成本
	int last_visited=0;//保留src到最新选中顶点的成本
	for(int i=0;i<n;i++){//n个顶点需要n-1次循环
	    for(int j=0;j<n;j++){//循环遍历所有顶点
	        if(!visited[j]){//找未被选中的点
	            if(graph[v0][j]!=INT_MAX){//当前v0到点j有路径可走
	                cost[j]=min(cost[j],graph[v0][j]+last_visited);//计算v0到j成本+src到v0成本，若比之前的小则更新
	            }
	       	}
	    }
	    //找出最小值
	    int min_index=0;
	    int min_cost=INT_MAX;
	    for(int i=0;i<n;i++){
	        if(!visited[i]){
	            if(cost[i]<min_cost){
	                min_index=i;//最小值索引
	                min_cost=cost[i];//最小值
	            }
	        }
	    }
	    last_visited=min_cost;//更新最小值
	    visited[min_index]=true;//将最小值点选中
	    v0=min_index;//下次查找从最小值点开始
	}
	return cost[dst]==INT_MAX?-1:cost[dst];
}