022:迷宫问题

定义一个二维数组：

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<bits/stdc++.h>
using namespace std;
int n,m,vit[6][6],a[10][10],path[31][3],cnt;
struct node
{
	int x,y;
	int fux,fuy;
	int step;
}q[6][6];
queue<node> p;
int main()
{
	for(int i=1;i<=5;i++)
		for(int j=1;j<=5;j++)
		cin>>a[i][j];
	for(int i=0;i<=6;i++)
	a[i][0]=a[i][6]=-1;
	for(int j=0;j<=6;j++)
	a[0][j]=a[6][j]=-1;
	for(int i=1;i<=5;i++)
	{
		for(int j=1;j<=5;j++)
		q[i][j].x=i,q[i][j].y=j;
	}
	p.push(node{1,1,0,0,0});
	while(p.empty()==0)
	{
		node r=p.front();
		p.pop();
		vit[r.x][r.y]=1;
		if(r.x==5&&r.y==5)
		{
			break;
		}
		if(a[r.x+1][r.y]!=-1&&a[r.x+1][r.y]!=1&&vit[r.x+1][r.y]!=1)
		{
			q[r.x+1][r.y].step=r.step+1;
			q[r.x+1][r.y].fux=r.x;
			q[r.x+1][r.y].fuy=r.y;
			p.push(q[r.x+1][r.y]);
		}
		if(a[r.x-1][r.y]!=-1&&a[r.x-1][r.y]!=1&&vit[r.x-1][r.y]!=1)
		{
			q[r.x-1][r.y].step=r.step+1;
			q[r.x-1][r.y].fux=r.x;
			q[r.x-1][r.y].fuy=r.y;
			p.push(q[r.x-1][r.y]);
		}
		if(a[r.x][r.y+1]!=-1&&a[r.x][r.y+1]!=1&&vit[r.x][r.y+1]!=1)
		{
			q[r.x][r.y+1].step=r.step+1;
			q[r.x][r.y+1].fux=r.x;
			q[r.x][r.y+1].fuy=r.y;
			p.push(q[r.x][r.y+1]);
		}
		if(a[r.x][r.y-1]!=-1&&a[r.x][r.y-1]!=1&&vit[r.x][r.y-1]!=1)
		{
			q[r.x][r.y-1].step=r.step+1;
			q[r.x][r.y-1].fux=r.x;
			q[r.x][r.y-1].fuy=r.y;
			p.push(q[r.x][r.y-1]);
		}
	}
	int c=5,d=5;
	while(1)
	{
		int e=c,f=d;
		cnt++;
		path[cnt][1]=c;
		path[cnt][2]=d;
		if(c==1&&d==1)
		break;
		c=q[e][f].fux;
		d=q[e][f].fuy;
	}
	for(int i=cnt;i>=1;i--)
	cout<<"("<<path[i][1]-1<<", "<<path[i][2]-1<<")"<<endl;
}