洛谷 1126 机器人搬重物

1126 机器人搬重物

题目描述

机器人移动学会（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

#include<cstdio>
#include<queue>
#include<cstring>
#include<iostream>
using namespace std;
int a[51][51],n,m;
bool v[51][51][5];
int dx[4]={-1,0,1,0};
int dy[4]={0,1,0,-1};
int sx,sy;
struct node
{
int x,y,step;
int to;
}cur,nxt;
queue<node>q;
void bfs()
{
q.push(cur);
v[cur.x][cur.y][cur.to]=1;
while(!q.empty())
{
cur=q.front(); q.pop();
int xx,yy; int k=cur.to;
int x=cur.x,y=cur.y;
for(int i=1;i<=3;i++)
{
xx=cur.x+i*dx[k]; yy=cur.y+i*dy[k];
if(xx>0&&xx<n&&yy>0&&yy<m&&!a[xx][yy]&&!a[xx+1][yy]&&!a[xx][yy+1]&&!a[xx+1][yy+1])
{
if(xx==sx&&yy==sy)
{
printf("%d",cur.step+1);
return;
}
if(v[xx][yy][k]) continue;
v[xx][yy][k]=true;
nxt.x=xx; nxt.y=yy; nxt.step=cur.step+1; nxt.to=k;
//    printf("(%d %d)-->(%d %d)  %d %d\n",cur.x,cur.y,nxt.x,nxt.y,nxt.to,nxt.step);
q.push(nxt);
}
else break;
}
nxt.x=cur.x; nxt.y=cur.y;nxt.step=cur.step+1;
nxt.to=(cur.to+1)%4;
if(!v[nxt.x][nxt.y][nxt.to])
{
v[nxt.x][nxt.y][nxt.to]=true;
q.push(nxt);
//printf("(%d %d)-->(%d %d)  %d %d\n",cur.x,cur.y,nxt.x,nxt.y,nxt.to,nxt.step);
}
nxt.to=(cur.to-1+4)%4;
if(!v[nxt.x][nxt.y][nxt.to])
{
v[nxt.x][nxt.y][nxt.to]=true;
q.push(nxt);
//printf("(%d %d)-->(%d %d)  %d %d\n",cur.x,cur.y,nxt.x,nxt.y,nxt.to,nxt.step);
}
}
printf("-1");
}
int main()
{
//freopen("1","w",stdout);
scanf("%d%d",&n,&m);
for(int i=1;i<=n;i++)
for(int j=1;j<=m;j++)
scanf("%d",&a[i][j]);
scanf("%d%d",&cur.x,&cur.y);
cur.step=0;
scanf("%d%d",&sx,&sy);
char c; cin>>c;
switch(c)
{
case 'N': cur.to=0;break;
case 'E': cur.to=1;break;
case 'S': cur.to=2;break;
case 'W': cur.to=3;break;
}
if(cur.x==sx&&cur.y==sy)
{
printf("0\n");
return 0;
}
bfs();
}

if(v[xx][yy][k]) continue;
这一句不能加到上面的if一起判断
因为