问题 C: 最短路径问题
时间限制: 1 Sec 内存限制: 128 MB提交: 5 解决: 5
[ 提交][ 状态][ 讨论版]
题目描述
平面上有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的最短路径长度。
样例输入
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<stdio.h>
#include<queue>
#include<string.h>
#include<iostream>
#include<queue>
#include<math.h>
using namespace std;
const double inf=0x3f3f3f3f;
int n,m;
double mat[105][105];//记录点与点的距离
int vis[105];
double dis[105];
struct node{//记录坐标
int x,y;
}s[105];
double Length(int a,int b){
return sqrt((s[a].x -s[b].x )*(s[a].x -s[b].x )+(s[a].y -s[b].y )*(s[a].y -s[b].y ));
}
void Djk(int c,int d){
memset(vis,0,sizeof(vis));
for(int i=1;i<=n;i++)
dis[i]=mat[c][i];
vis[c]=1;dis[c]=0;
for(int i=0;i<n;i++){
double maxn=inf;
int pos;
for(int j=1;j<=n;j++){
if(!vis[j]&&dis[j]<maxn){
maxn=dis[j];
pos=j;
}
}
vis[pos]=1;
for(int j=1;j<=n;j++){
if(!vis[j]&&dis[j]>dis[pos]+mat[pos][j])
dis[j]=dis[pos]+mat[pos][j];
}
}
printf("%.2lf\n",dis[d]);
return ;
}
int main()
{
int a,b;
scanf("%d",&n);
for(int i=0;i<=n;i++)
for(int j=0;j<=n;j++)
mat[i][j]=inf;
for(int i=1;i<=n;i++)
scanf("%d%d",&s[i].x ,&s[i].y );
scanf("%d",&m);
for(int i=0;i<m;i++){
scanf("%d%d",&a,&b);
mat[a][b]=Length(a,b);
}
int c,d;
scanf("%d%d",&c,&d);
Djk(c,d);
return 0;
}