规划场景监视器
PlanningSceneMonitor 是维护最新规划场景的推荐接口。RobotState、CurrentStateMonitor、PlanningScene、PlanningSceneMonitor 和 PlanningSceneInterface 之间的关系一开始可能会非常混乱。本教程旨在阐明这些关键概念。
机器人状态 RobotState
RobotState 是机器人的快照。它包含 RobotModel 和一组关节值。
当前状态监视器 CurrentStateMonitor
CurrentStateMonitor (CSM) 可以被认为是 RobotState 的 ROS 包装器。它订阅提供的 JointState 消息主题,这些消息为单自由度执行器(如旋转或棱柱关节)提供最新的传感器值,并使用这些关节值更新其内部 RobotState。除了单自由度关节外,机器人还可以具有多自由度关节,如浮动关节和平面关节。为了维护附加有多自由度关节的连杆和其他框架的最新变换信息,CSM 存储了一个 TF2 缓冲区,该缓冲区使用 TF2 TransformListener 在其内部数据中设置它们的变换。
规划场景 PlanningScene
PlanningScene 是世界的快照,包括 RobotState 和任意数量