poj 1367 robot(搜索)

题意：给你一个图，求起点 到 终点的最少时间

每次有两种选择①：往前走1~3步                ②原地选择90°   费时皆是1s

图中1为障碍物，而且不能出边界。还要考虑机器人的直径

思路：

bfs，但是在判断时出了点问题/(ㄒoㄒ)/，想复杂了，导致一直wr。

用vis[x][y][dir] 表示状态，即在(x,y)点的dir方向

问题：

①考虑判断条件时出现问题，开始想得太简单，后来想得太复杂= =

②最开始写的搜索部分太乱

③题意理解不准确。。

#include <iostream>
#include <cstdio>
#include <cmath>
#include <cstring>
#include <cstdlib>
#include <queue>
#include <algorithm>
typedef long long ll;
using namespace std;

int tmap[60][60];
int vis[60][60][5];
struct node
{
    int x,y;
    int step;
    int dir;
};
int n,m;
char to[10];
int fx,fy,tx,ty;
int dir[5][2] = {{-1,0},{0,1},{1,0},{0,-1}};
int ans = -1;

bool judge(node a)              //判断当前是否包含了黑点
{
    if(a.x<1||a.x>=n||a.y<1||a.y>=m)
        return false;
    if(tmap[a.x][a.y]||tmap[a.x+1][a.y]||tmap[a.x][a.y+1]||tmap[a.x+1][a.y+1])
        return false;
    return true;
}

void bfs()
{
    queue<node>q;

    node cur;
    ans = -1;
    cur.x = fx;
    cur.y = fy;
    cur.step = 0;

    if(to[0] == 's') cur.dir = 2;
    if(to[0] == 'n') cur.dir = 0;
    if(to[0] == 'w') cur.dir = 3;
    if(to[0] == 'e') cur.dir = 1;
    vis[cur.x][cur.y][cur.dir] = 1;
    q.push(cur);
    while(!q.empty())
    {
        cur = q.front();
        q.pop();
//        printf("%d %d %d %d\n",cur.x,cur.y,cur.dir,cur.step);
        for(int i = 1; i <= 3; i++)
        {
            node t;
            int dr = cur.dir;
            t.dir = cur.dir;
            t.x = cur.x + dir[dr][0]*i;
            t.y = cur.y + dir[dr][1]*i;
            t.step = cur.step+1;
            if(!judge(t))
                break;
            if(t.x == tx  &&  t.y == ty)
            {
                ans = t.step;
//                printf("%d %d %d\n",t.x,t.y,t.dir);
                return ;
            }
            if(!vis[t.x][t.y][t.dir])
            {
                vis[t.x][t.y][t.dir] = 1;
                q.push(t);
            }
        }
        for(int i = 0; i < 4; i++)
        {
            if(max(i,cur.dir)-min(i,cur.dir) == 2)
                continue;
            if(vis[cur.x][cur.y][i])
                continue;
            node t = cur;
            t.dir = i;
            t.step = cur.step+1;
            vis[t.x][t.y][t.dir] = 1;
            q.push(t);
        }
    }
    return ;
}

int main()
{
    while(scanf("%d%d",&n,&m) != EOF)
    {
        if(n == 0 && m == 0)
            break;
        memset(vis,0,sizeof(vis));
        for(int i = 1; i <= n; i++)
            for(int j = 1; j <= m; j++)
            {
                scanf("%d",&tmap[i][j]);
            }
        scanf("%d%d%d%d",&fx,&fy,&tx,&ty);
        scanf("%s",to);
        if(tmap[tx][ty])
        {
            printf("-1\n");
            continue;
        }
        if(fx == tx && fy == ty)
        {
            printf("0\n");
            continue;
        }
        bfs();

        if(ans == -1)
            printf("-1\n");
        else
            printf("%d\n",ans);
    }
    return 0;
}