迷宫问题

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>
using namespace std;
int map[5][5];
int dx[4]= {1,-1,0,0};
int dy[4]= {0,0,-1,1};
int front=0,rear=1;
struct node
{
int x,y,pre;
} q[100];
void print(int i)//输出过程
{
if(q[i].pre!=-1)
{
print(q[i].pre);
cout<<"("<<q[i].x<<", "<<q[i].y<<")"<<endl;

}
}
void bfs(int x1,int y1)//广搜
{
q[front].x=x1;
q[front].y=y1;
q[front].pre=-1;
while(front<rear)//当队列不空
{
for(int i=0; i<4; i++) //搜索可达的路径
{
int a=dx[i]+q[front].x;
int b=dy[i]+q[front].y;
if(a<0||a>=5||b<0||b>=5||map[a][b])//是否在迷宫内，是否可行
continue;
else
{
map[a][b]=1; //走过的路做标记
q[rear].x=a;    //记录的是下一个front的值（front++）
q[rear].y=b;
q[rear].pre=front;
//     cout<<'('<<q[rear].x<<'.'<<q[rear].y<<')'<<"   "<<"q["<<rear<<"].pre="<<q[rear].pre<<"   "<<"  rear="<<rear<<"  front="<<front<<endl;

rear++; //入队
}
if(a==4&&b==4)
{
// cout<<front<<"kkkkkk"<<endl;
print(front);
}
}
front++;//出队

}
}

int main()
{
int i,j;
for(i=0; i<5; i++)
for(j=0; j<5; j++)
cin>>map[i][j];
cout<<"(0, 0)"<<endl;
bfs(0, 0);
cout<<"(4, 4)"<<endl;
return 0;
}