最短路径问题 dijkstra

最短路径问题
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;
}