23.最短路径问题

时间限制: 1 s

 空间限制: 32000 KB

 题目等级 : 黄金 Gold

题解

 查看运行结果

题目描述 Description

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

输入描述 Input Description

第一行为整数n。

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

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

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

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

输出描述 Output Description

仅一行，一个实数（保留两位小数），表示从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

using namespace std;

#include

#include

#include

#define maxn 101

int n,x,y,m,s,t;

int a[maxn][3];

double p[maxn][maxn];

double dis[maxn];

bool exist[maxn];

int team[10010],head,tail;//队列一定要足够大，否则用循环队列

void input();

void SPFA();

int main()

{

       input();

       SPFA();

       printf("%0.2lf",dis[t]);

       return 0;

}

void input()

{

       scanf("%d",&n);

       for(int i=1;i<=n;++i)

       scanf("%d%d",&a[i][1],&a[i][2]);

       scanf("%d",&m);

       memset(p,99,sizeof(p));

       for(int i=1;i<=m;++i)

       {

              scanf("%d%d",&x,&y);

              p[x][y]=sqrt(pow(a[x][1]-a[y][1],2)+pow(a[x][2]-a[y][2],2));

              p[y][x]=p[x][y];

       }

       scanf("%d%d",&s,&t);

       return;

}

 

void SPFA()

{

       memset(dis,0x7f,sizeof(dis));

       memset(exist,false,sizeof(exist));

       team[1]=s;head=0;tail=1;

       exist[s]=true;

       dis[s]=0;

       do{

              int u=team[++head];

              exist[u]=false;

              for(int i=1;i<=n;++i)

              {

                     if(dis[i]>dis[u]+p[u][i])

                     {

                            dis[i]=dis[u]+p[u][i];

                            if(!exist[i])

                            {

                                   team[++tail]=i;

                                   exist[i]=true;

                            }

                     }

              }

       }while(head<=tail);

}