POJ 3984 迷宫问题

迷宫问题

Time Limit: 1000MS		Memory Limit: 65536K
Total Submissions: 30044		Accepted: 17268

Description

定义一个二维数组： 

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)

题中是让找最短路径，用深搜的话只是可以找出是否存在路径，所以我们就用广搜来做，这道题跟我们平常做的题有些不同的是，这道题需要求得是具体路径，但是我们可以用一个father数组标记该节点的父结点，因为先搜索到这的点一定是会比后来搜索过来的点的路径要短，所以该点的父结点就唯一确认了

#include<stdio.h>
#include<string.h> 
#include<queue>
using namespace std;
int map[7][7];//记录图
int dir[4][2]={{1,0},{-1,0},{0,1},{0,-1}};//方向 
struct Node{
	int x,y;
}; 
Node father[7][7];//存储节点在遍历过程中的父结点 
void printf_result(){
	//因为需要按顺序输出，而我们现在只能从结尾逆向找回去，所以应该是还需要一个数组存储路径
	Node path[50];
	int count=0;//存储一下从终点到起点一共需要走多少步
	path[count].x=5;
	path[count].y=5;
	while(1){
		if(path[count].x==1&&path[count].y==1)
		break;
		path[count+1]=father[path[count].x][path[count].y];
		count++;
	} 
	while(count>=0){
		printf("(%d, %d)\n",path[count].x-1,path[count].y-1);
		count--;
	}
}
void bfs(){
	queue<Node>q;
	Node start;
	start.x=1;
	start.y=1;
	q.push(start);
	while(!q.empty()){
		Node s=q.front();
		q.pop();
		if(s.x==5&&s.y==5){
			printf_result();
			return ;
		}
		for(int i=0;i<4;i++){
			Node s2;
			s2.x=s.x+dir[i][0];
			s2.y=s.y+dir[i][1];
			if(map[s2.x][s2.y]==0){
				map[s2.x][s2.y]=1;
				father[s2.x][s2.y]=s;
				q.push(s2);
			} 
		}
	}
} 
int main(){
	memset(map,0,sizeof(map));
	for(int i=0;i<7;i++){//直接标记边界可以避免后续判断，也可以不这样后边判断边界 
		map[0][i]=1;
		map[i][0]=1;
		map[6][i]=1;
		map[i][6]=1;
	}
	for(int i=1;i<=5;i++){//赋值 
		for(int j=1;j<=5;j++){
			scanf("%d",&map[i][j]);
		}
	} 
	bfs();
	return 0;
}