【隊內胡策 10.24 T4】星際牛仔

題目來源：USACO 2015 DEC Gold
去題面的傳送門

狀壓BFS
注意狀態有思維，安全標記，方向，座標。
記得某dalao說過開數組的時候，把小的放前面，大的放後面會快很多。所以安全標記只需要開2，就放在最前面吧。
還有，走到紫色格子的時候，只會朝着原來的方向滑動一格，而不是滑到底。。
代碼打起來有點噁心，調了許久
代碼：

#include<iostream>
#include<cstdio>
#include<cstring>
#include<algorithm>
#include<queue>
using namespace std;

const int maxn=1000+10;
int n,m,ans;
int ditu[maxn][maxn];
int dx[5]={0,-1,1,0,0},dy[5]={0,0,0,-1,1};
bool vis[2][5][maxn][maxn];//1:U 2:D 3:L 4:R
struct lxt
{
    int x,y,dir,safe,step;
};
queue<lxt>q;

bool judge(int x,int y,int dir,int safe)
{
    if(x<1||y<1||x>n||y>m) return false;
    if(ditu[x][y]==0) return false;
    if(!safe&&ditu[x][y]==3) return false;
    if(vis[safe][dir][x][y]) return false;
    return true;
}
int bfs()
{
    if(ditu[1][1]==3||ditu[1][1]==0) return -1;
    int fist=0;
    if(ditu[1][1]==3) fist=1;
    vis[fist][2][1][1]=true;
    q.push((lxt){1,1,2,fist,0});
    vis[fist][4][1][1]=true;
    q.push((lxt){1,1,4,fist,0});
    while(!q.empty())
    {
        int ux=q.front().x,uy=q.front().y;
        int ud=q.front().dir,us=q.front().safe,st=q.front().step;
        if(ux==n&&uy==m) return st;
        q.pop();
        int vx,vy,vd,vs=us;
        if(ditu[ux][uy]==2) vs=1;
        if(ditu[ux][uy]==4) 
        {
            vx=ux+dx[ud],vy=uy+dy[ud],vd=ud,vs=0;
            if(judge(vx,vy,vd,vs))
            {
                vis[vs][vd][vx][vy]=true;
                q.push((lxt){vx,vy,vd,vs,st+1});
                continue;
            }
        }
        for(int i=1;i<=4;++i)
        {
            vx=ux+dx[i],vy=uy+dy[i];
            vd=i,vs=us;
            if(ditu[vx][vy]==2) vs=1; 
            if(ditu[vx][vy]==4) vs=0;
            if(judge(vx,vy,vd,vs))
            {
                vis[vs][vd][vx][vy]=true;
                q.push((lxt){vx,vy,vd,vs,st+1});
            }
        }
    }
    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",&ditu[i][j]);
    ans=bfs();
    printf("%d",ans);
    return 0;
}