Description
定义一个二维数组:
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<iostream>
#include<stdio.h>
using namespace std;
struct node{
int x;
int y;
int pre;
}path[100];
int dirx[4]={0,0,1,-1};
int diry[4]={1,-1,0,0};
int map[5][5];
int front=0,rear=1;
void print(int i){
if(path[i].pre!=-1){ //找到始点后再开始输出节点
print(path[i].pre);
printf("(%d, %d)\n",path[i].x,path[i].y);
}
else
printf("(%d, %d)\n",path[i].x,path[i].y);
}
void WFS(int x, int y){
path[front].x=x;
path[front].y=y;
path[front].pre=-1;
map[x][y]=1;
bool flag=false;
while(front<rear){
for(int i=0; i<4; ++i){
int px=path[front].x+dirx[i];
int py=path[front].y+diry[i];
if(px<0||py<0||px>4||py>4||map[px][py])
continue;
else{
map[px][py]=1;
path[rear].x=px; //入队
path[rear].y=py;
path[rear].pre=front;
rear++;
}
if(px==4 && py==4){
print(rear-1);
flag=true;
break;
}
}
front++;
if(flag)
break;
}
}
int main(){
for(int i=0;i<5;++i)
for(int j=0; j<5; ++j)
scanf("%d",&map[i][j]);
WFS(0,0);
return 0;
}