poj3984迷宫问题【bfs+记录路径】

[align=center]迷宫问题[/align]

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 11236		Accepted: 6719

Description
定义一个二维数组：

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,

};

它表示一个迷宫，其中的1表示墙壁，0表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。
Input
一个5 × 5的二维数组，表示一个迷宫。数据保证有唯一解。
Output
左上角到右下角的最短路径，格式如样例所示。
Sample Input

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

Sample Output

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

#include<cstdio>
#include<cstdlib>
#include<cstring>
#include<queue>
using namespace std;
int last[6][6];
int map[6][6];
int vis[6][6];
int mov[][2]={1,0,-1,0,0,1,0,-1};
bool judge(int x,int y)
{
if(x>=0&&x<5&&y>=0&&y<5&&!map[x][y]&&!vis[x][y])return true;
return false;
}
void printpath(int x,int y)
{
int u,v,xx,yy;
if(last[x][y]!=-1)
{
xx=last[x][y]/5;yy=last[x][y]%5;
printpath(xx,yy);
}
printf("(%d, %d)\n",x,y);
}
void bfs()
{
int x,y,xx,yy,i,j,u,flag=0;
queue<int>Q;
x=0;y=0;u=x*5+y;
Q.push(u);vis[0][0]=1;last[0][0]=-1;
while(!Q.empty())
{
u=Q.front();Q.pop();
x=u/5;y=u%5;
for(i=0;i<4;++i)
{
xx=x+mov[i][0];
yy=y+mov[i][1];
if(judge(xx,yy))
{
int v=xx*5+yy;
vis[xx][yy]=1;
last[xx][yy]=u;
if(vis[4][4])
{
printpath(4,4);
flag=1;break;
}
Q.push(v);
}
if(flag)break;
}
}
}
int main()
{
int i,j;
for(i=0;i<5;++i)
{
for(j=0;j<5;++j)
{
scanf("%d",&map[i][j]);
last[i][j]=vis[i][j]=0;
}
}
bfs();
return 0;
}