B - 最短路径问题(佛洛依德)

Description

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

第1行为整数n。
第2行到第n+1行(共n行),每行两个整数x和y,描述了一个点的坐标(以一个空格分隔)。
第n+2行为一个整数m,表示图中连线的个数。
此后的m行,每行描述一条连线,由两个整数i和j组成,表示第i个点和第j个点之间有连线。
最后一行:两个整数s和t,分别表示源点和目标点。
Output

仅1行,一个实数(保留两位小数),表示从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
Output

3.41

#include<stdio.h>
#include<stdlib.h>
#include<string.h>
#include<malloc.h>
#include<queue>
#include<math.h>
#define INF 0x3f3f3f3f
using namespace std;
int n,m;
double Map[12000][12000];
int mapx[12000],mapy[12000];
void floyd()
{
    int i,j,k;
    for(k=1;k<=n;k++)
    {
        for(i=1;i<=n;i++)
        {
            for(j=1;j<=n;j++)
            {
                if(Map[i][j]>Map[i][k]+Map[k][j])
                    Map[i][j] = Map[i][k]+Map[k][j];
            }
        }
    }
}
int main()
{
   int u,v,i,j;
    scanf("%d",&n);
    for(i=1; i<=n; i++)
    {
        for(j=1; j<=n; j++)
        {
            Map[i][j]=Map[j][i]=INF;
        }
        Map[i][i]=0;
    }
    for(i=1;i<=n;i++)
    {
        scanf("%d %d",&mapx[i],&mapy[i]);
    }
    scanf("%d",&m);
    for(i = 1;i<=m;i++)
    {
         scanf("%d %d",&u,&v);
         double w;
         w = sqrt((double)(mapx[v] - mapx[u])*(double)(mapx[v] - mapx[u]) +
         (double)(mapy[v] - mapy[u])*(double)(mapy[v] - mapy[u]));
         if(Map[u][v]>w)
         {
             Map[u][v] = Map[v][u] = w;
         }
    }
    floyd();
    int e,s;
    scanf("%d %d",&e,&s);
    printf("%.2lf\n",Map[e][s]);
    return 0;

}

发布了177 篇原创文章 · 获赞 7 · 访问量 3万+

猜你喜欢

转载自blog.csdn.net/Fusheng_Yizhao/article/details/104895180