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，此题的难度在于不只有前进一步、两步、三步，还有左转、右转的情况，一个比较巧的方法将将北、东、南、西 化为1、2、3、4，利用数字加减转向。
代码：
1 #include<iostream> 2 #include<cstdio> 3 #include<queue> 4 using namespace std; 5 6 int a[51][51],n,m,sx,sy; 7 bool visit[51][51][5]; 8 int dx[4]={-1,0,1,0}; 9 int dy[4]={0,1,0,-1}; 10 struct node { 11 int x,y,step,to; 12 }cur,nxt; 13 queue<node>q; 14 15 void bfs(){ 16 q.push(cur); 17 visit[cur.x][cur.y][cur.to]=true; 18 while(!q.empty()){ 19 cur=q.front(); 20 q.pop(); 21 int k=cur.to; 22 for(int i=1;i<=3;i++){//直走 23 int xx=cur.x+i*dx[k],yy=cur.y+i*dy[k]; 24 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]){ 25 if(xx==sx&&yy==sy){ 26 cout<<cur.step+1<<endl; 27 return ; 28 } 29 if(visit[xx][yy][k]) continue; 30 visit[xx][yy][k]=true; 31 nxt.x=xx,nxt.y=yy,nxt.step=cur.step+1,nxt.to=k; 32 q.push(nxt); 33 } 34 else break; 35 } 36 nxt.x=cur.x,nxt.y=cur.y,nxt.step=cur.step+1; 37 nxt.to=(cur.to+1)%4;//右转 38 if(!visit[nxt.x][nxt.y][nxt.to]){ 39 visit[nxt.x][nxt.y][nxt.to]=true; 40 q.push(nxt); 41 } 42 nxt.to=(cur.to-1+4)%4;//左转 43 if(!visit[nxt.x][nxt.y][nxt.to]){ 44 visit[nxt.x][nxt.y][nxt.to]=true; 45 q.push(nxt); 46 } 47 } 48 cout<<"-1"<<endl; 49 } 50 51 int main(){ 52 cin>>n>>m; 53 for(int i=1;i<=n;i++) 54 for(int j=1;j<=m;j++){ 55 cin>>a[i][j]; 56 } 57 cin>>cur.x>>cur.y; 58 cur.step=0; 59 cin>>sx>>sy; 60 char c;cin>>c; 61 switch(c){ 62 case 'N': cur.to=0; break;//将北、东、南、西 化为1、2、3、4，便于转向 63 case 'E': cur.to=1; break; 64 case 'S': cur.to=2; break; 65 case 'W': cur.to=3; break; 66 } 67 if(cur.x==sx&&cur.y==sy){ 68 cout<<"0"<<endl; 69 return 0; 70 } 71 bfs(); 72 }