定义一个二维数组:
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)
/*思路很简单,就是需要记录途径有点麻烦,
因此不能再用模板中的队列来做,
因为STL中的队列取出来后不能保存,
所以需要自己弄一个队列,这里的是借鉴了大佬的代码才A出来的;
看了网上很多的代码,大都是自己再写一个队列实现操作;
觉得这个是最好的,
*/
#include<iostream>
#include<cstring>
using namespace std;
int a[5][5];
struct node
{
int x,y;
int pre;
}queue[30];
int rear=0;
int front=0;
int visited[5][5];
int dis[4][2]={{-1,0},{1,0},{0,1},{0,-1}};
void bfs(int sx,int sy, int ex, int ey)
{
queue[0].x=sx;
queue[0].y=sy;
queue[0].pre=-1;
rear++;
visited[sx][sy]=1;
while(front<rear)
{
for(int i = 0;i < 4;i++)
{
int newx=queue[front].x+dis[i][0];
int newy=queue[front].y+dis[i][1];
if(newx<0||newx>=5||newy<0||newy>=5) continue;
if(visited[newx][newy]==1||a[newx][newy]==1) continue;
visited[newx][newy]=1;
queue[rear].x=newx;
queue[rear].y=newy;
queue[rear].pre=front;
rear++;
if(newx==ex&&newy==ey) return ;
}
front++;
}
}
void Print(node now)
{
if(now.pre==-1)
cout<<"("<<now.x<<", "<<now.y<<")"<<endl;
else
{
Print(queue[now.pre]);
cout<<"("<<now.x<<", "<<now.y<<")"<<endl;
}
}
int main()
{
memset(visited,0,sizeof(visited));
for(int i = 0;i < 5;i++)
for(int j = 0;j < 5;j++)
cin >>a[i][j];
bfs(0,0,4,4);
Print(queue[rear-1]);
return 0;
}