POJ 3984 迷宫问题（BFS+路径输出）

题目地址：http://poj.org/problem?id=3984

思路：路径输出有2种方式，一种是用STL提供的queue，但是必须在结构体中加step或pre，来标记他本身的操作或上一个操作，第二种是手动写队列，通过数组下标来记录，这种简单

AC代码：

#include <iostream>
#include <cstdio>
#include <cstdlib>
#include <algorithm>
#include <queue>
#include <stack>
#include <map>
#include <cstring>
#include <climits>
#include <cmath>
#include <cctype>

const int inf = 0x7f7f7f7f;//2139062143
typedef long long ll;
using namespace std;

int map1[5][5];
int visit[30][30];
int pre[30];

struct node
{
int x;
int y;
}a[30];

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

bool judge(int x,int y)
{
if(x >=0 && x < 5 && y >= 0 && y < 5 && !visit[x][y] && !map1[x][y])
return true;
return false;
}

void print(int x)
{
int t = pre[x];
if(t == -1)
{
printf("(0, 0)\n");
return;
}
print(t);
printf("(%d, %d)\n",a[x].x,a[x].y);
}

void bfs()
{
int head = 0,tail = 1;
a[0].x = 0;
a[0].y = 0;
pre[0] = -1;
while(head < tail)
{
for(int i=0; i<4; i++)
{
int newx = a[head].x + dir[i][0];
int newy = a[head].y + dir[i][1];
if(a[head].x == 4 && a[head].y == 4)
{
print(head);
return;
}
if(judge(newx,newy))
{
visit[newx][newy] = 1;
pre[tail] = head;
a[tail].x = newx;
a[tail].y = newy;
tail++;
}
}
head++;
}
}

int main()
{
for(int i=0; i<5; i++)
{
for(int j=0; j<5; j++)
{
scanf("%d",&map1[i][j]);
}
}
memset(visit,0,sizeof(visit));
bfs();
return 0;
}