POJ_2502（dijkstra算法）

POJ_2502，dijkstra例题，代码有所参考。

#include <stdio.h>
#include <algorithm>
#include <math.h>
#define INF 0x3f3f3f3f
#define Max 250
using namespace std;
//只告诉了点坐标,还没告诉点与点之间的边权,故先将点存到数组中
//其中dkr[1]dkr[2]是起止点坐标,dkr[3]开始是地铁站坐标 
struct Point{
    int x,y;
}dkr[Max];
bool vis[Max];			//用于dij
double dis[Max];		//用于dij
double Map[Max][Max];	//Map[][]存时间，相当于dij里的边权重 

void dijkstra(int x,int n){	//x是起始点，n是总点数 
    int i,j,u;
    for( i=1 ; i<=n ; i++ ){
        dis[i]=Map[x][i];
        vis[i]=0;
    }
    vis[x]=1;
    for( i=1 ; i<n ; i++ ){
        //找到离当前点最近的点下标并攻占
        double minn=INF;
        for( j=1 ; j<=n ; j++)
            if(!vis[j] && minn>dis[j] ){
                minn=dis[j];
                u=j;
            }
        vis[u]=1;
        //从找到的点出发更新dis
        for( j=1 ; j<=n ; j++ )
            if(!vis[j] && dis[j]>dis[u]+Map[u][j])
                dis[j]=dis[u]+Map[u][j];
    }
    printf("%.0f",dis[2]);
}

double feet(Point t,Point s){	//两点之间距离 
    return sqrt((t.x-s.x)*(t.x-s.x)+(t.y-s.y)*(t.y-s.y));
}

int main(){
    int x,y,k=3,n=3;
	//n是坐标点总数(地铁站+起始点)，k是当前录入的地铁线始发站编号
	//现在均赋值为第一条地铁的首个地铁站 
    for(int i=1 ; i<Max ; i++ )
        for(int j=1 ; j<Max ; j++ )
            if(i==j)
                Map[i][j] = 0 ;
            else
                Map[i][j] = INF ;
    scanf("%d%d%d%d",&dkr[1].x ,&dkr[1].y,&dkr[2].x ,&dkr[2].y);//起点，终点 
    while(~scanf("%d%d",&x,&y)){	//地铁 
        if(x==-1&&y==-1){
           k=n;
           continue;
        }
        dkr[n].x=x;		dkr[n].y=y;
        //先用地铁速度更新地铁线上的点的G[][]
        if(n!=k)		//本条地铁的首个站点不能与相邻地铁站建边 
            Map[n][n-1]=Map[n-1][n]=feet(dkr[n],dkr[n-1])*3/2000;
        n++;
    }
    //再用步行速度更新所有点的min(G[][])
    for(int i=1 ; i<=n ;i++)//步行 
        for(int j=1 ; j<=n ; j++)
            Map[i][j]=Map[j][i]=min(Map[i][j],feet(dkr[i],dkr[j])*3/500);
    dijkstra(1,n);
    return 0;
}