Hdu 1072 Nightmare

简单搜索题，由于很久没写搜索题的缘故，我自己的模板出现了小问题。

注意：1、如果maze[q.x][q.y] == 4的话可能会出现死循环，所以要走过之后直接标记为0。

CODE：

#include <stdio.h>
#include <stdlib.h>
#include < string.h>
#include <queue>
using  namespace std;

const  int SIZE =  110;
int maze[SIZE][SIZE];
const  int move[ 4][ 2] = {{ 1,  0}, {- 1,  0}, { 0, - 1}, { 0,  1}};
int flag[SIZE][SIZE];
int N, M;
int bx, by;


struct node
{
     int x, y;
     int step;
     int costT;
}p, q;


int check( int r,  int c)
{
     if(maze[r][c] !=  0 && r < N && c < M && r >=  0 && c >=  0)
         return  1;
     return  0;
}


void bfs( int bx,  int by)
{
    queue<node> Q;
    p.x = bx; p.y = by;
    p.step =  6; p.costT =  0;
    Q.push(p);
     while(!Q.empty())
    {
        p = Q.front();
        Q.pop();
         for( int i =  0; i <  4; i++)
        {
            q = p;
            q.x += move[i][ 0];
            q.y += move[i][ 1];
             if(check(q.x, q.y))
            {
                 if(maze[q.x][q.y] ==  1)
                {
                    q.step--;
                     if(q.step >  0)
                    {
                        q.costT++;
                        Q.push(q);
                    }
                }
                 if(maze[q.x][q.y] ==  4)
                {
                    q.step--;
                     if(q.step >  0)
                    {
                        q.costT++;
                        q.step =  6;
                        Q.push(q);
                    }
                    maze[q.x][q.y] =  0;     // 可能会有死循环 
                }
                 if(maze[q.x][q.y] ==  3 && q.step >  1)
                {
                    printf( " %d\n ", ++q.costT);
                     return ;
                }
            }
        }
    }
    printf( " -1\n ");
     return ;
}


int main()
{
     int T;
     int i, j;
    scanf( " %d ", &T);
     while(T--)
    {
        memset(maze,  0,  sizeof(maze));
        scanf( " %d%d ", &N, &M);
         for(i =  0; i < N; i++)
        {
             for(j =  0; j < M; j++)
            {
                scanf( " %d ", &maze[i][j]);
                 if(maze[i][j] ==  2)
                {
                    bx = i;
                    by = j;
                }
            }
        }
        bfs(bx, by);
    }
     return  0;

}