Subway POJ - 2502 spfa

#include<cstdio>
#include<cmath>
#include<cstring>
#include<cstring>
#include<iostream>
#include<queue>
using namespace std;
const int N=;
const double INF=0x3f3f3f3f;
int k,l;
struct node
{
    double x,y;
    int num;
} s[N];
bool st[N];
double dist[N];
void spfa(int x)
{
    memset(st,false,sizeof st );
    for(int i=;i<N;i++)
        dist[i]=INF;
    st[x]=true;
    dist[x]=;
    queue<int>q;
    while(!q.empty())
        q.pop();
    q.push(x);
    while(!q.empty())
    {
        int u=q.front();
        st[u]=false;
        q.pop();
        for(int i=; i<=k; i++)
        {
            if(i==u)
                continue;
            double far,t;
            far=sqrt(((s[u].y-s[i].y)*(s[u].y-s[i].y))+((s[u].x-s[i].x)*(s[u].x-s[i].x)));
            far=far/1000.0;
            if(fabs(s[u].num-s[i].num)==)
                t=far/40.0;
            else
                t=far/10.0;
            if(dist[i]>dist[u]+t)
            {
                dist[i]=dist[u]+t;
                if(!st[i])
                {
                    st[i]=true;
                    q.push(i);
                }
            }
        }
    }
}
int main()
{
    double s1,s2,e1,e2;
    double x,y;
    k=,l=;
    cin>>s1>>s2>>e1>>e2;
    //只有相邻的站点能到
    while(cin>>x>>y)
    {
        if(x==-&&y==-)
        {
            if(l==)
                break;
            l++;
            continue;
        }
        s[k].x=x,s[k].y=y;
        s[k++].num=l++;
    }
    s[].x=s1,s[].y=s2,s[].num=-;
    s[k].x=e1,s[k].y=e2,s[k].num=-;
    spfa();
    //四舍五入
    cout<<(int)(dist[k]*+0.5)<<endl;
    return ;
}