迷宫问题

 迷宫问题

Time Limit:1000MS     Memory Limit:65536KB     64bit IO Format:%I64d & %I64u

Submit Status Practice POJ 3984

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 00 1 0 1 00 0 0 0 00 1 1 1 00 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<stdio.h>#include<queue>#include<string.h>using namespace std;struct node{int h;int x;int y;int pre;}f[26];int a[5][5],biao=1,flag,d;int c[4][2]={{0,-1},{0,1},{-1,0},{1,0}};int vis[5][5];node f1[100];queue<node>q;void dfs(int z){f1[d].x=f[z].x;f1[d].y=f[z].y;d++;if(z==0)return;dfs(f[z].pre);}void bfs(int x,int y){while(!q.empty()){for(int i=0;i<=3;i++){   intxx=q.front().x+c[i][0];   intyy=q.front().y+c[i][1];if(xx>=0&&xx<=4&&yy>=0&&yy<=4&&a[xx][yy]==0&&vis[xx][yy]==0){vis[xx][yy]=1;f[biao].x=xx;f[biao].y=yy;f[biao].pre=q.front().h;f[biao].h=biao;q.push(f[biao]);biao++;}if(xx==4&&yy==4){flag=1;break;}}q.pop();if(flag)break;}}int main(){int i,j;flag=0;d=0;memset(vis,0,sizeof(vis));for(i=0;i<5;i++){for(j=0;j<5;j++){scanf("%d",&a[i][j]);}}f[0].x=0;f[0].y=0;f[0].h=0;f[0].pre=0;vis[0][0]=1;q.push(f[0]);bfs(0,0);/*for(i=0;i<=25;i++){printf("%d ",f[i].pre);}*/for(i=1;;i++){if(f[i].x==4&&f[i].y==4){//printf("%d\n",i);dfs(i);break;}}//printf("%d %d\n",f1[0].x,f1[0].y);for(i=d-1;i>=0;i--){printf("(%d, %d)\n",f1[i].x,f1[i].y);}}