描述
平面上有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的最短路径长度。
#include <iostream>
#include <cstdlib>
#include <cstdio>
#include <cmath>
#include <cstring>
#include <algorithm>
#include <queue>
using namespace std;
int n,m,x[105],y[105],i,j,s,t,z[2005],f[105],ne[2005],d[110],w,ww,v[105],h;
double b[2005],qu[105];
int main()
{
scanf("%d",&n);
for(int k=1;k<=n;k++)
{
scanf("%d%d",&x[k],&y[k]);
f[k]=-1;
qu[k]=99999;
}
scanf("%d",&m);
for(int k=1;k<=m;k++)
{
scanf("%d%d",&i,&j);
ne[++ww]=f[i];
f[i]=ww;
z[ww]=j;
b[ww]=sqrt(pow(x[i]-x[j],2)+pow(y[i]-y[j],2));
ne[++ww]=f[j];
f[j]=ww;
z[ww]=i;
b[ww]=b[ww-1];
}
scanf("%d%d",&s,&t);
qu[s]=0;
w=h=1;
d[w++]=s;
while(w!=h)
{
v[d[h]]=0;
for(int k=f[d[h]];k!=-1;k=ne[k])
if(qu[z[k]]>qu[d[h]]+b[k])
{
qu[z[k]]=qu[d[h]]+b[k];
if(!v[z[k]])
{
d[w++]=z[k];
v[z[k]]=1;
}
}
h++;
}
printf("%.2lf",qu[t]);
}