POJ-3984(BFS) 迷宫问题

定义一个二维数组：

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)

要输出路径 记录父节点

好像自己构造队列比queue要好用一些，省着另处理父亲节点了

#include <iostream>
#include <cstring>
using namespace std;

int map[ 5 ][ 5 ];
struct node
{
int x;
int y;
int fa;
}que[100];
int head = 0,tail = 1;
int dir[4][2]={{ 0, -1 }, { 1, 0 },{ 0, 1 },{ -1, 0 }};

void print(int i){
if (que[i].fa != -1){
print(que[i].fa);
cout<<"("<<que[i].x<<", "<<que[i].y<<")"<<endl;
}
}

void solve( int x, int y){
que[head].x = x;
que[head].y = y;
que[head].fa = -1;
while ( head < tail){
int i;
for ( i = 0; i < 4; i++ ){
int x = que[head].x + dir[i][0];
int y = que[head].y + dir[i][1];
if ( x < 0 || x >= 5 || y < 0 || y >= 5 ||map[ x ][ y ]  ) continue;
else{
map[ x ][ y ] = -1;
que[tail].x = x;
que[tail].y = y;
que[tail].fa = head;
tail++;
}
if ( x == 4 && y == 4 ){
cout<<"(0, 0)"<<endl;
print(head);
cout<<"(4, 4)"<<endl;
}
}
head++;
}
}

int main(){
for ( int i = 0; i < 5; i++ ){
for ( int j = 0; j < 5; j++ ){
cin>>map[ i ][ j ];
}
}
solve(0,0);
return 0;
}