hdu1175 连连看 （BFS+优先队列）

Problem Description
“连连看”相信很多人都玩过。没玩过也没关系，下面我给大家介绍一下游戏规则：在一个棋盘中，放了很多的棋子。如果某两个相同的棋子，可以通过一条线连起来（这条线不能经过其它棋子），而且线的转折次数不超过两次，那么这两个棋子就可以在棋盘上消去。不好意思，由于我以前没有玩过连连看，咨询了同学的意见，连线不能从外面绕过去的，但事实上这是错的。现在已经酿成大祸，就只能将错就错了，连线不能从外围绕过。
玩家鼠标先后点击两块棋子，试图将他们消去，然后游戏的后台判断这两个方格能不能消去。现在你的任务就是写这个后台程序。
Input
输入数据有多组。每组数据的第一行有两个正整数n,m(0 < n< = 1000,0 < m < 1000)，分别表示棋盘的行数与列数。在接下来的n行中，每行有m个非负整数描述棋盘的方格分布。0表示这个位置没有棋子，正整数表示棋子的类型。接下来的一行是一个正整数q(0

#include<cstdio>
#include<cstring>
#include<queue>
#include<algorithm>
using namespace std;
struct node
{
    int x,y,t,fear;
    friend bool operator<(node a,node b)
    {
        return a.t>b.t;
    }
};
int map[1005][1005],n,m;
int zx,zy,dx,dy,flag;
int mark[1005][1005];
int vis[4][2]={0,1,0,-1,1,0,-1,0};
int ok(int x,int y)
{
    if(x>0&&x<=n&&y>0&&y<=m&&map[x][y]==0)
        return 1;
    else
        return 0;
}
void bfs()
{
    node q,p;
    q.x=dx,q.y=dy,q.t=0,q.fear=-1;
    priority_queue<node>que;
    que.push(q);
    while(que.size())
    {
        q=que.top();
        que.pop();
        if(q.x==zx&&q.y==zy)
        {
            flag=1;
            return;
        }
        for(int i=0;i<=3;i++)
        {
            p.x=q.x+vis[i][0];
            p.y=q.y+vis[i][1];
            p.fear=i;
            if(mark[p.x][p.y])
            {
                if(p.fear==q.fear)
                {
                    if(q.t<=mark[p.x][p.y])
                        mark[p.x][p.y]=0;
                }
                else
                {
                    if(q.t+1<=mark[p.x][p.y])
                        mark[p.x][p.y]=0;
                }
            }
            if(ok(p.x,p.y)&&!mark[p.x][p.y]||(p.x==zx&&p.y==zy))
            {
                if(p.fear!=q.fear)
                    p.t=q.t+1;
                else
                    p.t=q.t;
                mark[p.x][p.y]=p.t;
                if(p.t<=3)
                   que.push(p);
            }
        }
    }
}
int main()
{
    while(scanf("%d%d",&n,&m),n||m)
    {
        for(int i=1;i<=n;i++)
            for(int j=1;j<=m;j++)
                scanf("%d",&map[i][j]);
        int T;
        scanf("%d",&T);
        while(T--)
        {
            memset(mark,0,sizeof(mark));
            scanf("%d%d%d%d",&dx,&dy,&zx,&zy);
            mark[dx][dy]=1;
            if(map[dx][dy]!=map[zx][zy])
            {
                printf("NO\n");
                continue;
            }
            if(map[dx][dy]==0)
            {
                printf("NO\n");
                continue;
            }
            if(dx==zx&&dy==zy)
            {
                printf("NO\n");
                continue;
            }
            flag=0;
            bfs();
            if(flag)
                printf("YES\n");
            else
                printf("NO\n");
        }
    }
}