杭电 HDU ACM 1175 连连看（麻烦的bfs）

YES
NO
NO
NO
NO
YES 

这个题目当时坑了我一个下午时间……。代码漏洞百出，并且老是出现意想不到的字母打错，并且最坑的一点就是，dir数组 元素排列不一样就错 ，鬼知道为啥。
和我之前做的一个题目很是类似。只需bfs一搜到底，按照层数作为bfs深度，并且队列中只需加入可能能够满足条件的点。在按照层数扩展的过程中，寻找终点

同时加上最开始的些许剪枝。足够优化。
#include<iostream>
#include<sstream>
#include<algorithm>
#include<cstdio>
#include<string.h>
#include<cctype>
#include<string>
#include<cmath>
#include<vector>
#include<stack>
#include<queue>
#include<map>
#include<set>
using namespace std;
const int INF=1003;
int cnt[INF][INF];
int vis[INF][INF];
int dir[4][2] = {{-1,0}, {0, 1}, {1, 0}, {0, -1}};
int n,m;
int sx,sy,ex,ey;
struct Node
{
    int x,y,step;
    Node(int x,int y,int step):x(x),y(y),step(step) {}
    Node() {}
};

void bfs(int x,int y)
{
    queue<Node>q;
    Node next;
    vis[x][y]=1;
    q.push(Node(x,y,0));
    while(!q.empty())
    {
        Node u=q.front();//cout<<"u.x="<<u.x<<"u.y="<<u.y<<"u.step="<<u.step<<endl;
        q.pop();
        for(int i=0; i<4; i++)
        {
            next.x=u.x+dir[i][0];
            next.y=u.y+dir[i][1];
            next.step=u.step;

            while(!vis[next.x][next.y]&&next.step<3&& cnt[next.x][next.y]==0&& next.x>=1&&next.x<=n&&next.y>=1&&next.y<=m)
            {
                vis[next.x][next.y]=1;
                next.step+=1;
                q.push(next);
                next.step-=1;
                next.x+=dir[i][0];
                next.y+=dir[i][1];

            }
            if(next.x==ex&&next.y==ey&&next.step<3)
            {
                printf("YES\n");
                return ;
            }
        }
    }
    printf("NO\n");
    return ;
}

int main()
{
    while(cin>>n>>m,n+m)
    {

        memset(cnt,0,sizeof(cnt));
        for(int i=1; i<=n; i++)
            for(int j=1; j<=m; j++)
                scanf("%d",&cnt[i][j]);

        int qu;
        scanf("%d",&qu);
        for(int i=0; i<qu; i++)
        {
            memset(vis,0,sizeof(vis));
            scanf("%d%d%d%d",&sx,&sy,&ex,&ey);
            if(cnt[sx][sy]==0||cnt[ex][ey]==0)
                printf("NO\n");
            else if(sx==ex&&sy==ey)
                printf("NO\n");
            else if(cnt[sx][sy]!=cnt[ex][ey])
                printf("NO\n");
            else
                bfs(sx,sy);
        }
    }
    return 0;
}
/*
3 4
1 2 3 4
0 3 0 0
0 0 3 1
4
1 1 3 4
*/