hdu2102A计划(bfs)

关注

原创最新推荐文章于 2026-06-20 14:30:30 发布 235 阅读 AI 写同款· GEO 优化 ›

机器人抓取（一）—— ROS MoveIt! 程序控制真实UR5机器人运动（python）接上篇：ubuntu18.04 ros-melodic 安装 ur_robot_driver，驱动真实的 ur5 机器人上文在 ubuntu 系统中配置了ur 机器人ros功能包 universal_robot 和驱动 Universal_Robots_ROS_Driver，并实现了用 moveit_rviz 拖动机器人运动。本文旨在学习如何使用 moveit python 用户接口moveit_commander，实现真实的ur5 机器人轨迹规划与控制。 1. ur5 机器人控制参考：MoveIt » 阅读详情

hdu2102A计划
A计划
Time Limit: 3000/1000 MS (Java/Others) Memory Limit: 32768/32768 K (Java/Others)
Total Submission(s): 33348 Accepted Submission(s): 8254

Problem Description
可怜的公主在一次次被魔王掳走一次次被骑士们救回来之后，而今，不幸的她再一次面临生命的考验。魔王已经发出消息说将在T时刻吃掉公主，因为他听信谣言说吃公主的肉也能长生不老。年迈的国王正是心急如焚，告招天下勇士来拯救公主。不过公主早已习以为常，她深信智勇的骑士LJ肯定能将她救出。
现据密探所报，公主被关在一个两层的迷宫里，迷宫的入口是S（0，0，0），公主的位置用P表示，时空传输机用#表示，墙用*表示，平地用.表示。骑士们一进入时空传输机就会被转到另一层的相对位置，但如果被转到的位置是墙的话，那骑士们就会被撞死。骑士们在一层中只能前后左右移动，每移动一格花1时刻。层间的移动只能通过时空传输机，且不需要任何时间。

Input
输入的第一行C表示共有C个测试数据，每个测试数据的前一行有三个整数N，M，T。 N，M迷宫的大小NM（1 <= N,M <=10)。T如上所意。接下去的前NM表示迷宫的第一层的布置情况，后N*M表示迷宫第二层的布置情况。

Output
如果骑士们能够在T时刻能找到公主就输出“YES”，否则输出“NO”。

Sample Input
1
5 5 14
S*#*.
.#…
…
****.
…#.

….P
#.…
**…
….
*.#…

Sample Output
YES

Source
HDU 2007-6 Programming Contest

Recommend
xhd

暴力bfs，注意下列情况：
1.两个传送门会卡进去
2.直接传送到公主头上

#include<bits/stdc++.h>
using namespace std;
char mp[2][11][11];
int vis[2][11][11];
int dy[4]={0,0,1,-1};
int dz[4]={1,-1,0,0};
int n,m,t;
struct node{
    int x,y,z;
    node(){}
    node(int a,int b,int c){x=a;y=b;z=c;}
    bool operator ==(const node &a)const{
        return x==a.x&&y==a.y&&z==a.z;
    }
}ed;
inline int *getvis(node &st){return &vis[st.x][st.y][st.z];}
inline void setvis(node &st,int p){*getvis(st)=p;}
int bfs(node st){
    memset(vis,-1,sizeof vis);
    setvis(st,0);
    queue<node>mq;
    mq.push(st);
    while(!mq.empty()){
        node nw=mq.front();
        mq.pop();node q;
        int step=*getvis(nw);
        if(nw==ed)return step;
        if(step==t)continue;
        for(int i=0;i<4;i++){
            q.y=nw.y+dy[i];
            q.z=nw.z+dz[i];
            q.x=nw.x;
            if(q.y<0||q.y>=n||q.z<0||q.z>=m)continue;
            if(mp[q.x][q.y][q.z]=='#')q.x^=1;
            if(mp[q.x][q.y][q.z]=='.'||mp[q.x][q.y][q.z]=='P'){
                if(*getvis(q)==-1){
                    mq.push(q);
                    setvis(q,step+1);
                }
            }
        }
    }
    return 0;
}
int  main(){
    int T;
    scanf("%d",&T);
    while(T--){
        scanf("%d%d%d",&n,&m,&t);
        for(int i=0;i<2;i++){
            for(int j=0;j<n;j++){
                scanf("%s",mp[i][j]);
                for(int k=0;k<m;k++){
                    if(mp[i][j][k]=='P'){
                        ed.x=i;
                        ed.y=j;
                        ed.z=k;
                    }
                }
            }
        }
        if(bfs(node(0,0,0)))puts("YES");
        else puts("NO");
    }
    return 0;
}