hdu 2992 Hotel booking

http://acm.hdu.edu.cn/showproblem.php?pid=2992

#include <cstdio>
#include <cstring>
#include <map>
#include <vector>
#include <queue>
#define maxn 200
#include <algorithm>
using namespace std;

const int inf=0x3fffffff;

struct node
{
    int v,cost;
};
int g[maxn][maxn],a[maxn],dis[20000];
int n,m,k;
map<int,int>q;
vector<node>v[20000];
bool vis[20000];
int que[20000];

void inti()
{
    q.clear();
    for(int i=0; i<=n; i++)
    {
        v[i].clear();
    }
    for(int i=0; i<=m+2; i++)
    {
        for(int j=0; j<=m+2; j++)
        {
            g[i][j]=inf;
            if(i==j) g[i][j]=0;
        }
    }
}

void spfa(int qr)
{
    queue<int>qq;
    memset(vis,false,sizeof(vis));
    for(int i=1; i<=n; i++) dis[i]=inf;
    dis[qr]=0;
    qq.push(qr);
    vis[qr]=true;
    while(!qq.empty())
    {
        int x=qq.front();
        qq.pop();
        vis[x]=false;
        for(int i=0; i<(int)v[x].size(); i++)
        {
            int v2=v[x][i].v,cost=v[x][i].cost;
            if(dis[v2]>dis[x]+cost)
            {
                dis[v2]=dis[x]+cost;
                if(!vis[v2])
                {
                    vis[v2]=true;
                    qq.push(v2);
                }
            }
        }
    }
    for(int i=1; i<=n; i++)
    {
        if(dis[i]<=600&&q[i]!=0)
        {
            g[q[qr]][q[i]]=1;
        }
    }

}

void floyd()
{
    for(int c=0; c<=m+1; c++)
    {
        for(int i=0; i<=m+1; i++)
        {
            for(int j=0; j<=m+1; j++)
            {
                    g[i][j]=min(g[i][j],g[i][c]+g[c][j]);
            }
        }
    }
}
int main()
{
    while(scanf("%d",&n)!=EOF)
    {
        if(n==0) break;
        scanf("%d",&m);
        inti();
        for(int i=1; i<=m; i++)
        {
            scanf("%d",&a[i]);
            q[a[i]]=i;
        }
        a[0]=1;
        q[1]=0;
        a[m+1]=n;
        q[n]=m+1;
        scanf("%d",&k);
        for(int i=0; i<k; i++)
        {
            int u,v1,cost;
            scanf("%d%d%d",&u,&v1,&cost);
            node st;
            st.v=v1;
            st.cost=cost;
            node st1;
            st1.v=u;
            st1.cost=cost;
            v[u].push_back(st);
            v[v1].push_back(st1);
        }
        for(int i=0; i<=m; i++)
        {
            spfa(a[i]);
        }
        floyd();
        if(g[0][m+1]==inf)
        {
            printf("-1
");
        }
        else
            printf("%d
",g[0][m+1]-1);
    }
    return 0;
}