标签:构造 printf step 面向 bsp cin std upload switch
机器人移动学会(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。
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一起判断
因为
标签:构造 printf step 面向 bsp cin std upload switch
原文地址:http://www.cnblogs.com/TheRoadToTheGold/p/6759551.html