一本通 第三部分 数据结构 第四章 图论算法 第二节 最短路径算法 1342：【例4-1】最短路径问题

1342：【例4-1】最短路径问题

时间限制: 1000 ms 内存限制: 65536 KB
提交数: 3087 通过数: 1372
【题目描述】
平面上有n个点（n≤100），每个点的坐标均在-10000~10000之间。其中的一些点之间有连线。

若有连线，则表示可从一个点到达另一个点，即两点间有通路，通路的距离为两点间的直线距离。现在的任务是找出从一点到另一点之间的最短路径。

【输入】
共n+m+3行，其中:

第一行为整数n。

第2行到第n+1行（共n行） ，每行两个整数x和y，描述了一个点的坐标。

第n+2行为一个整数m，表示图中连线的个数。

此后的m 行，每行描述一条连线，由两个整数i和j组成，表示第i个点和第j个点之间有连线。

最后一行：两个整数s和t，分别表示源点和目标点。

【输出】
一行，一个实数（保留两位小数），表示从s到t的最短路径长度。

【输入样例】
5
0 0

2 0
2 2
0 2
3 1
5
1 2
1 3
1 4
2 5
3 5
1 5
【输出样例】
3.41

#include<iostream>
#include<algorithm>
#include<cmath>
#include<cstdio>
#include<cstring>
struct node
{
	int fori,forj;
}wei[1001];
double map[101][101],d[101];
bool visit[101];
using namespace std;
int main()
{
	int n,m,s,t;
	memset(map,0x7f,sizeof(map));
	fill_n(d,102,999999);
	cin>>n;
	for(int i=1;i<=n;i++)
		cin>>wei[i].fori>>wei[i].forj;
	cin>>m;
	for(int i=1;i<=m;i++)
	{
		int x,y;
		cin>>x>>y;
		map[y][x]=map[x][y]=sqrt(
		(max(wei[x].fori,wei[y].fori)-min(wei[x].fori,wei[y].fori))*
		(max(wei[x].fori,wei[y].fori)-min(wei[x].fori,wei[y].fori))+
		(max(wei[x].forj,wei[y].forj)-min(wei[x].forj,wei[y].forj))*
		(max(wei[x].forj,wei[y].forj)-min(wei[x].forj,wei[y].forj)));
	}
	cin>>s>>t;
	d[s]=0;
	for(int i=1;i<=n;i++)
	{
		int x,minn=999999;
		for(int j=1;j<=n;j++)
			if(!visit[j]&&d[j]<=minn)
			{
				minn=d[j];
				x=j;
			}
		visit[x]=true;
		for(int j=1;j<=n;j++)
			d[j]=min(d[j],d[x]+map[x][j]);
	}
	printf("%.2lf",d[t]);
	return 0;
}