http://poj.org/problem?id=3984
Description
定义一个二维数组:
它表示一个迷宫,其中的1表示墙壁,0表示可以走的路,只能横着走或竖着走,不能斜着走,要求编程序找出从左上角到右下角的最短路线。
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 <iostream>
#include <queue>
#include <stack>
using namespace std;
struct note//定义结构体用于存放横纵坐标,输出时使用
{
int x,y;
};
note dis[5][5];//用于存放到达(x,y)点的上一个点的横纵坐标,以便输出最短的路径
int abc[5][5];//输入的各点
bool di[5][5];//标记在搜索是点是否已经搜索过
stack <note> P;//定义一个栈,输出时采用出栈的形式
void sta(int i,int j)//途径上各点的入栈操作函数(利用栈的先进先出的特点)
{
if(i==0&&j==0)//因为(0,0)点没有前面一个点,因此不必有进栈直接输出就行
{
printf("(0, 0)\n");
return;
}
else
{
note p;
p.x=i;
p.y=j;
P.push(p);
sta(dis[i][j].x,dis[i][j].y);//递归,进栈
}
}
void bfs()//搜索
{
queue < note > Q;//定义队列
note a,b,c,d;
a.x=0;
a.y=0;
int i;
di[0][0]=1;
int dx[]= {1,0,-1,0};
int dy[]= {0,1,0,-1};
Q.push(a);
dis[0][0].x=0;
dis[0][0].y=0;
int xx,yy;
while(!Q.empty())//队列为空时跳出
{
c=Q.front();//去除队列中的第一个元素
Q.pop();//删除第一个元素
for(i=0; i<4; i++)
{
xx=dx[i]+c.x;
yy=dy[i]+c.y;
if(xx==4&&yy==4)
{
sta(c.x,c.y);//如果成立开始进栈
return;
}
if(xx>=0&&yy>=0&&xx<5&&yy<5&&abc[xx][yy]==0&&!di[xx][yy])
{
dis[xx][yy].x=c.x;//记录到达这一点上一点的横纵坐标
dis[xx][yy].y=c.y;
d.x=xx;
d.y=yy;
Q.push(d);
di[xx][yy]=1;//标记已经遍历过该点
}
}
}
}
int main()
{
for(int i=0; i<5; i++)
for(int j=0; j<5; j++)
{
scanf("%d",&abc[i][j]);
}
bfs();
while(!P.empty())
{
printf("(%d, %d)\n",P.top().x,P.top().y);
P.pop();
}
printf("(4, 4)\n");//因最后一个点的横纵坐标未进栈,必须单独输出
return 0;
}