迷宫问题(最短路+记录路径)

定义一个二维数组:

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<bits/stdc++.h>
using namespace std;
int to[10][2]={0,1,1,0,0,-1,-1,0};
int a[10][10],book[10][10];
struct z{
	int x,y,l,t1[110],t2[110];  //t1和 t2数组用来记录路径 
}u,v;
queue<z> q;
int main()
{
	int i,j,tx,ty;
	for(i=0;i<5;i++)
		for(j=0;j<5;j++)
		scanf("%d",&a[i][j]);
	memset(book,0,sizeof(book));
	u.x=0;
	u.y=0;
	u.l=0;
	u.t1[0]=0;
	u.t2[0]=0;
	book[0][0]=0;
	q.push(u);
	while(!q.empty())
	{
		u=q.front();
		q.pop();
		if(u.x==4&&u.y==4)
		{
			for(i=0;i<u.l;i++)
			printf("(%d, %d)\n",u.t1[i],u.t2[i]);
			printf("(4, 4)\n");
		}
		v=u;
		for(i=0;i<4;i++)
		{
			tx=u.x+to[i][0];
			ty=u.y+to[i][1];
			if(tx>=0&&tx<5&&ty>=0&&ty<5&&!a[tx][ty]&&!book[tx][ty])
			{
				book[tx][ty]=1;
				v.x=tx;
				v.y=ty;
				v.l=u.l+1;
				v.t1[v.l]=tx;
				v.t2[v.l]=ty;
				q.push(v);
			}
		}
	}
	return 0;
}
上一篇:算法分析--图的搜索


下一篇:方格分割