Superbot ZOJ - 3865（BFS）

Superbot

题目链接：ZOJ - 3865
题意：一个N*M地图， 可以通过光标移动机器人， 使之找到钻石（@表示机器人初始位置， $表示钻石位置， *表示障碍， .表示空地），每p秒光标自动右移， 每秒一个操作，四个操作：
1> 按光标移动
2> 光标左移
3> 光标右移
4> 不动
初始时光标位置是  left ，  right ，  up ， down；  
光标的移动如下图：

每次移动有三个状态， 坐标 x， y， 光标位置 z；

#include <iostream> 
#include <cstdio>
#include <algorithm>
#include <cstring>
#include <queue>
using namespace std;
int dir[4][2]={0, -1, 0, 1, -1, 0, 1, 0};
int n, m, p, sx, sy, ex, ey;
char maze[15][15];
bool vis[15][15][5];
bool ok(int x, int y){
	if(x<0||x>=n||y<0||y>=m) return false;
	if(maze[x][y]=='*') return false;
	return true;
}
struct node{
	int x, y;
	int t;
	int z;//光标位置 
	node(){};
	node(int xx, int yy, int tt, int zz){
		x=xx;
		y=yy;
		t=tt;
		z=zz;
	}
};
queue<node> que;
int bfs(){
	while(!que.empty()) que.pop();
	node tmp=node(sx, sy, 0, 0);
	que.push(tmp);
	memset(vis, false, sizeof(vis));
	vis[sx][sy][0]=true;
	while(!que.empty()){
		tmp=que.front();
		que.pop();
	//	cout<<"x: "<<tmp.x<<" , y: "<<tmp.y<<endl;  
    //   cout<<"cmd: "<<tmp.z<<" time "<<tmp.t<<endl;  
    //    cout << "-----------------\n";
		if(tmp.x==ex&&tmp.y==ey||maze[tmp.x][tmp.y]=='$'){
			return tmp.t;
		}
		//光标左移
		node v=tmp;
		v.z=(v.z+1)%4;
		v.t++;
		if(v.t%p==0) v.z=(v.z+4-1)%4;
		if(!vis[v.x][v.y][v.z]){
			vis[v.x][v.y][v.z]=true;
			que.push(v);
		} 
		//光标右移
		v=tmp;
		v.z=(v.z+4-1)%4;
		v.t++;
		if(v.t%p==0) v.z=(v.z+4-1)%4;
		if(!vis[v.x][v.y][v.z]){
			vis[v.x][v.y][v.z]=true;
			que.push(v);
		}
		//不动
		v=tmp;
		v.t++;
		if(v.t%p==0) v.z=(v.z+4-1)%4;
		if(!vis[v.x][v.y][v.z]){
			vis[v.x][v.y][v.z]=true;
			que.push(v);
		}
		//移动
		v=tmp;
		v.x=v.x+dir[v.z][0], v.y=v.y+dir[v.z][1];
		v.t++;
		if(v.t%p==0) v.z=(v.z+4-1)%4;
		if(!vis[v.x][v.y][v.z]&&ok(v.x, v.y)){
			vis[v.x][v.y][v.z]=true;
			que.push(v);
		} 
	}
	return -1;
}
int main(){
	int T;
	scanf("%d", &T);
	while(T--){
		scanf("%d%d%d", &n, &m, &p);
		for(int i=0; i<n; i++){
			scanf("%s", maze[i]);
			for(int j=0; j<m; j++){
				if(maze[i][j]=='@') sx=i, sy=j;
				if(maze[i][j]=='$') ex=i, ey=j;
			}
		}
		int ans=bfs();
		if(ans==-1) printf("YouBadbad\n");
		else printf("%d\n", ans);
	}
	return 0;
}