poj2225---Asteroids!(简单三维搜索)

题目大意：

给定一个三维空间，有些点能走有些点不能走，每次只能上下，左右，前后六个方向走，给定起始坐标和终点坐标，求从起点到终点最短的路径。

注意：

图是按z，y，x给出的，所以在获取起点和终点时也是按z，y，x获取

//Accepted    192K    16MS    C++    1395B
#include <cstring>
#include <cstdio>
#include <queue>
using namespace std;
#define MAX 15
struct node{
    int x,y,z,d;
}start,end;
char map[MAX][MAX][MAX];
int useif[MAX][MAX][MAX];
int n;
int dx[6] = {0,0,1,-1,0,0};
int dy[6] = {0,0,0,0,1,-1};
int dz[6] = {1,-1,0,0,0,0};
int cmp(node temp)
{
    if(temp.x >=0 && temp.x < n && temp.y >= 0 && temp.y < n && temp.z >= 0 && temp.z < n)
        return 1;
    return 0;
}
void bfs()
{
    queue <node> Q;
    node temp;
    while(!Q.empty()) Q.pop();
    memset(useif,0,sizeof(useif));
    start.d = 0;
    useif[start.x][start.y][start.z] = 1;
    Q.push(start);
    while(!Q.empty())
    {
        start = Q.front();
        Q.pop();
        if(start.x == end.x && start.y == end.y && start.z == end.z)
        {
            printf("%d %d\n",n,start.d);
            return ;
        }
        for(int i = 0 ;i < 6; ++i)
        {
            temp.x = start.x + dx[i];
            temp.y = start.y + dy[i];
            temp.z = start.z + dz[i];
            temp.d = start.d + 1;
            if(cmp(temp) && useif[temp.x][temp.y][temp.z] == 0 && map[temp.x][temp.y][temp.z] == 'O')
            {
                useif[temp.x][temp.y][temp.z] = 1;
                Q.push(temp);
            }
        }        
    }
    printf("NO ROUTE\n");
}

int main(void)
{
    char s[10];
    int i,j;
    while(scanf("%s%d",s,&n)!=EOF)
    {
        for(i=0;i<n;i++)
            for(j=0;j<n;j++)
                scanf("%s",&map[i][j]);
        scanf("%d%d%d%d%d%d%s",&start.z,&start.y,&start.x,&end.z,&end.y,&end.x,s);
        bfs();
    }
    return 0;
}