bzoj 1671: [Usaco2005 Dec]Knights of Ni 骑士【bfs】

bfs预处理出每个点s和t的距离d1和d2（无法到达标为inf），然后在若干灌木丛格子(x,y)里取min(d1[x][y]+d2[x][y])

/*
  0：贝茜可以通过的空地
    1：由于各种原因而不可通行的区域
    2：贝茜现在所在的位置
    3：骑士们的位置
    4：长着贝茜需要的灌木的土地
*/
#include<iostream>
#include<cstdio>
#include<queue>
#include<cstring>
using namespace std;
const int N=1005,inf=1e9,dx[]={-1,1,0,0},dy[]={0,0,-1,1};
int n,m,a[N][N],d1[N][N],d2[N][N],ans=inf;
bool v[N][N];
struct qwe
{
    int x,y,p;
    qwe(int X=0,int Y=0,int P=0)
    {
        x=X,y=Y,p=P;
    }
}s,t;
int read()
{
    int r=0,f=1;
    char p=getchar();
    while(p>'9'||p<'0')
    {
        if(p=='-')
            f=-1;
        p=getchar();
    }
    while(p>='0'&&p<='9')
    {
        r=r*10+p-48;
        p=getchar();
    }
    return r*f;
}
bool ok(int x,int y)
{
    return x>=1&&x<=n&&y>=1&&y<=m&&!v[x][y]&&a[x][y]!=1;
}
void bfs(qwe s)
{
    queue<qwe>q;
    memset(v,0,sizeof(v));
    for(int i=1;i<=n;i++)
        for(int j=1;j<=m;j++)
            d2[i][j]=inf;
    v[s.x][s.y]=1;
    d2[s.x][s.y]=0;
    q.push(s);
    while(!q.empty())
    {
        qwe u=q.front();
        q.pop();
        for(int i=0;i<4;i++)
            if(ok(u.x+dx[i],u.y+dy[i]))
            {
                v[u.x+dx[i]][u.y+dy[i]]=1;
                d2[u.x+dx[i]][u.y+dy[i]]=u.p+1;
                q.push(qwe(u.x+dx[i],u.y+dy[i],u.p+1));
            }
    }
}
int main()
{
    m=read(),n=read();
    for(int i=1;i<=n;i++)
        for(int j=1;j<=m;j++)
        {
            a[i][j]=read();
            if(a[i][j]==2)
                s=qwe(i,j,0);
            if(a[i][j]==3)
                t=qwe(i,j,0),a[i][j]=1;
        }
    bfs(s);
    for(int i=1;i<=n;i++)
        for(int j=1;j<=m;j++)
            d1[i][j]=d2[i][j];
    a[t.x][t.y]=3;
    bfs(t);
    for(int i=1;i<=n;i++)
        for(int j=1;j<=m;j++)
            if(a[i][j]==4)
                ans=min(ans,d1[i][j]+d2[i][j]);
    printf("%d\n",ans);
    return 0;
}