洛谷1162机器人搬重物

原创 2018年04月17日 12:57:18

题目描述

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

广搜吧,但我思路简单,代码复杂度挺大的,纪念人生第一道码农题

把转身和走合并起来算两次时间,同理向后走算作三次时间


#include<bits/stdc++.h>
using namespace std;
queue <int> qx,qy;
queue <char> fx;
int n,m;
int qxx,qyy,zx,zy;
int s[550][550];
int ans[550][550];
char p;
bool check(int x,int y) {
	if(x>=1&&y>=1&&x<n&&y<m)
		return 1;
	return 0;
}
int main() {
	scanf("%d%d",&n,&m);
	for(int i=1; i<=n; i++)
		for(int j=1; j<=m; j++) {
			scanf("%d",&s[i][j]);
			if(s[i][j]==1)
				s[i-1][j]=s[i][j-1]=s[i-1][j-1]=1;
		}
	for(int i=0; i<=n; i++)
		for(int j=0; j<=m; j++)
			ans[i][j]=20021109;
	scanf("%d%d%d%d",&qxx,&qyy,&zx,&zy);
	cin>>p;
	qx.push(qxx),qy.push(qyy),fx.push(p);
	ans[qxx][qyy]=0;
	while(!qx.empty()) {
		int x=qx.front(),y=qy.front();
		char pos=fx.front();
		qx.pop(),qy.pop(),fx.pop();
		if(pos=='S') {
			if(check(x+1,y))
				if(ans[x][y]+1<=ans[x+1][y]  &&s[x+1][y]==0) {
					ans[x+1][y]=ans[x][y]+1;
					qx.push(x+1);
					qy.push(y);
					fx.push('S');
				}
			if(check(x+2,y))
				if(ans[x][y]+1<=ans[x+2][y]  &&s[x+1][y]==0 && s[x+2][y]==0) {
					ans[x+2][y]=ans[x][y]+1;
					qx.push(x+2);
					qy.push(y);
					fx.push('S');
				}
			if(check(x+3,y))
				if(ans[x][y]+1<=ans[x+3][y]  &&s[x+1][y]==0 && s[x+2][y]==0 &&s[x+3][y]==0) {
					ans[x+3][y]=ans[x][y]+1;
					qx.push(x+3);
					qy.push(y);
					fx.push('S');
				}
			if(check(x,y+1))
				if(ans[x][y]+2<=ans[x][y+1]  &&s[x][y+1]==0) {
					ans[x][y+1]=ans[x][y]+2;
					qx.push(x);
					qy.push(y+1);
					fx.push('E');
				}
			if(check(x,y+2))
				if(ans[x][y]+2<=ans[x][y+2]  &&s[x][y+1]==0 && s[x][y+2]==0) {
					ans[x][y+2]=ans[x][y]+2;
					qx.push(x);
					qy.push(y+2);
					fx.push('E');
				}
			if(check(x,y+3))
				if(ans[x][y]+2<=ans[x][y+3]  &&s[x][y+1]==0 && s[x][y+2]==0 &&s[x][y+3]==0) {
					ans[x][y+3]=ans[x][y]+2;
					qx.push(x);
					qy.push(y+3);
					fx.push('E');
				}
			if(check(x,y-1))
				if(ans[x][y]+2<=ans[x][y-1]  &&s[x][y-1]==0) {
					ans[x][y-1]=ans[x][y]+2;
					qx.push(x);
					qy.push(y-1);
					fx.push('W');
				}
			if(check(x,y-2))
				if(ans[x][y]+2<=ans[x][y-2]  &&s[x][y-1]==0 && s[x][y-2]==0) {
					ans[x][y-2]=ans[x][y]+2;
					qx.push(x);
					qy.push(y-2);
					fx.push('W');
				}
			if(check(x,y-3))
				if(ans[x][y]+2<=ans[x][y-3]  &&s[x][y-1]==0 && s[x][y-2]==0 &&s[x][y-3]==0) {
					ans[x][y-3]=ans[x][y]+2;
					qx.push(x);
					qy.push(y-3);
					fx.push('W');
				}
			if(check(x-1,y))
				if(ans[x][y]+3<=ans[x-1][y]  &&s[x-1][y]==0) {
					ans[x-1][y]=ans[x][y]+3;
					qx.push(x-1);
					qy.push(y);
					fx.push('N');
				}
			if(check(x-2,y))
				if(ans[x][y]+3<=ans[x-2][y]  &&s[x-1][y]==0 && s[x-2][y]==0) {
					ans[x-2][y]=ans[x][y]+3;
					qx.push(x-2);
					qy.push(y);
					fx.push('N');
				}
			if(check(x-3,y))
				if(ans[x][y]+3<=ans[x-3][y]  &&s[x-1][y]==0 && s[x-2][y]==0 &&s[x-3][y]==0) {
					ans[x-3][y]=ans[x][y]+3;
					qx.push(x-3);
					qy.push(y);
					fx.push('N');
				}
		}
		if(pos=='N') {
			if(check(x-1,y))
				if(ans[x][y]+1<=ans[x-1][y]  &&s[x-1][y]==0) {
					ans[x-1][y]=ans[x][y]+1;
					qx.push(x-1);
					qy.push(y);
					fx.push('N');
				}
			if(check(x-2,y))
				if(ans[x][y]+1<=ans[x-2][y]  &&s[x-1][y]==0 && s[x-2][y]==0) {
					ans[x-2][y]=ans[x][y]+1;
					qx.push(x-2);
					qy.push(y);
					fx.push('N');
				}
			if(check(x-3,y))
				if(ans[x][y]+1<=ans[x-3][y]  &&s[x-1][y]==0 && s[x-2][y]==0 &&s[x-3][y]==0) {
					ans[x-3][y]=ans[x][y]+1;
					qx.push(x-3);
					qy.push(y);
					fx.push('N');
				}
			if(check(x,y+1))
				if(ans[x][y]+2<=ans[x][y+1]  &&s[x][y+1]==0) {
					ans[x][y+1]=ans[x][y]+2;
					qx.push(x);
					qy.push(y+1);
					fx.push('E');
				}
			if(check(x,y+2))
				if(ans[x][y]+2<=ans[x][y+2]  &&s[x][y+1]==0 && s[x][y+2]==0) {
					ans[x][y+2]=ans[x][y]+2;
					qx.push(x);
					qy.push(y+2);
					fx.push('E');
				}
			if(check(x,y+3))
				if(ans[x][y]+2<=ans[x][y+3]  &&s[x][y+1]==0 && s[x][y+2]==0 &&s[x][y+3]==0) {
					ans[x][y+3]=ans[x][y]+2;
					qx.push(x);
					qy.push(y+3);
					fx.push('E');
				}
			if(check(x,y-1))
				if(ans[x][y]+2<=ans[x][y-1]  &&s[x][y-1]==0) {
					ans[x][y-1]=ans[x][y]+2;
					qx.push(x);
					qy.push(y-1);
					fx.push('W');
				}
			if(check(x,y-2))
				if(ans[x][y]+2<=ans[x][y-2]  &&s[x][y-1]==0 && s[x][y-2]==0) {
					ans[x][y-2]=ans[x][y]+2;
					qx.push(x);
					qy.push(y-2);
					fx.push('W');
				}
			if(check(x,y-3))
				if(ans[x][y]+2<=ans[x][y-3]  &&s[x][y-1]==0 && s[x][y-2]==0 &&s[x][y-3]==0) {
					ans[x][y-3]=ans[x][y]+2;
					qx.push(x);
					qy.push(y-3);
					fx.push('W');
				}
			if(check(x+1,y))
				if(ans[x][y]+3<=ans[x+1][y]  &&s[x+1][y]==0) {
					ans[x+1][y]=ans[x][y]+3;
					qx.push(x+1);
					qy.push(y);
					fx.push('S');
				}
			if(check(x+2,y))
				if(ans[x][y]+3<=ans[x+2][y]  &&s[x+1][y]==0 && s[x+2][y]==0) {
					ans[x+2][y]=ans[x][y]+3;
					qx.push(x+2);
					qy.push(y);
					fx.push('S');
				}
			if(check(x+3,y))
				if(ans[x][y]+3<=ans[x+3][y]  &&s[x+1][y]==0 && s[x+2][y]==0 &&s[x+3][y]==0) {
					ans[x+3][y]=ans[x][y]+3;
					qx.push(x+3);
					qy.push(y);
					fx.push('S');
				}
		}
		if(pos=='E') {
			if(check(x,y+1))
				if(ans[x][y]+1<=ans[x][y+1]  &&s[x][y+1]==0) {
					ans[x][y+1]=ans[x][y]+1;
					qx.push(x);
					qy.push(y+1);
					fx.push('E');
				}
			if(check(x,y+2))
				if(ans[x][y]+1<=ans[x][y+2]  &&s[x][y+1]==0 && s[x][y+2]==0) {
					ans[x][y+2]=ans[x][y]+1;
					qx.push(x);
					qy.push(y+2);
					fx.push('E');
				}
			if(check(x,y+3))
				if(ans[x][y]+1<=ans[x][y+3]  &&s[x][y+3]==0 && s[x][y+2]==0 &&s[x][y+1]==0) {
					ans[x][y+3]=ans[x][y]+1;
					qx.push(x);
					qy.push(y+3);
					fx.push('E');
				}
			if(check(x-1,y))
				if(ans[x][y]+2<=ans[x-1][y]  &&s[x-1][y]==0) {
					ans[x-1][y]=ans[x][y]+2;
					qx.push(x-1);
					qy.push(y);
					fx.push('N');
				}
			if(check(x-2,y));
			if(ans[x][y]+2<=ans[x-2][y]  &&s[x-1][y]==0 && s[x-2][y]==0) {
				ans[x-2][y]=ans[x][y]+2;
				qx.push(x-2);
				qy.push(y);
				fx.push('N');
			}
			if(check(x-3,y))
				if(ans[x][y]+2<=ans[x-3][y]  &&s[x-1][y]==0 && s[x-2][y]==0 &&s[x-3][y]==0) {
					ans[x-3][y]=ans[x][y]+2;
					qx.push(x-3);
					qy.push(y);
					fx.push('N');
				}
			if(check(x+1,y))
				if(ans[x][y]+2<=ans[x+1][y]  &&s[x+1][y]==0) {
					ans[x+1][y]=ans[x][y]+2;
					qx.push(x+1);
					qy.push(y);
					fx.push('S');
				}
			if(check(x+2,y));
			if(ans[x][y]+2<=ans[x+2][y]  &&s[x+1][y]==0 && s[x+2][y]==0) {
				ans[x+2][y]=ans[x][y]+2;
				qx.push(x+2);
				qy.push(y);
				fx.push('S');
			}
			if(check(x+3,y))
				if(ans[x][y]+2<=ans[x+3][y]  &&s[x+1][y]==0 && s[x+2][y]==0 &&s[x+3][y]==0) {
					ans[x+3][y]=ans[x][y]+2;
					qx.push(x+3);
					qy.push(y);
					fx.push('S');
				}
			if(check(x,y-1))
				if(ans[x][y]+3<=ans[x][y-1]  &&s[x][y-1]==0) {
					ans[x][y-1]=ans[x][y]+3;
					qx.push(x);
					qy.push(y-1);
					fx.push('W');
				}
			if(check(x,y-2))
				if(ans[x][y]+3<=ans[x][y-2]  &&s[x][y-1]==0 && s[x][y-2]==0) {
					ans[x][y-2]=ans[x][y]+3;
					qx.push(x);
					qy.push(y-2);
					fx.push('W');
				}
			if(check(x,y-3))
				if(ans[x][y]+3<=ans[x][y-3]  &&s[x][y-1]==0 && s[x][y-2]==0 &&s[x][y-3]==0) {
					ans[x][y-3]=ans[x][y]+3;
					qx.push(x);
					qy.push(y-3);
					fx.push('W');
				}
		}
		if(pos=='W') {
			if(check(x,y-1))
				if(ans[x][y]+1<=ans[x][y-1]  &&s[x][y-1]==0) {
					ans[x][y-1]=ans[x][y]+1;
					qx.push(x);
					qy.push(y-1);
					fx.push('W');
				}
			if(check(x,y-2))
				if(ans[x][y]+1<=ans[x][y-2]  &&s[x][y-1]==0 && s[x][y-2]==0) {
					ans[x][y-2]=ans[x][y]+1;
					qx.push(x);
					qy.push(y-2);
					fx.push('W');
				}
			if(check(x,y-3))
				if(ans[x][y]+1<=ans[x][y-3]  &&s[x][y-1]==0 && s[x][y-2]==0 &&s[x][y-3]==0) {
					ans[x][y-3]=ans[x][y]+1;
					qx.push(x);
					qy.push(y-3);
					fx.push('W');
				}
			if(check(x-1,y))
				if(ans[x][y]+2<=ans[x-1][y]  &&s[x-1][y]==0) {
					ans[x-1][y]=ans[x][y]+2;
					qx.push(x-1);
					qy.push(y);
					fx.push('N');
				}
			if(check(x-2,y))
				if(ans[x][y]+2<=ans[x-2][y]  &&s[x-1][y]==0 && s[x-2][y]==0) {
					ans[x-2][y]=ans[x][y]+2;
					qx.push(x-2);
					qy.push(y);
					fx.push('N');
				}
			if(check(x-3,y))
				if(ans[x][y]+2<=ans[x-3][y]  &&s[x-1][y]==0 && s[x-2][y]==0 &&s[x-3][y]==0) {
					ans[x-3][y]=ans[x][y]+2;
					qx.push(x-3);
					qy.push(y);
					fx.push('N');
				}
			if(check(x+1,y))
				if(ans[x][y]+2<=ans[x+1][y]  &&s[x+1][y]==0) {
					ans[x+1][y]=ans[x][y]+2;
					qx.push(x+1);
					qy.push(y);
					fx.push('S');
				}
			if(check(x+2,y))
				if(ans[x][y]+2<=ans[x+2][y]  &&s[x+1][y]==0 && s[x+2][y]==0) {
					ans[x+2][y]=ans[x][y]+2;
					qx.push(x+2);
					qy.push(y);
					fx.push('S');
				}
			if(check(x+3,y))
				if(ans[x][y]+2<=ans[x+3][y]  &&s[x+1][y]==0 && s[x+2][y]==0 &&s[x+3][y]==0) {
					ans[x+3][y]=ans[x][y]+2;
					qx.push(x+3);
					qy.push(y);
					fx.push('S');
				}
			if(check(x,y+1))
				if(ans[x][y]+3<=ans[x][y+1]  &&s[x][y+1]==0) {
					ans[x][y+1]=ans[x][y]+3;
					qx.push(x);
					qy.push(y+1);
					fx.push('E');
				}
			if(check(x,y+2))
				if(ans[x][y]+3<=ans[x][y+2]  &&s[x][y+1]==0 && s[x][y+2]==0) {
					ans[x][y+2]=ans[x][y]+3;
					qx.push(x);
					qy.push(y+2);
					fx.push('E');
				}
			if(check(x,y+3))
				if(ans[x][y]+3<=ans[x][y+3]  &&s[x][y+3]==0 && s[x][y+2]==0 &&s[x][y+1]==0) {
					ans[x][y+3]=ans[x][y]+3;
					qx.push(x);
					qy.push(y+3);
					fx.push('E');
				}
		}
		if(ans[zx][zy]!=20021109) {
			printf("%d",ans[zx][zy]);
			return 0;
		}
	}
	printf("-1");
	return 0;
}


解密Google Tango,从视觉惯性里程计到机器人SLAM

学员对视觉SLAM有一定了解,通过课程可以深入了解最尖端的视觉惯性里程计 -- Google Tango的内部原理和局限性。随后介绍该技术在学术界的发展态势,以及过渡到机器人SLAM技术的挑战。
  • 2017年03月24日 10:14

洛谷P1126-机器人搬重物-BFS/SPFA

洛谷P1126-机器人搬重物-BFS/SPFADescription机器人移动学会(RMI)现在正尝试用机器人搬运物品。机器人的形状是一个直径1.6米的球。在试验阶段,机器人被用于在一个储藏室中搬运货...
  • Zickshen
  • Zickshen
  • 2017-08-11 22:56:11
  • 240

洛谷P1126 机器人搬重物

洛谷1126 机器人搬重物 题目描述 机器人移动学会(RMI)现在正尝试用机器人搬运物品。机器人的形状是一个直径1.6米的球。在试验阶段,机器人被用于在一个储藏室中搬运货物。储藏室是一个N*M的网...
  • hahalidaxin
  • hahalidaxin
  • 2016-03-30 17:24:10
  • 701

bfs 洛谷 P1126 机器人搬重物

题目描述机器人移动学会(RMI)现在正尝试用机器人搬运物品。机器人的形状是一个直径1.6米的球。在试验阶段,机器人被用于在一个储藏室中搬运货物。储藏室是一个N*M的网格,有些格子为不可移动的障碍。机器...
  • sdz20172133
  • sdz20172133
  • 2018-03-03 00:17:21
  • 31

【The first】 题解:机器人搬重物

这是第一次写题解。。。 选的真的道题有坑。。。 请认真读题。 此题来自洛谷P1126题目描述机器人移动学会(RMI)现在正尝试用机器人搬运物品。机器人的形状是一个直径1.6的球。在试验阶段,机器...
  • jjqjinqiu
  • jjqjinqiu
  • 2016-04-28 10:25:43
  • 548

机器人搬重物 acm

ROBOT机器人搬重物Time Limit:1000MS  Memory Limit:65536KTotal Submit:7 Accepted:4 Description 机器人移动学会(RMI)现...
  • abcjennifer
  • abcjennifer
  • 2010-04-26 14:49:00
  • 3725

洛谷 P1126 机器人搬重物

题目描述机器人移动学会(RMI)现在正尝试用机器人搬运物品。机器人的形状是一个直径1.6米的球。在试验阶段,机器人被用于在一个储藏室中搬运货物。储藏室是一个N*M的网格,有些格子为不可移动的障碍。机器...
  • liangzihao1
  • liangzihao1
  • 2017-01-19 11:19:57
  • 255

机器人搬重物

路线规划
  • sundujing
  • sundujing
  • 2015-07-17 16:40:55
  • 452
收藏助手
不良信息举报
您举报文章:洛谷1162机器人搬重物
举报原因:
原因补充:

(最多只允许输入30个字)