（poj 2502） Subway 最短路

题目链接：

题意：在一个城市里有许多地铁，现在你知道每条地铁的起点  终点与停站点的坐标，知道我们的起始坐标与终点坐标，问加上走路最快到达终点的时间是多少？

方法：求出任意两点的车速时间与步行时间，再算出最短路

 #include<stdio.h>
 #include<cstring>
 #include<cstdlib>
 #include<algorithm>
 #include<math.h>
 #include<queue>
 using namespace std;
 #define INF 0x3f3f3f3f
 #define ll long long
 #define met(a,b) memset(a,b,sizeof(a))
 #define N 100010
 #define vs 40*1000/60.0 车速
 #define vp 10*1000/60.0 人速
 struct point
 {
     int x,y;

 }P[];
 struct node
 {
     int v,u,next;
     double l;
 }s[N];
 int a[],vis[],npoint;
 double dis[];
 double len(point a,point b,double v)
 {
     return sqrt((b.y-a.y)*(b.y-a.y)+(b.x-a.x)*(b.x-a.x))/v;
 }
 void add(int u,int v,double l,int k)
 {
     s[k].l=l;
     s[k].v=v;
     s[k].next=a[u];
     a[u]=k;
 }
 void spfa()
 {
     met(vis,);
     queue<int >Q;
     Q.push();
     vis[]=;
     while(Q.size())
     {
         int u=Q.front();
         Q.pop();
         vis[u]=;
         for(int i=a[u];i!=-;i=s[i].next)
         {
             int v=s[i].v;
             if(dis[v]>dis[u]+s[i].l)
             {
                 dis[v]=dis[u]+s[i].l;
                 if(!vis[v])
                 {
                     vis[v]=;
                     Q.push(v);
                 }
             }
         }
     }
 }
 int main()
 {
     int k,flag=;
     scanf("%d %d %d %d",&P[].x,&P[].y,&P[].x,&P[].y);
     int npoint=;
     met(a,-);k=;
     while(scanf("%d %d",&P[npoint].x,&P[npoint].y)!=EOF)
     {
         if(P[npoint].x!=-)
         {
             if(flag==)
                 flag=;
             else
             {
                 double c=len(P[npoint],P[npoint-],vs);
                 add(npoint,npoint-,c,k++);
                 add(npoint-,npoint,c,k++);
             }
             npoint++;
         }
         else
             flag=;
     }
     for(int i=;i<npoint;i++)
     {
         for(int j=i+;j<=npoint;j++)
         {
             double c=len(P[i],P[j],vp);
             add(i,j,c,k++);
             add(j,i,c,k++);
         }
     }
     for(int i=;i<npoint;i++)
         dis[i]=INF;
     spfa();
     printf("%.0f\n",dis[]);
     return ;
 }