最短路径问题
Time Limit: 1000MS Memory Limit: 65536KB
Submit Statistic
Problem Description
平面上有n个点(n<=100),每个点的坐标均在-10000~10000之间。其中的一些点之间有连线。若有连线,则表示可从一个点到达另一个点,即两点间有通路,通路的距离为两点间的直线距离。现在的任务是找出从一点到另一点之间的最短距离。
Input
第1行为整数n。
第2行到第n+1行(共n行),每行两个整数x和y,描述了一个点的坐标(以一个空格分隔)。
第n+2行为一个整数m,表示图中连线的个数。
此后的m行,每行描述一条连线,由两个整数i和j组成,表示第1个点和第j个点之间有连线。
最后一行:两个整数s和t,分别表示源点和目标点。
Output
仅1行,一个实数(保留两位小数),表示从s到t的最短路径长度。
Example 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
Example Output
3.41
代码:
#include<stdio.h>
#include<string.h>
#include<math.h>
#define INF 9999999.9
double map[105][105];
int vis[105];//标记是否走过
int x[105], y[105];//记录输入点的坐标
double dist[105];//记录到起始点的距离
double pf(int u, int v)
{
return sqrt((x[u] - x[v]) * (x[u] - x[v]) + (y[u] - y[v]) * (y[u] - y[v]));
}
void dijkstra(int a, int b, int n)
{
int i, j, k, u;
double min;
for(i = 1; i <= n; i++)
{
dist[i] = map[a][i];//起始点到其他点的距离 赋值给dist[]
}
dist[a] = 0.0;//自己到自己为0
vis[a] = 1;//标记一下
for(i = 1; i < n; i++)
{
min = INF;
for(j = 1; j <= n; j++)
{
if(!vis[j] && min > dist[j])//找到起始点最小的点
{
min = dist[j];
u = j;
}
}
vis[u] = 1;
for(k = 1; k <= n; k++)
{
if(!vis[k] && map[u][k] < INF && dist[k] > dist[u] + map[u][k])//更新没有标记过的点到起始点的距离
{
dist[k] = dist[u] + map[u][k];
}
}
}
printf("%.2lf\n", dist[b]);//输出最短距离
}
int main()
{
double t;
int n, u, v, m, i, a, b;
while(~scanf("%d", &n))
{
memset(map, INF, sizeof(map));
memset(vis, 0, sizeof(vis));
for(i = 1; i <= n; i++)
map[i][i] = 0.0;//除了自身到自身为0,其他都为无穷大
for(i = 1; i <= n; i++)
scanf("%d %d", &x[i], &y[i]);
scanf("%d", &m);
for(i = 0; i < m; i++)
{
scanf("%d %d", &u, &v);
t = pf(u, v);//两点直接距离公式
map[u][v] = map[v][u] = t;
}
scanf("%d %d", &a, &b);
dijkstra(a, b, n);//调用函数
}
return 0;
}