POJ 3984 迷宫问题

int maze[5][5] = {

0, 1, 0, 0, 0,

0, 1, 0, 1, 0,

0, 0, 0, 0, 0,

0, 1, 1, 1, 0,

0, 0, 0, 1, 0,

};

0 1 0 0 0
0 1 0 1 0
0 0 0 0 0
0 1 1 1 0
0 0 0 1 0

(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

#include<stdio.h>
#include<string.h>
int map[5][5],vis[5][5];
int per[100];
struct node
{
int x,y;
}a[111];
int dis[4][2]={{-1,0},{1,0},{0,1},{0,-1}};
int OK(int x,int y)
{
if(x>=0&&y>=0&&x<5&&y<5&&map[x][y]==0)
return 1;
return 0;
}
void print(int x)//从一直查到树的根部!!
{
int t;
t=per[x];
if(t==0)
{
printf("(0, 0)\n");
printf("(%d, %d)\n",a[x].x,a[x].y);
return;
}
else
print(t);
printf("(%d, %d)\n",a[x].x,a[x].y);//好像用到了递归回溯，一旦t==0成立，前面所有都回溯了。
}
void bfs()
{
int i,head,tail;
int x,y,tx,ty;
memset(vis,0,sizeof(vis));
head=0;tail=1;
a[0].x=0;a[0].y=0;
per[0]=-1;
while(head<tail)
{
x=a[head].x;
y=a[head].y;
if(x==4&&y==4)
{
print(head);
return;
}
for(i=0;i<4;i++)
{
tx=x+dis[i][0];
ty=y+dis[i][1];
if(!vis[tx][ty]&&OK(tx,ty))
{
vis[tx][ty]=1;
a[tail].x=tx;
a[tail].y=ty;
per[tail]=head;
tail++;
}
}
head++;
}
return;
}
int main()
{
int i,j;
for(i=0;i<5;i++)
for(j=0;j<5;j++)
scanf("%d",&map[i][j]);
bfs();
return 0;
}