迷宫问题————bfs解决

迷宫问题————bfs解决

输入一个nn的矩阵，以0代表道路，以1代表障碍物，实现一个算法，要求能够给出从入口（默认为左上角）到出口（默认为右下角）的路线。
输入
第一行一个n。
第二行开始是一个（n+2）（n+2）的矩阵（四周边框为1）
输出
从左上角（1，1）到右下角（n，n）的序列。
测试用例确保具有通路

迷宫问题，采用bfs算法非递归实现，不仅可以求出通路而且可以求出所有通路中最短通途。

/* 测试数据 
6
0 1 0 1 0 1
0 1 0 0 0 1
0 1 0 1 0 1
0 1 0 1 0 1
0 1 0 1 0 1
0 0 0 1 0 0
输出
(1,1)
(2,1)
(3,1)
(4,1)
(5,1)
(6,1)
(6,2)
(6,3)
(5,3)
(4,3)
(3,3)
(2,3)
(2,4)
(2,5)
(3,5)
(4,5)
(5,5)
(6,5)
(6,6)
*/ 
#include "iostream"
using namespace std;
class stay		//stay类 记录每一步 
{
	public:
		int x,y,s;		// xy为地图中坐标，s为从原点到当前位置的步数  ox oy为上一步的位置 
		int ox,oy;	
};
int dx[4]={0,1,-1,0};		//地图内四个方向 
int dy[4]={1,0,0,-1}; 
int main()
{
	stay stay[2500];
	int n,nowstay=1,nowtier=1;
	int a[50][50]={0},b[50][50]={0};		//地图 
	int c[1000],m=0;		//存储可行路径 
	int k=0,tier=0;
	int tx=0,ty=0;
	int end=0,zj=0;

	cin>>n;
	for(int i=0;i<n;i++)				//输入地图 
	{
		for(int j=0;j<n;j++)
		{
			cin>>a[i][j];
		}
	}
	
	stay[k].x=0;						//初始化 
	stay[k].y=0;
	stay[k].s=0;
	b[0][0]=1;
	k++;
	
	while(tier<k)						//bfs 每次循环为下一步的四种走法 
	{
		for(int i=0;i<4;i++)			
		{
			tx=stay[tier].x+dx[i];
			ty=stay[tier].y+dy[i];
			if(tx<0||tx>=n||ty<0||ty>=n)			//边界 
			{
				continue;
			}
			if(a[tx][ty]!=1&&b[tx][ty]!=1)			//可行路 
			{
				b[tx][ty]=1;
				stay[k].x=tx;
				stay[k].y=ty;
				stay[k].s=stay[tier].s+1;
				stay[k].ox=stay[tier].x;
				stay[k].oy=stay[tier].y;
				k++;
			}
			if(tx==n-1&&ty==n-1)
			{
				zj=k-1;
				end=1;
				break;
			}
		}	
		if(end==1)
		{
			tier++;
			break;
		}
		tier++;
	}
	c[m]=stay[zj].x ;
	m++;
	c[m]=stay[zj].y;
	m++;
	for(int i=stay[tier].s;i>=0;i--)				// 通过最后走到终点的这一步去寻找上一步并存放在数组c中，一直找到原点 
	{
		for(int j=0;j<zj;j++)
		{
			if(stay[j].s==i&&stay[j].x==stay[zj].ox&&stay[j].y==stay[zj].oy)
			{
				c[m]=stay[j].x ;
				m++;
				c[m]=stay[j].y;
				m++;
				zj=j;
			}
		}
	}
	for(int i=m-1;i>=0;i=i-2)
	{
		cout<<"("<<c[i-1]+1<<","<<c[i]+1<<")"<<endl;
	}
	return 0;
 }