poj 1376 Robot （BFS）

题目大意是给一个图，然后给你起点和终点，以及开始所处的方向，要求你求出从起点到终点的最小步数，如果无法到达则输出-1。

这个题注意有4点：

1、它一秒可以执行2种命令，一种是向现在所面向的方向走1-3步，另外一种是向左或向右90度转向（不能向后转）。
2、图中为1的是障碍物，是不允许通过的，包括边界也不能允许，这一点需要注意下。
3、对搜索进行去重操作的时候需要记录所处位置的方向，因为这个题存在方向的问题，需要注意下，可以设置数组为vis[100][100][4]，4代表4个方向。

4、还可以直接做一个优化，如果终点所在的四个块存在障碍，则始终不可达。

朝某一个方向走时，如果走一步不行，后面的2,3步也不用走了。

代码：47ms

#include <iostream>#include <cstdio>#include <cstring>#include <string>#include <algorithm>#include <stack>#include <cmath>#include <vector>#include <queue>using namespace std;#define LL long long#define N 55#define INF 1<<29#define CLS(x,v) memset(x,v,sizeof(x))/**每秒可执行一条指令，1.向前走1,2,3 步2.向左或向右转90度*/int graph[N][N];//每一点记录他右下角的状态int vis[N][N][4];int n,m;int dir[4][2]={{0,1},{1,0},{0,-1},{-1,0}};//E,S,W,Nstruct point{  int x,y;  int dir;  int step;  bool ok()  {     return x>0&&x<n&&y>0&&y<m;  }  bool operator ==(const point &b)const{     return x==b.x&&y==b.y;  }  bool operator <(const point&b)const{    return step>b.step;  }}s,e;int getdir(char* s){    if(s[0]=='e')return 0;    if(s[0]=='s')return 1;    if(s[0]=='w')return 2;    if(s[0]=='n')return 3;}int BFS(){    if(s==e)return 0;//起点和终点相同    priority_queue<point> Q;    CLS(vis,0);    vis[s.x][s.y][s.dir]=1;    Q.push(s);    point pre,now;    while(!Q.empty())    {        pre=Q.top();        //printf("x==%d,y==%d,step==%d\n",pre.x,pre.y,pre.step);        Q.pop();        for(int i=1;i<4;i++)        {            now.x=pre.x+i*dir[pre.dir][0];            now.y=pre.y+i*dir[pre.dir][1];            if(!now.ok()||graph[now.x][now.y]||graph[now.x][now.y-1]||              graph[now.x-1][now.y]||graph[now.x-1][now.y-1])              break;              //该位置可达，并且没障碍物            now.dir=pre.dir;            if(!vis[now.x][now.y][now.dir])            {                now.step=pre.step+1;                Q.push(now);                if(now==e)return now.step;                vis[now.x][now.y][now.dir]=1;            }        }        now=pre;        now.dir++;        now.step++;        if(now.dir==4)now.dir=0;        if(!vis[now.x][now.y][now.dir])        {            Q.push(now);            vis[now.x][now.y][now.dir]=1;        }        now=pre;        now.dir--;        now.step++;        if(now.dir<0)now.dir=3;        if(!vis[now.x][now.y][now.dir])        {            Q.push(now);            vis[now.x][now.y][now.dir]=1;        }    }    return -1;}int main(){    char c[10];    while(~scanf("%d%d",&n,&m)&&n&&m)    {        for(int i=0;i<n;i++)        for(int j=0;j<m;j++)            scanf("%d",&graph[i][j]);        scanf("%d%d",&s.x,&s.y);        scanf("%d%d",&e.x,&e.y);        scanf("%s",c);        s.dir=getdir(c);        s.step=0;        //终点不可达        if(e.x==0||e.y==0||graph[e.x][e.y]||graph[e.x-1][e.y]           ||graph[e.x][e.y-1]||graph[e.x-1][e.y-1])printf("-1\n");        else printf("%d\n",BFS());    }    return 0;}