机器人 / 系统课时

配置夹爪关节组和命名姿态

配置夹爪关节组和命名姿态

本篇以 ROS 2 Jazzy、MoveIt 2 和 Panda 双指夹爪为例,建立独立的 hand 规划组,保存 open、close 命名姿态,并把 MoveIt 的执行请求映射到实际夹爪控制器。完成后可在 RViz 发起开合请求,通过 Action 类型与关节反馈确认动作确实执行。

学习目标

  • 区分 Panda 夹爪主动关节与随动关节,设置合法开合数值。
  • 在 SRDF 中核对 hand、末端执行器及 open、close 命名姿态。
  • 对齐 MoveIt 与 ros2_control 的夹爪 Action,并完成开合验收。

确认两根手指的关节职责

Panda 夹爪有 panda_finger_joint1 和 panda_finger_joint2。标准模型中后者通过 URDF 的 mimic 关系跟随前者;控制器只需给 panda_finger_joint1 下发位置指令,不能把两根手指误配成两个独立执行轴。panda_arm 管七轴机械臂,hand 只管夹爪。

示例选择每根手指从中心向外移动 0.035 m 作为 open,两指间的理论开口约为 0.070 m;close 使用 0.000 m。这是关节位移,不是直接向控制器发送的“总开口宽度”。实际机器人应以 URDF 关节限位和夹爪驱动规格为准,不要把 0.070 写成单根手指的目标值。

保存规划组与命名姿态

使用 MoveIt Setup Assistant 编辑自己的配置包时,依次检查:

  1. Planning Groups → Add Group:组名设为 hand,加入夹爪相关连杆和关节;确认第二根手指的 mimic 关系来自 URDF。
  2. Robot Poses → Add Pose:组选择 hand,保存 open = 0.035 与 close = 0.000。界面通常只显示主动关节 panda_finger_joint1。
  3. End Effectors → Add End Effector:末端执行器名和组名均设为 hand,连接到机械臂末端 panda_link8;保存并重新生成配置包。

以下是 Panda 示例 config/panda.srdf 中与本课有关的片段示例,必须位于已有的 <robot name="panda"> 元素内。已有同名组时应核对而非重复粘贴,也不要用片段覆盖整份 SRDF。

xml
<group name="hand">
  <link name="panda_hand"/>
  <link name="panda_leftfinger"/>
  <link name="panda_rightfinger"/>
  <joint name="panda_finger_joint1"/>
  <!-- 第二根手指由 URDF mimic 约束,不单独下发指令 -->
  <passive_joint name="panda_finger_joint2"/>
</group>
<!-- 命名姿态的数值是每根手指的关节位移,单位 m -->
<group_state name="open" group="hand">
  <joint name="panda_finger_joint1" value="0.035"/>
  <joint name="panda_finger_joint2" value="0.035"/>
</group_state>
<group_state name="close" group="hand">
  <joint name="panda_finger_joint1" value="0"/>
  <joint name="panda_finger_joint2" value="0"/>
</group_state>
<end_effector name="hand" parent_link="panda_link8"
              group="hand" parent_group="panda_arm"/>

生效检查:重新启动加载该 SRDF 的 move_group 与 RViz;Planning Group 能选择 hand,Goal State 中能选择 open 和 close。若只有 panda_arm,优先检查启动文件实际加载的 robot_description_semantic,而不是继续修改控制器。

对齐控制器与 Action 类型

SRDF 只负责描述“计划让夹爪到哪里”;执行还需要三处名称一致:hand 中的主动关节、ros2_control 控制的关节、MoveIt 控制器映射中的关节。夹爪反馈从 /joint_states 返回,供 MoveIt 更新当前状态。

Panda 夹爪命名姿态到控制器的执行与反馈链路

在 ROS 2 Jazzy 的 Panda 模拟配置中,config/ros2_controllers.yaml 应使用下列控制器类型;这是片段示例,原文件的机械臂控制器与 joint_state_broadcaster 必须保留。

yaml
controller_manager:
  ros__parameters:
    panda_hand_controller:
      type: parallel_gripper_action_controller/GripperActionController

panda_hand_controller:
  ros__parameters:
    joint: panda_finger_joint1
    state_interfaces: [position, velocity]

对应的 config/gripper_moveit_controllers.yaml 也须包含 panda_hand_controller,并保留现有的 panda_arm_controller 定义。下面是片段示例:

yaml
moveit_simple_controller_manager:
  controller_names: [panda_arm_controller, panda_hand_controller]
  panda_hand_controller:
    action_ns: gripper_cmd
    type: ParallelGripperCommand
    default: true
    joints: [panda_finger_joint1]

启动演示并验收开合

已安装 moveit_resources_panda_moveit_config 且使用 ROS 2 Jazzy 的终端运行:

bash
source /opt/ros/jazzy/setup.bash
ros2 launch moveit_resources_panda_moveit_config demo.launch.py

预期结果:RViz 显示 Panda 和 MotionPlanning 面板,同时启动 move_group、controller_manager 及模拟硬件。终端中的时间戳、进程号等因环境而不同。修改过配置文件后,应确认启动的是修改后的包,而非被系统安装包覆盖的旧版本。

在另一终端运行检查命令:

bash
source /opt/ros/jazzy/setup.bash
ros2 control list_controllers | grep panda_hand_controller
ros2 action list -t | grep /panda_hand_controller/gripper_cmd

预期输出(节选,空格可能不同):

text
panda_hand_controller parallel_gripper_action_controller/GripperActionController active
/panda_hand_controller/gripper_cmd [control_msgs/action/ParallelGripperCommand]

接着在 RViz 的 MotionPlanning → Planning 中按顺序验证:

  1. 将 Planning Group 设为 hand,Start State 选当前状态,Goal State 选 open。
  2. 先按 Plan 检查结果,再按 Execute;两指应同步张开。将 Goal State 改为 close,重复规划与执行。
  3. 在新终端用 ros2 topic echo /joint_states --once 查看反馈,将 name 数组与 position 同索引对应;主动关节应分别接近 0.035 和 0.000,随动手指应同步变化。模拟硬件可用于验证接口链路,不能代表真实夹持力。

若能规划却不能执行,先看控制器是否为 active、Action 路径及消息类型是否匹配;若 RViz 只有目标姿态变化而 /joint_states 不变,检查是否只做了 Plan 或是否加载了不包含夹爪控制器的配置。不要仅凭轨迹动画判断执行成功。

按自己的节奏,确认真正理解。

目录与阅读设置

阅读设置

17

记录一个想法

配置夹爪关节组和命名姿态

0 / 10000 · 笔记保存到账号。未提交的修改会在关闭、离开或刷新后丢失。

登录哪都通