一本通 第二部分 基础算法 第八章 广度优先搜索算法 1255：迷宫问题

1255：迷宫问题

时间限制: 1000 ms 内存限制: 65536 KB
提交数: 1607 通过数: 726
【题目描述】
定义一个二维数组：

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)

#include<iostream>
#include<cstring>
#include<cstdio>
using namespace std;
bool a[6][6],v[6][6];
int qi[100],qj[100],qnexti[100][100],qnextj[100][100];
int dis[4][2]={{1,0},{0,1},{-1,0},{0,-1}};
void print(int x,int y)
{
    if(x==-1&&y==-1)
        return;
    print(qnexti[x][y],qnextj[x][y]);
    printf("(%d, %d)\n",x,y);
}
int main()
{
	int n; 
	memset(v,false,sizeof(v));
	memset(a,true,sizeof(a));
	for(int i=0;i<5;i++)
		for(int j=0;j<5;j++)
			cin>>a[i][j];
	int head=0,tail=1;
	qi[0]=0;
	qj[0]=0;
	qnexti[0][0]=-1;
	qnextj[0][0]=-1;
	v[0][0]=true;
	while(head!=tail)
	{
		int x=qi[head];
		int y=qj[head];
		if(x==4&&y==4)
		{
			print(x,y);
			break;
		}
		head++;
		for(int i=0;i<4;i++)
		{
			int nx=x+dis[i][0];
			int ny=y+dis[i][1];
			if(nx<5&&ny<5&&nx>=0&&ny>=0&&!v[nx][ny]&&!a[nx][ny])
			{
				v[nx][ny]=true;
				qnexti[nx][ny]=x;
				qnextj[nx][ny]=y;
				qi[tail]=nx;
				qj[tail]=ny;
				tail++;
			}
		}
	}
	return 0;
}