BFS 迷宫问题

001:迷宫问题

总时间限制: 1000ms 内存限制: 65536kB
描述
定义一个二维数组：

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<algorithm>
using namespace std;

int maze[10][10];    //存放迷宫

struct Step{
		int x; //行 
		int y; //列 
		int f; //父节点在队列中的下标 
};

int visited[10][10];        //标记该位置是否入队
Step Queue[50];      //自建队列
int head;  //指向0 
int tail; //指向0  
int dp[4][2]={{1,0},{-1,0},{0,1},{0,-1}};          //搜索顺序
void Print(Step a){             //模拟堆栈
	if(a.f==-1) {
	cout<<"("<<a.x<<", "<<a.y<<")"<<endl;
	return;
	}
	Print(Queue[a.f]);       //进入父节点
	cout<<"("<<a.x<<", "<<a.y<<")"<<endl;
}
int main(){
	for (int i=0;i<5;i++)
		for (int j=0;j<5;j++){
			cin>>maze[i][j];       //保存迷宫
		}
	memset(visited,0,sizeof visited);         //初始化visited
	memset(Queue,0,sizeof Queue);             //初始化队列
	head=tail=0;                         //初始化头尾指针
	                      
	Queue[tail].x=0;            
	Queue[tail].y=0;         
	Queue[tail].f=-1;		//x0,y0,步数0，无父节点
						    
	tail++;	                   //Queue[0]为起点
	visited[0][0]=1;            
	while(tail!=head){          //当队列不为空 
		Step s=Queue[head];       //取出队首 
		if(s.x==4&&s.y==4){       //队首为所求点
		Print(s);
		break;
		}
		else{
			for(int t=0;t<4;t++){         //四种走法，逐个入队
				int x1=s.x+dp[t][0];
				int y1=s.y +dp[t][1];
				if(x1>=0&&x1<5&&y1>=0&&y1<5&& !visited[x1][y1]&&maze[x1][y1]==0){
				Queue[tail].x=x1;
				Queue[tail].y=y1;
				Queue[tail].f=head;
				visited[x1][y1]=1;
				tail++;
				}
			}
			head++;
		}
	}
	return 0;
}