机器人搬重物

#include <iostream>
#include <cstdio>
#include <cstdlib>
#include <cmath>
#include <algorithm>
#include <climits>
#include <cstring>
#include <string>
#include <set>
#include <map>
#include <queue>
#include <stack>
#include <vector>
#include <list>
#define rep(i,m,n) for(i=m;i<=n;i++)
#define rsp(it,s) for(set<int>::iterator it=s.begin();it!=s.end();it++)
#define mod 1000000007
#define inf 0x3f3f3f3f
#define vi vector<int>
#define pb push_back
#define mp make_pair
#define fi first
#define se second
#define ll long long
#define pi acos(-1.0)
const int maxn=51;
const int dis[4][2]={{0,1},{-1,0},{0,-1},{1,0}};
using namespace std;
ll gcd(ll p,ll q){return q==0?p:gcd(q,p%q);}
ll qpow(ll p,ll q){ll f=1;while(q){if(q&1)f=f*p;p=p*p;q>>=1;}return f;}
int n,m,k,t,a[maxn][maxn],vis[maxn][maxn][4],sx,sy,ex,ey;
char d;
inline int gao(char p)
{
    if(p==‘S‘)return 3;
    if(p==‘N‘)return 1;
    if(p==‘E‘)return 0;
    if(p==‘W‘)return 2;
}
bool check(int x,int y)
{
    if(x>=0&&x<n&&y>=0&&y<m&&a[x][y]==0);
    else return false;
    if(x+1>=0&&x+1<n&&y>=0&&y<m&&a[x+1][y]==0);
    else return false;
    if(x>=0&&x<n&&y+1>=0&&y+1<m&&a[x][y+1]==0);
    else return false;
    if(x+1>=0&&x+1<n&&y+1>=0&&y+1<m&&a[x+1][y+1]==0);
    else return false;
    return true;
}
struct node
{
    int x,y,dir;
    node(int xx,int yy,char dirr)
    {
        x=xx,y=yy,dir=dirr;
    }
};
queue<node>p;
int main()
{
    int i,j;
    scanf("%d%d",&n,&m);
    rep(i,0,n-1)rep(j,0,m-1)scanf("%d",&a[i][j]);
    scanf("%d%d%d%d %c",&sx,&sy,&ex,&ey,&d);
    sx--,sy--,ex--,ey--;
    if(sx==ex&&sy==ey)return 0*puts("0");
    node q(sx,sy,gao(d));
    p.push(q);vis[sx][sy][gao(d)]=1;
    while(!p.empty())
    {
        node u=p.front();p.pop();
        node v=u;
        for(int i=1;i<=3;i++)
        {
            v.x+=dis[v.dir][0];
            v.y+=dis[v.dir][1];
            if(!check(v.x,v.y))break;
            if(!vis[v.x][v.y][v.dir])
            {
                p.push(v);
                vis[v.x][v.y][v.dir]=vis[u.x][u.y][u.dir]+1;
                if(v.x==ex&&v.y==ey)return 0*printf("%d\n",vis[u.x][u.y][u.dir]);
            }
        }
        v=u;
        v.dir=(u.dir+3)%4;
        if(!vis[v.x][v.y][v.dir])
        {
            p.push(v);
            vis[v.x][v.y][v.dir]=vis[u.x][u.y][u.dir]+1;
        }
        v=u;
        v.dir=(u.dir+1)%4;
        if(!vis[v.x][v.y][v.dir])
        {
            p.push(v);
            vis[v.x][v.y][v.dir]=vis[u.x][u.y][u.dir]+1;
        }
    }
    puts("-1");
    //system("pause");
    return 0;
}