迷宫问题

题目内容：

定义一个二维数组，例如：

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表示可以走的路，只能横着走或
竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。

输入格式:

一个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, 0)

(1, 0)

(2, 0)

(2, 1)

(2, 2)

(2, 3)

(2, 4)

(3, 4)

(4, 4)

话不多说，先上C++源码：

#include<iostream>
#include<queue>
#include<vector>
using namespace std;
int w[5][5];
int d[5][5];
class Node{
public:
	int x,y;
	Node(int x=0,int y=0){this->x=x;this->y=y;}
};
Node p[5][5];
const int dx[]={1,0,-1,0};
const int dy[]={0,1,0,-1};
Node walk(const Node& u,int turn){
	return Node(u.x+dx[turn],u.y+dy[turn]);
}
bool ok(const Node& u){
	if(u.x>=0&&u.x<=4&&u.y>=0&&u.y<=4&&w[u.x][u.y]==0)
		return 1;
	else return 0;
}
void print_ans(Node u){
	vector<Node> nodes;
	for(;;){
		nodes.push_back(u);
		if(d[u.x][u.y]==0) break;
		u=p[u.x][u.y];
	}
	for(int i=nodes.size()-1;i>=0;i--){
		cout<<"("<<nodes[i].x<<", "<<nodes[i].y<<")"<<endl;
	}

}
int main(){
	for(int i=0;i<5;i++)
		for (int j=0;j<5;j++)
			cin>>w[i][j];
	queue<Node> q;
    for(int i=0;i<5;i++)
		for (int j=0;j<5;j++)
			d[i][j]=-1;
	Node u(0,0);
	d[0][0]=0;
	q.push(u);
	while(!q.empty()){
		Node u=q.front(); q.pop();
		if(u.x==4&&u.y==4){ print_ans(u);break;}
		for(int t=0;t<4;t++){
			Node v=walk(u,t);
			if(ok(v)&&d[v.x][v.y]<0){
				d[v.x][v.y]=d[u.x][u.y]+1;
				p[v.x][v.y]=u;
				q.push(v);

			}
		}

	}

	return 0;
}

迷宫问题的大致思路就是利用队列对解空间树进行广度优先搜索。