深度优先搜索

还是oj，刷到了深度优先搜索。以后做导航和路径规划应该会用到，因此记下本题思路。
题目连接：http://ac.jobdu.com/problem.php?pid=1456

题目

题目描述：
Ignatius被魔王抓走了,有一天魔王出差去了,这可是Ignatius逃亡的好机会.魔王住在一个城堡里,城堡是一个A*B*C的立方体,可以被表示成A个B*C的矩阵,刚开始Ignatius被关在(0,0,0)的位置,离开城堡的门在(A-1,B-1,C-1)的位置,现在知道魔王将在T分钟后回到城堡,Ignatius每分钟能从一个坐标走到相邻的六个坐标中的其中一个.现在给你城堡的地图,请你计算出Ignatius能否在魔王回来前离开城堡(只要走到出口就算离开城堡,如果走到出口的时候魔王刚好回来也算逃亡成功),如果可以请输出需要多少分钟才能离开,如果不能则输出-1.
输入：
输入数据的第一行是一个正整数K,表明测试数据的数量.每组测试数据的第一行是四个正整数A,B,C和T(1<=A,B,C<=50,1<=T<=1000),它们分别代表城堡的大小和魔王回来的时间.然后是A块输入数据(先是第0块,然后是第1块,第2块……),每块输入数据有B行,每行有C个正整数,代表迷宫的布局,其中0代表路,1代表墙。
输出：
对于每组测试数据,如果Ignatius能够在魔王回来前离开城堡,那么请输出他最少需要多少分钟,否则输出-1.
样例输入：
1
3 3 4 20
0 1 1 1
0 0 1 1
0 1 1 1
1 1 1 1
1 0 0 1
0 1 1 1
0 0 0 0
0 1 1 0
0 1 1 0
样例输出：
11

解答代码

/**
 * 深度优先搜索原理
 * 1. 标记已经搜索过的节点，以后再搜索到该点时所花时间一定比本次长，若本节点在最短路径上则第二个树一定不是最短的。
 * 2. FIFO，使用队列存取各树，保证本次当前搜索花的时间是所有树中最少的。这样当某棵树搜索到目标点时，可保证目标点在此棵树上最先达到。
 */
#include <stdio.h>
#include <queue>
using namespace std;
bool mark[50][50][50];
int maze[50][50][50];
struct N{
    int x,y,z;
    int t;
};
queue<N> Q;
/**
 * 坐标变换矩阵
 */
int go[][3] ={
        1,0,0,
        -1,0,0,
        0,1,0,
        0,-1,0,
        0,0,1,
        0,0,-1
};
int BFS(int a, int b, int c){
    while(Q.empty() == false){
        N now = Q.front();
        Q.pop();
        for(int i = 0; i < 6; i++){
            int nx = now.x + go[i][0];
            int ny = now.y + go[i][1];
            int nz = now.z + go[i][2];

            if(nx < 0 || nx >= a || ny < 0 || ny >= b || nz < 0 || nz >= c) continue;//到达边界，舍弃
            if(maze[nx][ny][nz] == 1) continue;//墙舍弃
            if(mark[nx][ny][nz] == true) continue;//已被遍历过，舍弃
            N tmp;
            tmp.x = nx;
            tmp.y = ny;
            tmp.z = nz;
            tmp.t = now.t + 1;
            Q.push(tmp);
            mark[nx][ny][nz] = true;
            if(nx == a-1 && ny == b-1 && nz == c-1) return tmp.t;

        }
    }
    return -1;
}

int main(){
    int T;
    scanf("%d", &T);
    while(T--){
        int a,b,c,t;
        scanf("%d%d%d%d", &a, &b, &c, &t);
        for(int i = 0; i < a; i++){
            for(int j = 0; j < b; j++){
                for(int k = 0; k < c; k++){
                    scanf("%d", &maze[i][j][k]);
                    mark[i][j][k] = false;
                }

            }
        }

        while(Q.empty() == false) Q.pop();
        mark[0][0][0] = true;
        N tmp;
        tmp.t = tmp.y = tmp.x = tmp.z = 0;
        Q.push(tmp);
        int rec = BFS(a,b,c);
        if(rec <= t) printf("%d\n", rec);
        else printf("-1\n");
    }
    return 0;
}