POJ 2502 Subway dij

这个题的输入输出注意一下就好

#include<cstdio>
#include<cstring>
#include<queue>
#include<cstdlib>
#include<algorithm>
#include<vector>
#include<cmath>
using namespace std;
typedef long long LL;
const int N=4e3+;
const int INF=0x3f3f3f3f;
struct Edge{
   int v,next;
   double w;
   bool operator<(const Edge &e)const{
      return w>e.w;
   }
}edge[N*N*];
int head[N],tot,n;
double d[N];
void add(int u,int v,double w){
   edge[tot].v=v;
   edge[tot].w=w;
   edge[tot].next=head[u];
   head[u]=tot++;
}
priority_queue<Edge>q;
bool vis[N];
double dij(int s,int t){
    for(int i=;i<=n;++i)d[i]=INF,vis[i]=;
    d[s]=,q.push(Edge{s,,});
    while(!q.empty()){
       while(!q.empty()&&vis[q.top().v])q.pop();
       if(q.empty())break;
       int u=q.top().v;
       q.pop();
       vis[u]=;
       for(int i=head[u];~i;i=edge[i].next){
          int v=edge[i].v;
          if(!vis[v]&&d[v]>d[u]+edge[i].w){
            d[v]=d[u]+edge[i].w;
            q.push(Edge{v,,d[v]});
          }
       }
    }
    return d[t];
}
struct Point{
  int x,y;
}p[N];
double dis(int i,int j){
  return sqrt((p[i].x-p[j].x)*(p[i].x-p[j].x)+(p[i].y-p[j].y)*(p[i].y-p[j].y));
}
int main(){
   memset(head,-,sizeof(head)),tot=;
   scanf("%d%d%d%d",&p[].x,&p[].y,&p[].x,&p[].y);
    n=;
    bool flag=;
    while(~scanf("%d%d",&p[n].x,&p[n].y)){
        if(p[n].x==-&&p[n].y==-){
          flag=;
          continue;
        }
        if(flag){
          double tmp=dis(n,n-)/40000.0;
          add(n,n-,tmp),add(n-,n,tmp);
        }
        flag=;
        ++n;
    }
    --n;
    for(int i=;i<=n;++i)
      for(int j=;j<=n;++j){
        if(i==j)continue;
        double tmp=dis(i,j)/10000.0;
        add(i,j,tmp),add(j,i,tmp);
      }
    printf("%d\n",(int)(dij(,)*60.0+0.5));
    return ;
}