RE求助

#include<stdio.h>
#include<queue>
using namespace std;
struct qqt{
	int x,y;
}fi,la;
int a,lx[500005],ly[500005],lt[500005],f[5005][5005],p=1,o;
int dx[4]={0,1,0,-1};
int dy[4]={1,0,-1,0};
queue<qqt> q;
int main(){
	scanf("%d",&a);
	for(int i=1;i<=a;i++) scanf("%d%d%d",&lx[i],&ly[i],&lt[i]);
	fi.x=0;
	fi.y=0;
	f[0][0]=1;
	q.push(fi); 
	while(!q.empty()){
		fi=q.front();
		q.pop();
		for(int i=0;i<4;i++){
			int xx=fi.x+dx[i],yy=fi.y+dy[i];
			if(xx>301||yy>301){
				printf("%d",p);
				return 0;
			}
			if(f[xx][yy]==0){
				f[xx][yy]=f[fi.x][fi.y]+1;
				la.x=xx;
				la.y=yy;
				q.push(la);
				if(f[xx][yy]>p){
					p++;
					for(int j=1;j<=a;j++){
						if(lt[j]==p){
							o++;
							f[lx[j]][ly[j]]=-1;
							for(int k=0;k<4;k++){
								f[lx[j]+dx[k]][ly[j]+dy[k]]=-1;
							}
						}
						if(o==a){
							printf("%d",p);
							return 0;
						}
					}
				} 
			}
		}
	}
	printf("-1");
	return 0;
}