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)
依然利用广搜进行解决,注意对路径的存储,用到了栈,要建立一个存储路径的数组,注意两个地方,就是father数组的初始化,以及压栈的条件
#include<iostream> #include<cmath> #include<algorithm> #include<stack> #include<cstring> #include<queue> using namespace std; int maze[5][5]; struct node { int x, y; }; stack<node> way; int d[4][2] = {{0, -1}, {-1, 0}, {0, 1}, {1, 0}}; queue<node> road; int book[5][5]; node father[5][5]; int bfs() { memset(book, 0, sizeof(book)); while(!road.empty()) road.pop(); node now, next; now.x = 0; now.y = 0; father[0][0] = now; road.push(now); book[0][0] = 1; while(!road.empty()) { now = road.front(); road.pop(); int i; for(i=0; i<4; ++i) { next.x = now.x + d[i][0]; next.y = now.y + d[i][1]; if(next.x < 0 || next.x >=5 || next.y < 0 || next.y >=5 || book[next.x][next.y] || maze[next.x][next.y] == 1) continue; father[next.x][next.y] = now; book[next.x][next.y] = 1; road.push(next); if(next.x == 4 && next.y ==4) { return 1; } } } return 0; } int main() { int i, j; for(i=0; i<5; ++i) { for(j=0; j<5; ++j) { scanf("%d", &maze[i][j]); father[i][j].x = i; father[i][j].y = j; } } bfs(); node temp; temp.x = 4, temp.y = 4; while(temp.x!=0 || temp.y!=0) { way.push(temp); temp = father[temp.x][temp.y]; } printf("(0, 0)\n"); while(!way.empty()) { printf("(%d, %d)\n", way.top().x, way.top().y); way.pop(); } return 0; }