洛谷P1126 机器人搬重物

题目描述

机器人移动学会（RMI）现在正尝试用机器人搬运物品。机器人的形状是一个直径1.6米的球。在试验阶段，机器人被用于在一个储藏室中搬运货物。储藏室是一个N*M的网格，有些格子为不可移动的障碍。机器人的中心总是在格点上，当然，机器人必须在最短的时间内把物品搬运到指定的地方。机器人接受的指令有：向前移动1步（Creep）；向前移动2步（Walk）；向前移动3步（Run）；向左转（Left）；向右转（Right）。每个指令所需要的时间为1秒。请你计算一下机器人完成任务所需的最少时间。

输入输出格式

输入格式：

输入的第一行为两个正整数N,M（N,M<=50），下面N行是储藏室的构造，0表示无障碍，1表示有障碍，数字之间用一个空格隔开。接着一行有四个整数和一个大写字母，分别为起始点和目标点左上角网格的行与列，起始时的面对方向（东E，南S，西W，北N），数与数，数与字母之间均用一个空格隔开。终点的面向方向是任意的。

输出格式：

一个整数，表示机器人完成任务所需的最少时间。如果无法到达，输出-1。

输入输出样例

输入样例#1： 

9 10
0 0 0 0 0 0 1 0 0 0
0 0 0 0 0 0 0 0 1 0
0 0 0 1 0 0 0 0 0 0
0 0 1 0 0 0 0 0 0 0
0 0 0 0 0 0 1 0 0 0
0 0 0 0 0 1 0 0 0 0
0 0 0 1 1 0 0 0 0 0
0 0 0 0 0 0 0 0 0 0
1 0 0 0 0 0 0 0 1 0
7 2 2 7 S

输出样例#1： 

12

复杂状态的 bfs ，敲了我一个小时。。。

药丸。。。

附代码：

#include<iostream>
#include<algorithm>
#include<cstdio>
#include<queue>
#include<map>
#define MAXN 55
using namespace std;
const int fx[4]={0,1,0,-1},fy[4]={1,0,-1,0};
int n,m,ans=-1,tx,ty,a[MAXN][MAXN];
struct node{
	int x,y,f;
	bool operator < (const node &p)const{
	    if(x!=p.x)return x<p.x;
	    else if(y!=p.y)return y<p.y;
	    else if(f!=p.f)return f<p.f;
	    else return 0;
	}
}s;
map<node,int> vis;
inline int read(){
	int date=0,w=1;char c=0;
	while(c<'0'||c>'9'){if(c=='-')w=-1;c=getchar();}
	while(c>='0'&&c<='9'){date=date*10+c-'0';c=getchar();}
	return date*w;
}
inline bool check(int x,int y){
	for(int i=0;i<4;i++){
	    x+=fx[i];y+=fy[i];
		if(x<1||x>n||y<1||y>m)return false;
		else if(a[x][y])return false;
	}
	return true;
}
inline int change(char ch){
	switch(ch){
		case 'E':return 0;
		case 'S':return 1;
		case 'W':return 2;
		case 'N':return 3;
	}
}
void bfs(int x,int y,char c){
	node u,v;
	queue<node> q;
	u.x=x;u.y=y;u.f=change(c);
	vis[u]=1;
	q.push(u);
	while(!q.empty()){
		u=q.front();
		q.pop();
		v=u;
		for(int i=1;i<4;i++){
		    v.x+=fx[u.f];v.y+=fy[u.f];
			if(!check(v.x,v.y))break;
			else if(!vis[v]){
				vis[v]=vis[u]+1;
				if(v.x==tx&&v.y==ty){
					ans=vis[v]-1;
					return;
				}
				q.push(v);
			}
		}
		for(int i=-1;i<=1;i++){
			if(!i)continue;
			v=u;v.f=(u.f+i+4)%4;
			if(!vis[v]){
				q.push(v);
				vis[v]=vis[u]+1;
			}
		}
	}
}
int main(){
	int x0,y0;
	char flag[2];
	n=read();m=read();
	for(int i=1;i<=n;i++)
	for(int j=1;j<=m;j++)
	a[i][j]=read();
	x0=read();y0=read();tx=read();ty=read();scanf("%s",flag);
	if(x0==tx&&y0==ty)printf("0\n");
	else if(!check(x0,y0))printf("-1\n");
	else{
		bfs(x0,y0,flag[0]);
		printf("%d\n",ans);
	}
	return 0;
}