hdu 1035 Robot Motion(模拟)

机器人路径规划与模拟算法

最新推荐文章于 2024-07-23 13:16:54 发布

u014068781

最新推荐文章于 2024-07-23 13:16:54 发布

阅读量303

点赞数

CC 4.0 BY-SA版权

分类专栏： ACM算法与数据结构

本文链接：https://blog.youkuaiyun.com/u014068781/article/details/39576461

ACM算法与数据结构专栏收录该内容

140 篇文章

订阅专栏

本文探讨了使用广度优先搜索算法解决机器人在特定环境中的路径规划问题，并通过HDOJ平台上的RobotMotion题目实例进行深入分析。文章详细介绍了算法实现步骤、关键变量定义以及如何通过BFS算法找到最优路径，同时考虑了路径重复与最优退出点的判断。

//hdu 1035 Robot Motion(模拟)
#include<iostream>
#include<cstdio>
#include<cstring>
#include<queue>
using namespace std;
const int N=20;
char ma[N][N];
int mp1[N][N];
bool flag[N*N];
int n,m,k;
int ansstep,ansloop;
void init()
{
    memset(flag,false,sizeof(flag));
    ansstep=0;ansloop=0;
    memset(mp1,0,sizeof(mp1));

}
bool samebfs(int di,int dj)
{
    int dt=di*m+dj;
    queue<int> q;
    q.push(dt);
    flag[dt]=true;
    while(!q.empty())
    {
        int tem=q.front();q.pop();
        int ti=tem/m;
        int tj=tem%m;
        if(ma[ti][tj]=='E')
        {
            if((tj+1)>=m)
            {
                ansstep=mp1[ti][tj]+1;
                return true;
            }
            tj=tj+1;
            dt=ti*m+tj;
            if(flag[dt]==false)
            {
                mp1[ti][tj]=mp1[ti][tj-1]+1;
                q.push(dt);
                flag[dt]=true;
            }
            else
            {
                ansstep=mp1[ti][tj];
                ansloop=mp1[ti][tj-1]-mp1[ti][tj];
                break;
            }
        }
        else if(ma[ti][tj]=='W')
        {
            if(tj-1<0)
            {
                ansstep=mp1[ti][tj]+1;
                return true;
            }
            tj=tj-1;
            dt=ti*m+tj;
            if(flag[dt]==false)
            {
                mp1[ti][tj]=mp1[ti][tj+1]+1;
                q.push(dt);
                flag[dt]=true;
            }
            else
            {
                ansstep=mp1[ti][tj];
                ansloop=mp1[ti][tj+1]-mp1[ti][tj];
                break;
            }
        }
        else if(ma[ti][tj]=='N')
        {
            if(ti-1<0)
            {
                ansstep=mp1[ti][tj]+1;
                return true;
            }
            ti=ti-1;
            dt=ti*m+tj;
            if(flag[dt]==false)
            {
                mp1[ti][tj]=mp1[ti+1][tj]+1;
                q.push(dt);
                flag[dt]=true;
            }
            else
            {
                ansstep=mp1[ti][tj];
                ansloop=mp1[ti+1][tj]-mp1[ti][tj];
                break;
            }
        }
        else if(ma[ti][tj]=='S')
        {
            if(ti+1>=n)
            {
                ansstep=mp1[ti][tj]+1;
                return true;
            }
            ti=ti+1;
            dt=ti*m+tj;
            if(flag[dt]==false)
            {
                mp1[ti][tj]=mp1[ti-1][tj]+1;
                q.push(dt);
                flag[dt]=true;
            }
            else
            {
                ansstep=mp1[ti][tj];
                ansloop=mp1[ti-1][tj]-mp1[ti][tj];
                break;
            }
        }
    }
    ansloop+=1;
    return false;
}
int main()
{
    while(scanf("%d%d",&n,&m)!=EOF)
    {
        init();
        if(n==0&&m==0) break;
        scanf("%d",&k);
        for(int i=0;i<n;i++)
        {
            scanf("%s",ma[i]);
        }
        bool vis=samebfs(0,k-1);
        if(vis)
        {
            printf("%d step(s) to exit\n",ansstep);
        }
        else
        {
            printf("%d step(s) before a loop of %d step(s)\n",ansstep,ansloop);
        }
    }
    return 0;
}