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

TJ先存储方向，再存储步数。写错原因，逗号写成了分号。以后避免的方法，加大括号。

#include<iostream>
#include<cstdio>
using namespace std;
int mov1[3][2]={{1,0},{2,0},{3,0}};
int mov3[3][2]={{-1,0},{-2,0},{-3,0}};
int mov2[3][2]={{0,1},{0,2},{0,3}};
int mov4[3][2]={{0,-1},{0,-2},{0,-3}};
int n,m,x1,y1,x2,y2,a[100000],b[100000],h[100000],sp[100000];
bool f[55][55][4];
int lc[55][55],rst;
char c;
bool pd(int x,int y)
{
    if(!lc[x][y] && !lc[x+1][y] && !lc[x][y+1] && !lc[x+1][y+1] && x+1<=n && y+1<=m)
    return 1;
    else return 0;
}
int bfs(int x,int y,int g)
{
    int head=1,tail=1;
    a[head]=x,b[head]=y,h[head]=g,sp[head]=0;
    f[x][y][g]=1;
    if(x==x2 && y==y2) return sp[tail];
    while(head<=tail)
    {
        switch(h[head])//先方向 
        {
            case 1: {if(!f[a[head]][b[head]][2])h[++tail]=2,
                        a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                        f[a[head]][b[head]][h[tail]]=1; 
                     if(!f[a[head]][b[head]][4])h[++tail]=4,
                        a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                        f[a[head]][b[head]][h[tail]]=1;break;}
            case 2: {if(!f[a[head]][b[head]][1])h[++tail]=1,
                         a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                         f[a[head]][b[head]][h[tail]]=1;    
                     if(!f[a[head]][b[head]][3])h[++tail]=3,
                         a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                         f[a[head]][b[head]][h[tail]]=1;break;}
            case 3: {if(!f[a[head]][b[head]][2])h[++tail]=2,
                         a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                         f[a[head]][b[head]][h[tail]]=1;    
                     if(!f[a[head]][b[head]][4])h[++tail]=4,
                         a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                         f[a[head]][b[head]][h[tail]]=1;break;}
            case 4: {if(!f[a[head]][b[head]][1])h[++tail]=1,
                         a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                         f[a[head]][b[head]][h[tail]]=1;    
                     if(!f[a[head]][b[head]][3])h[++tail]=3,
                         a[tail]=a[head],b[tail]=b[head],sp[tail]=sp[head]+1,
                         f[a[head]][b[head]][h[tail]]=1;    break;}
        }//a[tail-1] b[tail-1] h[tail-1] sp[tail-1]
        for(int i=0;i<3;i++)//后步数 
        {
            int xx,yy;
            switch(h[head])
            {
                case 1:{xx=a[head]+mov1[i][0],yy=b[head]+mov1[i][1];
                    break;
                }
                case 3:{xx=a[head]+mov3[i][0],yy=b[head]+mov3[i][1];
                    break;
                }
                case 2:{xx=a[head]+mov2[i][0],yy=b[head]+mov2[i][1];
                    break;
                }
                case 4:{xx=a[head]+mov4[i][0],yy=b[head]+mov4[i][1];
                    break;
                }
            }
            if(!pd(xx,yy))break;
            else if(xx>=1 && xx<=n && yy>=1 && yy<=m && !f[xx][yy][h[head]])
            {
                tail++;
                a[tail]=xx,b[tail]=yy,h[tail]=h[head];
                sp[tail]=sp[head]+1;
                f[xx][yy][h[head]]=1;
            }
            if(xx==x2 && yy==y2) return rst=sp[tail];
        }
//      cout<<a[tail]<<" "<<b[tail]<<" "<<h[tail]<<endl;
        head++;
    }
    return -1;
}
int main()
{
    scanf("%d%d",&n,&m);
    for(int i=1;i<=n;i++)
        for(int j=1;j<=m;j++)
        {
            scanf("%d",&lc[i][j]);
        }
    scanf("%d%d%d%d %c",&x1,&y1,&x2,&y2,&c);
    switch(c)
    {
        case 'S':{cout<<bfs(x1,y1,1)<<endl;break;}
        case 'E':{cout<<bfs(x1,y1,2)<<endl;break;}
        case 'N':{cout<<bfs(x1,y1,3)<<endl;
            break;
        }
        case 'W':{cout<<bfs(x1,y1,4)<<endl;
            break;
        }
    }
//  for(int i=1;i<=100;i++)
//      cout<<a[i]<<" "<<b[i]<<" "<<h[i]<<" "<<sp[i]<<endl;
}