c语言bfs记录迷宫中的位置,迷宫问题——bfs练习（记录路径）

定义一个二维数组：

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

#include

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

{

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<

else

{

Print(queue[now.pre]);

cout<

}

}

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;

}