POJ 3669 BFS

#include <stdio.h>
#include <iostream>
#include <queue>
#include <algorithm>
#include <map>
#include <vector>
#include <cmath>
#include <string.h>
#include <stdlib.h>
#include <time.h>
#include <fstream>
#include <set>
#include <stack>
using namespace std;

#define READ freopen("acm.in","r",stdin)
#define WRITE freopen("acm.out","w",stdout)
#define ll long long
#define ull unsigned long long
#define PII pair<int,int>
#define PDI pair<double,int>
#define PDD pair<double,double>
#define MII map<int,int>::iterator
#define fst first
#define sec second
#define MS(x,d) memset(x,d,sizeof(x))
#define INF 0x3f3f3f3f
#define ALL(x) x.begin(),x.end()
#define lson l,m,rt<<1
#define rson m+1,r,rt<<1|1
#define ROOT 0,n-1,1
#define PB push_back
#define FOR(a,b,c) for(int a=b;a<c;a++)
#define MOD 1000000007
#define keyTree (ch[ ch[root][1] ][0])
#define MAX 200000

int T[500][500];

int dir[4][2]={0,1,0,-1,1,0,-1,0};

int dist[500][500];
bool used[500][500];
int n;

int bfs()
{
MS(used,0);
queue< PII > q;
while(!q.empty())q.pop();
q.push(PII(0,0));
dist[0][0]=0;
used[0][0]=1;
while(!q.empty())
{
PII p=q.front();q.pop();
int x=p.fst,y=p.sec;
if(dist[x][y]>=T[x][y])
continue;
if(T[x][y]==2000)
return dist[x][y];
for(int i=0;i<4;i++)
{
int tx=x+dir[i][0];
int ty=y+dir[i][1];
if(tx>=0&&tx<n&&ty>=0&&ty<n&&!used[tx][ty])
{
used[tx][ty]=1;
dist[tx][ty]=dist[x][y]+1;
q.push(PII(tx,ty));
}
}
}
return -1;
}

int main()
{
int m;
n=311;
while(scanf("%d",&m)!=EOF)
{
for(int i=0;i<500;i++)
for(int j=0;j<500;j++)
T[i][j]=2000;
for(int i=0;i<m;i++)
{
int x,y,t;
scanf("%d%d%d",&x,&y,&t);
T[x][y]=min(t,T[x][y]);
for(int i=0;i<4;i++)
{
int tx=x+dir[i][0];
int ty=y+dir[i][1];
if(tx>=0&&tx<n&&ty>=0&&ty<n)
T[tx][ty]=min(T[tx][ty],t);
}
}
int ans=bfs();
cout<<ans<<endl;
}
return 0;
}