定义一个二维数组:
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<cstdio>
#include<cstring>
#include<queue>
#include<iostream>
using namespace std;
int vis[6][6];
int mp[6][6];
int d[4][2] = {{0, 1}, {0, -1}, {1, 0}, {-1, 0}};
struct node{
int x, y;
};
node pre[6][6];
void print(){//逆序输出
node lu[100];
int i = 0;
lu[i].x = lu[i].y = 4;
//printf("(%d, %d)\n", lu[i].x, lu[i].y);
for(;;){
if(lu[i].x == 0 && lu[i].y == 0)
break;
else{
lu[i+1] = pre[lu[i].x][lu[i].y];
}
i++;
}
// cout << "i = " << i << endl;
while(i >= 0){
printf("(%d, %d)\n", lu[i].x, lu[i].y);
i--;
}
}
void bfs(){
queue<node> q;
node a, ne;
vis[0][0] = 1;
q.push(node{0, 0});
while(!q.empty()){
a = q.front();
q.pop();
if(a.x == 4 && a.y == 4){
print();
return ;
}
for(int i = 0; i < 4; i++){
ne.x = a.x + d[i][0];
ne.y = a.y + d[i][1];
if(!vis[ne.x][ne.y] && ne.x >=0 && ne.y >= 0 && ne.x < 5 && ne.y < 5 && mp[ne.x][ne.y] != 1){
q.push(ne);
//cout << "ne.x = " << ne.x << " ne.y = " << ne.y << endl;
pre[ne.x][ne.y] = a;
//cout << "pre.x = " << pre[ne.x][ne.y].x << " pre.y = " << pre[ne.x][ne.y].y << endl;
vis[ne.x][ne.y] = 1;
}
}
}
}
int main(){
for(int i = 0; i < 5; i++){
for(int j = 0; j < 5; j++){
scanf("%d", &mp[i][j]);
}
}
memset(vis, 0, sizeof(vis));
bfs();
return 0;
}