bfs

 1 #include<iostream>
 2 #include<queue>
 3 using namespace std;
 4 const int INF = 100000000;
 5 const int maxn = 10000;
 6 typedef pair<int, int> P;    //储存坐标下x,y
 7 int maze[maxn][maxn];
 8 int d[maxn][maxn];            //储存每个坐标的最短路径
 9 int sx, sy;                    //起始坐标
10 int ex, ey;                    //终点坐标
11 int dx[4] = { 1,0,-1,0 };
12 int dy[4] = { 0,1,0,-1 };
13 int bfs()
14 {
15     queue<P> que;            //bfs用队列
16     for (int i = 0; i < maxn; i++) {        //初始化所有距离为极大
17         for (int j = 0; j < maxn; j++) {
18             d[i][j] = INF;
19         }
20     }
21     que.push(P(sx, sy));
22     d[sx][sy] = 0;
23     while (que.size()) {
24         P p = que.front();
25         que.pop();
26         if (p.first == ex && p.second == ey)
27             break;
28         for (int i = 0; i < 4; i++) {
29             int nx = p.first + dx[i];
30             int ny = p.second + dy[i];
31             if (nx >= 0 && nx < N && ny >= 0 && ny < N && d[nx][ny] == INF && maze[nx][ny] == ) {
32                 que.push(P(nx, ny));
33                 d[nx][ny] = d[p.first][p.second] + 1;
34             }
35         }
36     }
37     return d[ex][ey];
38 }

 

posted @ 2019-03-25 21:36  Coodyzのblog  阅读(134)  评论(0编辑  收藏  举报