搜索 || 二维宽搜（走迷宫）

F - 迷宫问题

定义一个二维数组： 
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表示可以走的路，只能横着走或竖着走，不能斜着走，要求编程序找出从左上角到右下角的最短路线。
Input
一个5 × 5的二维数组，表示一个迷宫。数据保证有唯一解。
Output
左上角到右下角的最短路径，格式如样例所示。
Sample Input
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
Sample Output
(0, 0)
(1, 0)
(2, 0)
(2, 1)
(2, 2)
(2, 3)
(2, 4)
(3, 4)
(4, 4)

#include<stdio.h>
#include<queue>
#include<stack>
#include<memory.h>
#include<iostream>
using namespace std;
int n;
struct pos{
	int x;
	int y;
};
int f[5][5];//标记是否走过且保存上一步坐标
int a[5][5];
int dx[4]={1,-1,0,0};
int dy[4]={0,0,1,-1};

void input(pos a){
	stack<pos> s;
	pos b=a;
	pos c;
	printf("(%d, %d)\n",0,0);
	while(f[b.x][b.y]!=-2){
		s.push(b);
		c.x=f[b.x][b.y]/10;
		c.y=f[b.x][b.y]%10;
		b=c;
	}
	while(!s.empty()){
		b=s.top();
		s.pop();
		printf("(%d, %d)\n",b.x,b.y);
	}
}
void bfs(int x,int y){
	queue<pos> q;
	pos sp;
	sp.x=x;
	sp.y=y;
	f[x][y]=-2;
	q.push(sp);
	while(!q.empty()){
		pos old =q.front();
		if(old.x==4&&old.y==4){
 			input(old);
			break;
		}
		q.pop();
		pos now;
		for(int i=0;i<4;i++){
			now.x=old.x+dx[i];
			now.y=old.y+dy[i];
			if(now.x>=0&&now.y>=0&&now.x<5&&now.y<5&&a[now.x][now.y]==0&&f[now.x][now.y]==-1){
				f[now.x][now.y]=old.x*10+old.y;
				q.push(now);
			}
		}
	}
}

int main(){
	
	n=5;
	for(int i=0;i<5;i++){
		for(int j=0;j<5;j++){
			scanf("%d",&a[i][j]);
		}
	}
	memset(f,-1,sizeof(f));
	bfs(0,0);

	return 0;
}