宽度优先搜索——迷宫的最短路径

#include <iostream>
#include <utility>
#include <queue>
using namespace std;
const int INF = 10000000;
typedef pair<int, int> Point;
int sx;//起点坐标
int sy;
int gx;//终点坐标
int gy;
//到各个位置的最短距离的数组
int d[100][100];
//4个方向移动的向量,对应相对于当前点的四个方向(1,0),(0,1),(-1,0),(0,1)
int dx[4] = {1, 0, -1, 0};
int dy[4] = {0, 1, 0, -1};
//求从(sx, sy)到(gx, gy)的最短距离，无法到达则是INF
int dfs(char a[10][11])
{
int M = 10;
int N = 10;
//定义一个队列存储各状态
queue<Point> que;
//把所有位置都初始化为INF
for(int i = 0; i < M; ++i)
{
for(int j = 0; j < N; ++j)
{
d[i][j] = INF;
}
}
//将起始点加入队列并把距离设置为0
que.push(Point(sx, sy));
d[sx][sy] = 0;
//不断循环知道队列的长度为0
while(que.size())
{
//从队首取元素
Point p = que.front();
//删除队首元素，但不返回任何值
que.pop();
//如果所取状态已是终点，则结束搜索
if(p.first == gx && p.second == gy)
break;
//四个方向的循环
for(int k = 0; k < 4; ++k)
{
//移动之后的位置为(nx, ny)
int nx = p.first + dx[k];
int ny = p.second + dy[k];
//判断是否可以移动以及是否是已访问过(d[nx][ny] != INF为已访问过的)
if(0 <= nx && nx < M && 0 <= ny && ny < N && d[nx][ny] == INF && a[nx][ny] != '#')
{
//可以移动的话，则加入到队列，并且到该位置的距离确定为到p的距离 + 1
que.push(Point(nx, ny));
d[nx][ny] = d[p.first][p.second] + 1;
}

}
}
return d[gx][gy];
}

int main()
{
//定义一个迷宫的字符串数组
char maze[10][11] = {
{'#', 'S', '#', '#', '#', '#', '#', '#', '.', '#'},
{'.', '.', '.', '.', '.', '.', '#', '.', '.', '#'},
{'.', '#', '.', '#', '#', '.', '#', '#', '.', '#'},
{'.', '#', '.', '.', '.', '.', '.', '.', '.', '.'},
{'#', '#', '.', '#', '#', '.', '#', '#', '#', '#'},
{'.', '.', '.', '.', '#', '.', '.', '.', '.', '#'},
{'.', '#', '#', '#', '#', '#', '#', '#', '.', '#'},
{'.', '.', '.', '.', '#', '.', '.', '.', '.', '.'},
{'.', '#', '#', '#', '#', '.', '#', '#', '#', '.'},
{'.', '.', '.', '.', '#', '.', '.', '.', 'G', '#'}
};
cin >> sx;
cin >> sy;
cin >> gx;
cin >> gy;
int result = dfs(maze);
cout << result << endl;
return 0;
}