最短路径问题

题目描述
平面上有n个点(n<=100),每个点的坐标均在-10000~10000之间,其中的一些点之间有连线。

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

输入
共n+m+3行。

第一行:整数n

第2行到第n+1行(共n行),每行两个整数x和y,描述一个点的坐标。

第n+2行为一个整数m,m<=1000,表示图中连线的个数。

此后的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  <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]);
}

你可能感兴趣的:(编程)