算法基础：4127:迷宫问题--广度优先搜索算法

题目：
定义一个矩阵：
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 <queue>
#include <vector>
#include <cstring>
using namespace std;

int visited[6][6];//保存每个点的访问情况 
int a[6][6];
struct Node{
	int x,y,i;//i是保存这个坐标的上一个坐标即路径 
	Node(int xx,int yy,int ii):x(xx),y(yy),i(ii){}
};

vector<Node> q;
int main()
{
	for(int i=0;i<5;i++)
		for(int j=0;j<5;j++)
			cin>>a[i][j];
	memset(visited,0,sizeof(visited));
	q.push_back(Node(0,0,-1));
	visited[0][0]=1;
	int c=0;
	while(1){
		if(q[c].x==4&&q[c].y==4)break;//到达终点结束
		 
		if(q[c].x-1>=0&&visited[q[c].x-1][q[c].y]==0&&a[q[c].x-1][q[c].y]==0){//向左移 
			q.push_back(Node(q[c].x-1,q[c].y,c));
			visited[q[c].x-1][q[c].y]=1;
		}
		if(q[c].x+1<=4&&visited[q[c].x+1][q[c].y]==0&&a[q[c].x+1][q[c].y]==0){//向下移 
			q.push_back(Node(q[c].x+1,q[c].y,c));
			visited[q[c].x+1][q[c].y]=1;
		}
		if(q[c].y-1>=0&&visited[q[c].x][q[c].y-1]==0&&a[q[c].x][q[c].y-1]==0){//向上移 
			q.push_back(Node(q[c].x,q[c].y-1,c));
			visited[q[c].x][q[c].y-1]=1;
		}
		if(q[c].y+1<=4&&visited[q[c].x][q[c].y+1]==0&&a[q[c].x][q[c].y+1]==0){//向下移 
			q.push_back(Node(q[c].x,q[c].y+1,c));
			visited[q[c].x][q[c].y+1]=1;
		}
		c++;
	}
	int i=q.size()-1;
	int num[100];
	int inum=0;
	
	while(1){//将反序的路径正序化 
		if(i==-1)break;
		num[inum]=i;
		i=q[i].i;
		inum++;
	} 
	
	for(int i=inum-1;i>=0;i--){
		cout<<"("<<q[num[i]].x<<", "<<q[num[i]].y<<")"<<endl;
	}
	return 0;
}

这是一个标准的广度优先搜索算法。将初始起点放入队列，然后搜索上下左右看能否满足条件，如果满足条件则搜索，并且将本坐标信息放入其中。
满足条件：1.是否越界2.是否被访问过3.是否是通路
最后将从末尾到起点的路径取出
注意：因为要取出路径，所以尽量不要使用队列，可以用数组代替。