洛谷 P1126

https://www.luogu.org/problemnew/show/P1126

题目描述

机器人移动学会（RMI）现在正尝试用机器人搬运物品。机器人的形状是一个直径$1.6米的球。在试验阶段，机器人被用于在一个储藏室中搬运货物。储藏室是一个N×M的网格，有些格子为不可移动的障碍。机器人的中心总是在格点上，当然，机器人必须在最短的时间内把物品搬运到指定的地方。机器人接受的指令有：向前移动1步（Creep）；向前移动2步（Walk）；向前移动3步（Run）；向左转（Left）；向右转（Right）。每个指令所需要的时间为1秒。请你计算一下机器人完成任务所需的最少时间。

输入输出格式

输入格式：

 

第一行为两个正整数N,M(N,M≤50)，下面N行是储藏室的构造，0表示无障碍，1表示有障碍，数字之间用一个空格隔开。接着一行有4个整数和1个大写字母，分别为起始点和目标点左上角网格的行与列，起始时的面对方向（东E，南S，西W，北N），数与数，数与字母之间均用一个空格隔开。终点的面向方向是任意的。

 

输出格式：

 

一个整数，表示机器人完成任务所需的最少时间。如果无法到达，输出−1。

 

输入输出样例

输入样例#1： 复制

9 10
0 0 0 0 0 0 1 0 0 0
0 0 0 0 0 0 0 0 1 0
0 0 0 1 0 0 0 0 0 0
0 0 1 0 0 0 0 0 0 0
0 0 0 0 0 0 1 0 0 0
0 0 0 0 0 1 0 0 0 0
0 0 0 1 1 0 0 0 0 0
0 0 0 0 0 0 0 0 0 0
1 0 0 0 0 0 0 0 1 0
7 2 2 7 S

输出样例#1： 复制

12

思路：第一点，化网格图为点图！这一点还蛮有意思的，认为当前读入的是该方格的右下角的点。第二点，转向要花费额外的时间，因此这道题要记录最小值，而不是直接输出第一个解。广搜的第一个解是最先到达的(步数)，但是这里还要考虑转向的额外花费，因此就不一定了。

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

struct node
{
    int x;
    int y;
    int d;
    int t;
};
int MIN=100000;
int flag=0;
int n,m;
int bx,by,ex,ey;
char dbeg;
int fx[5][2]={{0,0},{0,1},{0,-1},{1,0},{-1,0}}; //东西南北
int a[55][55];
int vis[55][55];    //必须保存最优解！

void bfs(int beg);

int main()
{
    cin>>n>>m;
    for(int i=1;i<=n;i++)
        for(int j=1;j<=m;j++)
        {
            cin>>a[i][j];
            if(a[i][j])
            {
                a[i-1][j-1]=1;
                a[i-1][j]=1;
                a[i][j-1]=1;
            }
        }
    for(int i=1;i<=n;i++)
    {
        a[n][i]=1;  //边界不能走
        a[i][m]=1;
    }
    cin>>bx>>by>>ex>>ey>>dbeg;
    memset(vis,0x3f3f3f3f,sizeof(vis));
    int beg;
    if(dbeg=='E')
        beg=1;
    else if(dbeg=='W')
        beg=2;
    else if(dbeg=='S')
        beg=3;
    else
        beg=4;
    bfs(beg);
    if(flag==0)
        cout<<-1<<endl;
    else if(flag==1)
        cout<<MIN<<endl;
    return 0;
}

void bfs(int beg)
{
    if(bx==ex&&by==ey)
    {
        flag=2;
        cout<<0<<endl;
        return ;
    }
    node temp1;
    temp1.x=bx;
    temp1.y=by;
    temp1.d=beg;
    temp1.t=0;
    vis[bx][by]=1;
    queue<node> q;
    q.push(temp1);
    while(!q.empty())
    {
        node temp2=q.front();
        q.pop();
        if(temp2.x==ex&&temp2.y==ey)
        {
            MIN=min(MIN,temp2.t);
            flag=1;
        }
        for(int i=1;i<=4;i++)//四个方向 东西南北
        {
            int step=temp2.t;
            if(temp2.d!=i)  //方向不同
            {
                step++;
                if((i==1&&temp2.d==2)||(i==2&&temp2.d==1)||(i==3&&temp2.d==4)||(i==4&&temp2.d==3))//需要向后转
                    step++;
            }
            for(int j=1;j<=3;j++)//三种可选的步数
            {
                int dx=temp2.x+j*fx[i][0];
                int dy=temp2.y+j*fx[i][1];
                if(dx>n||dy>m||dx<1||dy<1||a[dx][dy])//有障碍 或者超出边界
                    break;
                if(vis[dx][dy]>step)
                {
                    vis[dx][dy]=step;
                    temp1.x=dx;
                    temp1.y=dy;
                    temp1.d=i;
                    temp1.t=step+1;
                    q.push(temp1);
                }
            }
        }
    }
}