poj3669 Meteor Shower BFS

#include <iostream>
#include <cstring>
#include <cstdio>
#include <cmath>
#include <queue>
#include <algorithm>
using namespace std;
int st[400][400];
struct node
{
    int x,y,t,mv;
}save[51000];
vector<node>miss[1100];
int n,ed;
int dx[]={0,0,1,-1,0};
int dy[]={0,1,0,0,-1};
bool cmp(node aa,node bb)
{
    return aa.t<bb.t;
}
bool judge(int x,int y)
{
    if(x>0&&y>0)
        return true;
    return false;
}
int bfs()
{
    if(st[1][1]==0) return -1;  
    if(st[1][1]==st[0][0]) return 0; 
    queue<node>q;
    node tmp,tot,cur,now;
    int xx,tt,yy,ty,tx;
    tmp.x=1;
    tmp.y=1;
    tmp.t=0;
    q.push(tmp);
    while(!q.empty())
    {
        now=q.front();
        q.pop();
        tx=now.x;
        ty=now.y;
        tt=now.t;
        if(st[tx][ty]<=tt) continue;
        if(st[tx][ty]==st[0][0])
        {
            return now.t;
        }
        st[tx][ty]=0;//关键的剪枝 如果没有的话同一个点会走多遍。
        for(int i=0;i<=4;i++)
        {
            xx=tx+dx[i];
            yy=ty+dy[i];
            if(!judge(xx,yy)) continue;
            cur.x=xx;
            cur.y=yy;
            cur.t=tt+1;
            q.push(cur);
        }
    }
    return -1;
}
int main()
{
    ed=0;
    int xx,yy;
    memset(st,0x3f3f3f3f,sizeof(st));
    scanf("%d",&n);
    for(int i=1;i<=n;i++)
    {
        scanf("%d%d%d",&save[i].x,&save[i].y,&save[i].t);
        ed=max(ed,save[i].t);
        save[i].x++;
        save[i].y++;
        for(int j=0;j<=4;j++)
        {
            xx=save[i].x+dx[j];
            yy=save[i].y+dy[j];
            if(!judge(xx,yy)) continue;
            st[xx][yy]=min(st[xx][yy],save[i].t);
        }
    }
    printf("%d\n",bfs());
    return 0;
}