POJ3984 迷宫问题（BFS）

#include<cstdio>
#include<cstring>
#include<queue>
#include<vector>
using namespace std;


//0表示可以通过，1表示墙无法通过 
struct note{
int x,y;
note(){

}
note (int x,int y){
this->x=x;
this->y=y;
}
const bool operator==(const note &n)const {
return (this->x==n.x)&&(this->y==n.y);
}
};
int a[6][6];
int visit[6][6];//判断当前节点是否已经访问，0表示未访问，1表示已经访问 
note path[6][6];//路径记录 
queue<note>myqueue;

bool isValid(note &n){
return !a[n.x][n.y]&&n.x<=4&&n.y<=4&&n.x>=0&&n.y>=0;  // 0可以通过并且要在数组范围内 
}


void print(note &n){
vector<note>vc;
note u=n;
for(;;){
if(u.x==0&&u.y==0)break;
vc.push_back(u);
        u=path[u.x][u.y];
}
vc.push_back(note(0,0));
for(int i=vc.size()-1;i>=0;i--){
printf("(%d, %d)\n",vc[i].x,vc[i].y);
}

}
int main(){
for(int i=0;i<5;i++){
for(int j=0;j<5;j++){
scanf("%d",&a[i][j]);
}
}
memset(visit,0,sizeof(visit));
note Ve;Ve.x=4,Ve.y=4;
note Vs;Vs.x=0;Vs.y=0;

note V1,V2;
int direct[4][2]={
{0,1},{1,0},{0,-1},{-1,0}
};

myqueue.push(Vs);
visit[0][0]=1;

while(!myqueue.empty()){
V1=myqueue.front();
myqueue.pop();

for(int i=0;i<4;i++){
V2=note(V1.x+direct[i][0],V1.y+direct[i][1]);

if(V2==Ve){
path[V2.x][V2.y]=V1;
print(V2);
return 0;
}

if(isValid(V2)&&!visit[V2.x][V2.y]){
path[V2.x][V2.y]=V1;
myqueue.push(V2);
visit[V2.x][V2.y]=1;
}

}
}
return 0;
}