【CODEVS2602】最短路径问题

Description

平面上有n个点（n<=100），每个点的坐标均在-10000~10000之间。其中的一些点之间有连线。若有连线，则表示可从一个点到达另一个点，即两点间有通路，通路的距离为两点间的直线距离。现在的任务是找出从一点到另一点之间的最短路径。

Input

第一行为整数n。

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

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

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

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

Output

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

Sample Input

5

0 0

2 0

2 2

0 2

3 1

5

1 2

1 3

1 4

2 5

3 5

1 5

Sample Output

3.41

 

#include<cstring>
#include<cstdio>
#include<cmath>
using namespace std;
int x[110],y[110];
struct edtype
{
    int next,to;
    double w;
}e[20010]; //开得足够大！！！ 
bool vis[110];
int head[110],q[110];
double dis[110];
int cnt=0,h,t,s;
void ins(int u,int v,double w)
{
    e[++cnt].to=v; e[cnt].w=w; e[cnt].next=head[u]; head[u]=cnt;
}

void spfa()
{
    memset(dis,127,sizeof(dis));
    int h=0, t=1;
    dis[s]=0; vis[s]=true; q[t]=s;
    while (h!=t)
    {    
        int now=q[++h]; if (h==101) h=0;
        for (int i=head[now];i;i=e[i].next)
        {
            int v=e[i].to;
            if (dis[v]>dis[now]+e[i].w)
            {
                dis[v]=dis[now]+e[i].w;
                if (!vis[v])
                {
                    q[++t]=v;
                    if (t==101) t=0;
                    vis[v]=true;
                }
            }
        }
        vis[now]=false;
    }
}

int main()
{
    memset(head,0,sizeof(head));
    memset(q,0,sizeof(q));
    memset(vis,false,sizeof(vis));
    int n,m,u,v,w;
    scanf("%d",&n);
    for (int i=1;i<=n;i++) scanf("%d%d",&x[i],&y[i]);
    scanf("%d",&m);
    for(int i=1;i<=m;i++)
    {
        scanf("%d%d",&u,&v);
        double w=sqrt(pow(x[u]-x[v],2)+pow(y[u]-y[v],2));
        ins(u,v,w); ins(v,u,w);
    }
    scanf("%d%d",&s,&t);
    spfa();
    printf("%.2lf",dis[t]);
    return 0;
}