用 ROS 2 控制灵巧手：话题、控制周期与安全层怎么设计
关键词：ros2 robot hand control, ros2_control 灵巧手, EtherCAT · 阅读约 5 分钟 · 作者：DexHand 团队
灵巧手在 ROS 2 里最容易踩的坑不是话题名，而是控制周期与安全层。本文给出一套我们在 DexHand-5F 上验证过的结构，可直接照搬。
1. 接口分层
| 层 | 内容 |
|---|---|
| 硬件接口 | ros2_control SystemInterface：读关节位置 / 速度 / 电流，写目标位置；EtherCAT 周期 1–4 ms |
| 控制器 | JointTrajectoryController（示教 / 回放）、ForwardCommandController（RL 策略直接下发） |
| 应用 | /hand/joint_states、/hand/command（sensor_msgs/JointState 或自定义），抓取动作库以 Action 暴露 |
| 安全 | 独立节点：限位裁剪、速度 / 力矩上限、看门狗（100 ms 无指令 → 保持）、急停 |
2. 控制周期
- EtherCAT 总线 1 kHz，ros2_control 循环 500 Hz，策略 30–100 Hz；三级周期不要混在一个进程
- 策略输出做一阶低通 + 限幅，避免 RL 动作抖动直接打到电机
- 用 SCHED_FIFO + 隔离 CPU 核跑控制循环，抖动可压到 50 µs 级
3. 仿真与实机同一接口
- 仿真侧（Isaac Sim / MuJoCo / Gazebo）实现同名 SystemInterface，launch 文件用参数切换
- 同一套 controller.yaml、同一套话题，策略代码零改动
- 这就是 DexHand“虚拟手与实机同一控制器”的做法
4. 安全层清单
- 关节限位 = URDF 限位 − 2°，超出即裁剪并告警
- 电流 / 力矩上限按抓握任务分档，握持状态限流防过热
- 看门狗：策略断流 100 ms 保持当前位姿，1 s 缓慢张开
- 急停：硬件急停切驱动使能，软件急停发零力矩
5. 调试顺序
- 单关节点动 → 限位标定 → 多关节同步 → 姿态库回放 → 策略闭环
- 每一步都先在仿真过，再切实机
English summary
A field-tested ROS 2 architecture for dexterous hands: ros2_control hardware interface over EtherCAT (1 kHz), 500 Hz control loop, 30–100 Hz policy with low-pass and clamping, an independent safety node (limits, torque caps, 100 ms watchdog, e-stop), and identical interfaces for simulation and real hardware.