营救（广搜练习）

铁塔尼号遇险了！他发出了求救信号。距离最近的哥伦比亚号收到了讯息，时间就是生命，必须尽快赶到那里。

        通过侦测，哥伦比亚号获取了一张海洋图。这张图将海洋部分分化成n*n个比较小的单位，其中用1标明的是陆地，用0标明是海洋。船只能从一个格子，移到相邻的四个格子。

       为了尽快赶到出事地点，哥伦比亚号最少需要走多远的距离。

样例输入

3

001

101

100

1 1 3 3

样例输出

4

 

#include
#include
#include
#include
using namespace std;
const int M=1000+5;

int n,ax,ay,bx,by;
int f[M][M];
int dx[4]={0,-1,0,1};
int dy[4]={1,0,-1,0};
struct point{
    int x,y,step;
};

void bfs(int x,int y,int step){
    queue q;
    point p,tp;
    p.x=ax;p.y=ay;p.step=0;
    for(q.push(p);!q.empty();q.pop()){
        p=q.front();
        if(p.x==bx && p.y==by){
            printf("%d\n",p.step);
            break;
        }
        for(int i=0;i<4;i++){
            tp.x=p.x+dx[i];
            tp.y=p.y+dy[i];
            if(tp.x>0 && tp.x<=n &&
               tp.y>0 && tp.y<=n && f[tp.x][tp.y]==0){
                   f[tp.x][tp.y]=1;
                   tp.step=p.step+1;
                   q.push(tp);
            }    
        }
    }
}

int main()
{
    cin>>n;
    for(int i=1;i<=n;i++){
        string s;
        cin>>s;
        for(int j=1;j<=n;j++)
            if(s[j-1]!='0')
                f[i][j]=1;
    }
    cin>>ax>>ay>>bx>>by;
    if(ax==bx && ay==by) printf("0\n");
    else bfs(ax,ay,0);            
    return 0;
}