POJ1376简单广搜

题意：

      给你一个n*m的矩阵，然后给你机器人的起点和终点，还有起点的方向，然后每次机器人有两种操作，左右旋转90度，或者是朝着原来的方向走1,2或者3步，机器人再走的过程中不能碰到格子，也不能碰到边界，输出最少步数。

思路：

     比较简单的题目，只是要注意几点。

（1）走的过程中边界不可以碰

（2）如果你想一下子走3步的话，记住路程中不能碰墙

（3）mark的时候记得也罢方向mark上。

简单题目，就说这么多吧。

#include<queue>

#include<stdio.h>

#include<string.h>

using namespace std;

typedef struct

{

    int x ,y ,t ,dir;

}NODE;

int sx ,sy ,ex ,ey ,n ,m ,sdir;

int mark[55][55][5];

int map[55][55];

NODE xin ,tou;

bool jude2(int x ,int y)

{

    return !map[x+1][y] && !map[x][y+1] && !map[x+1][y+1];

}

bool ok(int x ,int y ,int dir)

{

    return x >= 1 && x <= n && y >= 1 && y <= m && !map[x][y] && !mark[x][y][dir] && jude2(x ,y);

}

int BFS()

{

    queue<NODE>q;

    memset(mark ,0 ,sizeof(mark));

    xin.x = sx ,xin.y = sy ,xin.t = 0 ,xin.dir = sdir;

    mark[sx][sy][sdir] = 1;

    q.push(xin);

    while(!q.empty())

    {

        tou = q.front();

        q.pop();

        if(tou.x == ex && tou.y == ey) return tou.t;

        //lift

        xin = tou;

        xin.t ++ ,xin.dir ++;

        if(xin.dir == 5) xin.dir = 1;

        if(ok(xin.x ,xin.y ,xin.dir))

        {

            mark[xin.x][xin.y][xin.dir] = 1;

            q.push(xin);

        }

        //right

        xin = tou;

        xin.t ++ ,xin.dir --;

        if(xin.dir == 0) xin.dir = 4;

        if(ok(xin.x ,xin.y ,xin.dir))

        {

            mark[xin.x][xin.y][xin.dir] = 1;

            q.push(xin);

        }

        for(int i = 1 ;i <= 3 ;i ++)

        {

            xin = tou;

            xin.t ++;

            int mk = 0;

            if(tou.dir == 1)

            {

                xin.x -= i;

                for(int j = xin.x + 1;j < tou.x ;j ++)

                if(map[j][xin.y] || map[j][xin.y+1])

                mk = 1;

            }

            if(tou.dir == 3)

            {

                xin.x += i;

                for(int j = tou.x + 1;j < xin.x ;j ++)

                if(map[j][xin.y] || map[j][xin.y+1])

                mk = 1;

            }

            if(tou.dir == 2)

            {

                xin.y += i;

                for(int j = tou.y + 1 ;j < xin.y ;j ++)

                if(map[xin.x][j] || map[xin.x+1][j]) mk = 1;

            }

            if(tou.dir == 4)

            {

                xin.y -= i;

                for(int j = xin.y + 1 ;j < tou.y ;j ++)

                if(map[xin.x][j] || map[xin.x+1][j]) mk = 1;

            }

            if(!mk && ok(xin.x ,xin.y ,xin.dir))

            {

                mark[xin.x][xin.y][xin.dir] = 1;

                q.push(xin);

            }

        }

    }

    return -1;

}

int main ()

{

    char str[10];

    while(~scanf("%d %d" ,&n ,&m) && n + m)

    {

        memset(map ,255 ,sizeof(map));

        for(int i = 1 ;i <= n ;i ++)

        for(int j = 1 ;j <= m ;j ++)

        scanf("%d" ,&map[i][j]);

        scanf("%d %d %d %d" ,&sx ,&sy ,&ex ,&ey);

        scanf("%s" ,str);

        if(str[0] == 'n') sdir = 1;

        else if(str[0] == 'e') sdir = 2;

        else if(str[0] == 's') sdir = 3;

        else sdir = 4;

        printf("%d\n" ,BFS());

    }

    return 0;

}