poj 3984 迷宫问题 BFS+栈的使用

1. #include <stdio.h>  
2. #include <algorithm>  
3. #include <string.h>  
4. #include <queue>  
5. #include <stack>  
6. using namespace std;  
7. int dir[]={-1,0,1,0};  ///上下左右四个移动方向
8. int dil[]={0,-1,0,1};  
9. int num[6][6];  
10. int visit[6][6];  ///表明当前位置是否访问
11. int d[30];  
12. struct node  
13. {  
14.     int x,y,id;  
15. }a[30];  
16. int cet;  
17. 
    
18. void bfs()  
19. {  
20.     queue<node>q;  
21.     cet = 0;  
22.     a[cet].x = 0;  
23.     a[cet].y = 0;  
24.     a[cet].id = 0;  
25.     d[0]=-1;  
26.     q.push(a[cet]);  
27.     bool flag = true;  
28.     while(!q.empty()&&flag)  ///队列非空且未找到出口
29.     {  
30.         node xx = q.front();  
31.         int t = xx.id;  
32.         q.pop();  
33.         visit[xx.x][xx.y] = true;  
34.         for(int k=0;k<=3;k++)  
35.         {  
36.             int p = xx.x+dir[k];  
37.             int v = xx.y+dil[k];  
38.             if(!visit[p][v]&&num[p][v]!=1&&p>=0&&p<5&&v>=0&&v<5)  
39.             {  
40.                 cet++;  
41.                 d[cet] = t;  
42.                 a[cet].x = p;  
43.                 a[cet].y = v;  
44.                 a[cet].id = cet;  
45.                 q.push(a[cet]);  
46.                 if(a[cet].x==4&&a[cet].y==4)  ///找到出口，强制中断，退出搜索
47.                 {  
48.                     flag = false;  
49.                     break;  
50.                 }  
51.             }  
52.         }  
53.     }  
54. }  
55. int main()  
56. {  
57.     for(int i=0;i<5;i++)  
58.     {  
59.         for(int j=0;j<5;j++)  
60.         {  
61.             scanf("%d",&num[i][j]);  
62.             visit[i][j] = false;  
63.         }  
64.     }  
65.     memset(d,-1,sizeof(d));  
66.     bfs();  
67.     stack<node>st;  
68.     while(cet>=0)  ///搜索出路径之后，根据之前搜索的信息，将路径反压入栈中，从而进行输出
69.     {  
70.         st.push(a[cet]);  
71.         cet=d[cet];  
72.     }  
73.     while(!st.empty())  
74.     {  
75.         node ll = st.top();  
76.         printf("(%d, %d)\n",ll.x,ll.y);  
77.         st.pop();  
78.     }  
79.     return 0;  
80. }