ZJU 3811 - Untrusted Patrol(DFS)

题意

有N个仓库,K个传感器,给出传感器的提示顺序,问能不能遍历图

思路

从第一个传感器的提示地方开始遍历,直到碰到装传感器的地方,然后看第二个地方有没有被访问到。 
如果没有被访问到,说明第一个传感器和第二个传感器是不连通的,false。 
如果有,遍历第二个传感器,依次。

代码

 
 
  1. #include <cstdio>
  2. #include <cstring>
  3. #include <vector>
  4. #define LL long long
  5. #define lowbit(x) ((x) & (-x))
  6. const int MAXN = 1e5 + 5;
  7. const int INF = 0x3f3f3f3f;
  8. using namespace std;
  9. vector<int> mp[MAXN];
  10. int Next[MAXN], vis[MAXN], cenvis[MAXN];
  11. void DFS(int cur)
  12. {
  13. for (vector<int>::iterator it = mp[cur].begin(); it != mp[cur].end(); it++)
  14. {
  15. if (vis[*it]) continue;
  16. vis[*it] = 1;
  17. if (!cenvis[*it]) DFS(*it);
  18. }
  19. }
  20. int main()
  21. {
  22. //freopen("input.txt", "r", stdin);
  23. int T, i, j, nroom, nway, nloc, nnext;
  24. scanf("%d", &T);
  25. while (T--)
  26. {
  27. memset(vis, 0, sizeof vis);
  28. memset(cenvis, 0, sizeof cenvis);
  29. scanf("%d%d%d", &nroom, &nway, &nloc);
  30. for (i = 0; i < nloc; i++)
  31. {
  32. int a;
  33. scanf("%d", &a);
  34. cenvis[a] = 1;
  35. }
  36. for (i = 0; i < nway; i++)
  37. {
  38. int a, b;
  39. scanf("%d%d", &a, &b);
  40. mp[a].push_back(b);
  41. mp[b].push_back(a);
  42. }
  43. scanf("%d", &nnext);
  44. bool flag = false;
  45. if (nnext < nloc)
  46. flag = true;
  47. for (i = 0; i < nnext; i++)
  48. scanf("%d", &Next[i]);
  49. vis[Next[0]] = 1;
  50. for (i = 0; i < nnext; i++)
  51. {
  52. if (!vis[Next[i]])
  53. {
  54. flag = true;
  55. break;
  56. }
  57. DFS(Next[i]);
  58. }
  59. for (i = 1; i <= nroom; i++)
  60. if (!vis[i]) flag = true;
  61. printf("%s\n", flag == false ? "Yes" : "No");
  62. for (i = 0; i <= nroom; i++)
  63. mp[i].clear();
  64. }
  65. return 0;
  66. }
ZJU-I型机械臂是一种由浙江大学机器人研究所开发的六自由度机械臂,具有高速、精度和可靠性等特点。机械臂的运动控制是机器人中的重要研究领域之一,其中点到点轨迹规划是机器人在运动过程中最基础和常用的一种方式,也是机械臂控制的核心问题之一。 点到点轨迹规划的目标是通过给定的起点和终点,计算出机械臂的运动轨迹,使机械臂在运动过程中满足机械臂轨迹的连续性、平滑性、可控性等要求。在过去的研究中,经典的点到点轨迹规划方法包括插值法、线性规划法、最小能量法等。 如果使用Python实现机械臂的点到点轨迹规划,可以采用Robotics Toolkit(简称robot)这个模块。robot模块提供了各种从轨迹规划、控制到仿真的功能,可用于ROS、Vrep、Webots等机器人仿真软件。使用robot模块,可以通过几行代码实现机械臂的点到点轨迹规划,例如: ``` from roboticstoolkit import robot from roboticstoolkit.robots import zju # 初始化机器人 zju_arm = robot.Robot('zju', zju.URDF) # 设定起点和终点 start = [0, 0, 0, 0, 0, 0] goal = [0, 1, 1, 0.5, 0, 0] # 计算机械臂的轨迹 path = zju_arm.get_trajectory(start, goal) # 控制机械臂运动到终点 zju_arm.move_to(goal) ``` 其中,`roboticstoolkit`和`roboticstoolkit.robots`都是导入的Python模块,`zju`是机械臂的URDF定义文件,`start`和`goal`是起点和终点的坐标,`get_trajectory()`函数会返回计算得到的机械臂轨迹,`move_to()`函数则控制机械臂运动到终点。 总之,使用Python实现ZJU-I型机械臂的点到点轨迹规划相对简单,只需要导入相应的模块,并根据需要设置机械臂的各种参数,即可轻松实现机械臂的控制。
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值