dijkstra + A* 第k短路

最新推荐文章于 2022-12-03 00:00:26 发布

daq0411

最新推荐文章于 2022-12-03 00:00:26 发布

阅读量190

点赞数 1

分类专栏： # Graph 图论 ACM模板

本文链接：https://blog.csdn.net/yingtingqi/article/details/113002940

版权

ACM模板同时被 2 个专栏收录

22 篇文章 0 订阅

订阅专栏

Graph 图论

16 篇文章 0 订阅

订阅专栏

这篇博客探讨了图论中的A*算法和Dijkstra算法。作者首先介绍了Dijkstra算法用于找到图中两点之间的最短路径，并用C++实现了一个反向查找的版本。接着，文章转向启发式搜索，详细讲解了A*算法的原理，并提供了A*算法的C++代码实现，用于寻找图中第k条最短路径。博主还承诺会补充更多细节和深入讨论，对于理解这两种算法在路径规划问题中的应用十分有帮助。

摘要由CSDN通过智能技术生成

Graph 图论

第k短路

今天好懒啊，不想补了……但是怕忘了，先把笔记挂上日后补上吧（狗头保命），但是启发式搜索的确挺有意思的一个算法。（一定补一定补）
感觉很好的一篇博客，膜大佬 A*算法
在这里插入图片描述

#include<iostream>
#include<queue>
#include<vector>
#include<cstring>
using namespace std;
int n,m,begin,end,k;
struct edge{
	int b;
	int cost;
};
vector<edge>map[1001];
struct infor{
	int num;
	int f;
	int g;
	int pre;
	friend bool operator < (infor a,infor b){
		if(a.f == b.f){
			if(a.g == b.g) return a.num > b.num;
			else return a.g > b.g;
		}
		else return a.f > b.f;
	}
};
int vis[1001];
int dist[1001];
int mp[1001][1001];
int flag[1001];

void dijkstra(int node){
	for(int i=1;i<=n;i++){
		if(vis[i]==0 && dist[i]>dist[node]+mp[node][i]){
			dist[i] = dist[node] + mp[node][i];
		}
	}
	int mini = -1;
	int Min = 0x7f7f7f7f;
	for(int i=0;i<n;i++){
		if(vis[i]==0 && dist[i]<Min){
			Min = dist[i];
			mini = i;
		}
	}
	if(mini == -1){
		return ;
	}
	else{
		vis[mini] = 1;
		dijkstra(mini);
	}
}
void Astar(){//f = g + dist
	memset(flag,0,sizeof(flag));
	priority_queue<infor>q;
	infor p;
	//起点入队 
	p.num = begin;
	p.pre = -1;
	p.g = 0;
	p.f = dist[begin] + p.g;
	flag[begin] = 1;
	q.push(p);
	int cnt = 0;
	infor node;
	while(cnt<k && !q.empty()){
		node = q.top();//node是队头元素
		q.pop();
		for(int i=0;i<map[node.num].size();i++){
			edge e = map[node.num][i];
			p.num = e.b;
			p.pre = node.num;
			p.g = node.g + e.cost;
			p.f = p.g + dist[p.num];
			q.push(p);
		}
		if(node.num==end){
			cnt++;
		}
		//cout << node.pre << "->" << node.num << ":" << node.f << endl;
	}
	if(cnt==k) cout << node.f << endl;
	else cout << "No" << endl;
}
int main(){
	cin >> n >> m >> k >> begin >> end;
	memset(vis,0,sizeof(vis));
	memset(dist,0x7f7f7f7f,sizeof(dist));
	memset(mp,0x7f7f7f7f,sizeof(mp));
	for(int i=0;i<m;i++){
		int a,b,c;
		cin >> a >> b >> c;
		edge node;
		node.b = b;
		node.cost = c;
		map[a].push_back(node);
		mp[b][a] = c;
	}
	vis[end] = 1;
	dist[end] = 0;
	dijkstra(end);//反边查找h(i);
	Astar();//启发式搜索
	return 0;
}