迷宫-最短路径距离-BFS

已知条件：

迷宫地图：0-不通，1通

二维数组（N*M）

0 0 0 0 0 0 0 0

0 1 1 0 0 1 0 0

0 0 1 1 1 1 0 0

0 1 1 1 0 1 1 1

1 1 1 0 0 0 0 1

起始点:s(2,2)

求解所有可通过的点到起始点的最短距离。

算法：

#include <iostream>#include <queue>#include <fstream>#include <string>using namespace std;typedef pair<int,int> Pos;int N,M;//下、右、上、左四个方向int dx[4]={1,0,-1,0};int dy[4]={0,1,0,-1};int *src;//迷宫信息数组int *dist;//各位置到起始点的最短路径距离int sx,sy;//起始点位置 //从文件中读取迷宫地图数据void readData(){fstream in;char c;in.open("maze.txt");int k = 0;        int n = 0;       while(!in.eof()){in>>c;if(c == '\n' || c == ' '){                    n++;}else{src[k++] = c - '0';}}       in.close();        N = n;        M = k/n;        src = new int[N*M]; //分配迷宫数组dist = new int [N*M]; //分配距离数组}//利用BFS计算路径距离void bfs(int ex, int ey)//输入终点位置{    queue<Pos> que;int d[N][M]; //临时距离数组    for(unsigned int i = 0; i < N; i++)    {        for(unsigned int j = 0; j < M; j++)        {            d[i*N + j] = -1;        }    }    que.push(Pos(sx,sy));    d[sx * N + sy] = 0;    while(que.size())    {        Pos p = que.front();        que.pop();        if(p.first == ex && p.second == ey)            break;        for(unsigned int i = 0; i < 4; i++)        {            int x = p.first + dx[i];            int y = p.second + dy[i];            if(0 <= x && x < N && 0 <= y && y < M && src[x * N + y] != 0 && d[x * N + y] == -1)            {                que.push(P(nx,ny));                d[x * N + y] = d[p.first*N + p.second] + 1;                            dist[x * N + y] = d[x * N + y]; //更新距离数组            }        }    }}int main(){    readData();    for(int i = 0; i < N; i++){for(int j = 0; j < N; j++){if(src[i * N + j] == 1 && dist[i * N+ j] == -1)//跳过计算过的位置         {            bfs(i,j);         }}}    return 0;}