最短路径：孙悟空找唐僧

问题描述：

唐僧被妖怪关在迷宫中。孙悟空好不容易找到一张迷宫地图，并通过一个魔法门来到来到迷宫某个位置。假设迷宫是一个n*m的矩阵，它有两种地形，0表示平地，1表示沼泽，孙悟空只能停留在平地上。孙悟空目前的位置在坐标(sx,sy)处，他可以向上下左右四个方向移动。
请你帮助孙悟空计算一下，迷宫中是否存在一条路从他所在位置(sx,sy)到达唐僧所在位置(tx,ty)，如果有，请计算出最短的一条路径。

输入描述：

每个测试样例的第1行是2个正整数n (1≤n≤100)，m (1≤m≤100)，表示迷宫是n*m的矩阵。接下来的n行输入迷宫，每行有m个数字（0或者1），数字之间用一个空格间隔。
接下来的1行是4个整数sx,sy,tx,ty，1≤sx,tx≤n，1≤sy,ty≤m，表示孙悟空所在位置为第sx行第sy列，唐僧所在位置为第tx行第tx列。迷宫左上角编号是(1,1)，右下角编号是(n, m)。
数据保证(sx,sy)格和(tx,ty)必定为平地，且孙悟空的初始位置（sx, sy)并不在唐僧所在格(tx, ty)。

输出描述：

输出孙悟空到达唐僧处所需经过的最短路径，如果不能到达，请输出“No”

输入样例1：

2 2
0 1
1 0
1 1 2 2

输出样例1：

No

输入样例2：

4 4 
0 0 0 1
0 1 0 0
0 1 0 0 
0 0 0 1
1 1 3 4

输出样例2：

5

#include <iostream>
#include <queue>
using namespace std;

int g[100][100];
int n, m;

struct point{
    int x, y;
    point(int xn = 0, int yn = 0) : x(xn), y(yn) {}
    bool operator==(const point& p){
        return (x == p.x) && (y == p.y);
    }
    bool operator!=(const point& p){
        return (x != p.x) || (y != p.y);
    }
};

bool get_nbr(const point& p, point& nbr){
    if(p.x > 0 && g[p.x-1][p.y] == 0){
        nbr.x = p.x - 1; nbr.y = p.y;
        g[nbr.x][nbr.y] = 1;
        return true;
    }
    if(p.x < n-1 && g[p.x+1][p.y] == 0){
        nbr.x = p.x+1; nbr.y = p.y;
        g[nbr.x][nbr.y] = 1;
        return true;
    }
    if(p.y > 0 && g[p.x][p.y-1] == 0){
        nbr.x = p.x; nbr.y = p.y-1;
        g[nbr.x][nbr.y] = 1;
        return true;
    }
    if(p.y < m-1 && g[p.x][p.y+1] == 0){
        nbr.x = p.x; nbr.y = p.y+1;
        g[nbr.x][nbr.y] = 1;
        return true;
    }

    return false;
}

int main(){
    int tx, ty, sx, sy;
    point p, nbr;
    cin >> n >> m;
    for(int i = 0; i < n; i++)
    for(int j = 0; j < m; j++) cin >> g[i][j];
    cin >> sx >> sy >> tx >> ty;
    sx--; sy--; tx--; ty--;

    queue<point> q;
    q.push(point(sx, sy));

   g[sx][sy] = 1;
    int step = 0, new_t = 0, old_t = 1;

    while(!q.empty() && q.front() != point(tx, ty)){
        p = q.front();
        while(get_nbr(p, nbr)){
            q.push(nbr);
            new_t++;
        }

        q.pop();
        old_t--;

        if(old_t == 0){
            old_t = new_t;
            new_t = 0;
            step++;
        }
    }
    if(q.front() == point(tx, ty))
        cout << step;
    else cout << "No";
    return 0;
}