2. ROS2基础回顾

在进入MoveIt2的机械臂运动规划之前，必须先建立对ROS2核心通信机制的清晰认知。机械臂控制是一个典型的实时、多传感器融合、多执行器协同的复杂系统，ROS2的节点、话题、服务、动作、参数、命名空间与launch文件，恰好为这种复杂性提供了结构化的解耦方案。本章将逐一剖析这些核心概念，并直接映射到机械臂的关节控制、状态反馈、轨迹执行与系统启动等具体场景中，为后续使用MoveIt2的API与规划器打下坚实的架构基础。

上图展示了ROS2各通信机制在机械臂控制中的典型布局。节点是计算单元，话题负责高频状态流（如关节角度），服务用于一次性请求（如回零），动作则承担需要反馈的长时间任务（如轨迹跟踪）。参数与命名空间提供了配置隔离与多设备管理能力，而launch文件将这些元素编排为可复用的系统启动方案。下面逐一深入。

2.1 节点：机械臂控制的功能模块划分

核心原理

节点是ROS2中可执行文件的最小计算单元。在机械臂系统中，一个完整的控制栈通常由多个节点组成：关节状态发布节点（读取编码器并发布/joint_states）、轨迹控制器节点（接收目标轨迹并计算力矩）、运动学求解节点（正逆解计算）、传感器驱动节点（力觉/视觉）。节点间通过DDS（数据分发服务）通信，天然支持分布式部署——例如将视觉处理节点运行在GPU工作站，而关节控制节点运行在实时工控机上。

操作流程

1. 使用rclcpp::Node创建节点，命名需体现功能，如arm_controller。
2. 在节点内声明Publisher、Subscriber、ServiceServer等接口。
3. 通过rclcpp::spin()保持节点活跃，处理回调。
4. 使用ros2 node list和ros2 node info <node_name>检查节点状态。

案例拆解：六轴机械臂的节点拓扑

这种模块化设计使得每个节点可独立测试、替换或重启。例如，当更换新型电机驱动器时，只需修改arm_controller节点内部的硬件接口层，而无需改动规划器或状态发布器。

2.2 话题：高频状态流与指令流

核心原理

话题是ROS2中异步、单向、多对多的通信方式。在机械臂控制中，话题是数据流的主干道。传感器数据（关节角度、力矩、IMU）以高频发布，控制器订阅后计算输出，再以话题形式发送给执行器。话题的QoS（服务质量）策略至关重要——对于关节状态，通常使用SensorDataQoS（尽力传输、低延迟）；对于控制指令，则使用Reliable（可靠传输、避免丢包）。

关键话题清单

• /joint_states：标准消息类型sensor_msgs/msg/JointState，包含关节名称、位置、速度、力矩数组。
• /arm_controller/command：自定义消息或std_msgs/msg/Float64MultiArray，用于发送目标关节位置。
• /tf：坐标变换树，用于将视觉坐标系下的目标点转换到机械臂基座坐标系。
• /arm_controller/status：控制器状态反馈，如当前模式、跟踪误差。

实战场景：基于话题的实时示教

假设需要实现手动拖拽示教功能。操作者拖动机臂末端，关节编码器产生位置变化，joint_state_publisher以200Hz发布/joint_states。上位机订阅该话题，实时记录轨迹点，并通过/arm_controller/command回放。此时QoS必须设置为BEST_EFFORT以保证最低延迟，否则拖拽手感会明显卡顿。

2.3 服务：同步请求-应答模式

核心原理

服务适用于一次性、需要确认的操作。在机械臂控制中，典型场景包括：回零（请求机械臂回到home位姿）、切换控制模式（位置模式切换到力矩模式）、查询当前位姿。服务由客户端发起请求，服务端处理并返回响应，整个过程是同步阻塞的。

操作流程

1. 定义服务接口文件（.srv），如SetPose.srv包含geometry_msgs/Pose target_pose请求和bool success响应。
2. 在控制器节点中创建服务服务器，注册回调函数。
3. 客户端通过ros2 service call /arm_controller/set_pose arm_msgs/srv/SetPose "{target_pose: ...}"调用。

案例：机械臂回零服务

# 服务接口定义: arm_msgs/srv/Home.srv
---
bool success
string message

控制器节点收到请求后，执行以下步骤：1) 检查当前是否处于安全状态；2) 以最大速度的20%缓慢运动至零位；3) 返回成功标志。若在运动过程中检测到碰撞力矩超限，则立即停止并返回失败信息。这种同步机制确保了操作者能明确知道动作是否完成。

2.4 动作：长时任务的执行与反馈

核心原理

动作（Action）是ROS2为长时间运行、可取消、带反馈的任务设计的通信机制。它由三部分组成：目标（Goal）、反馈（Feedback）、结果（Result）。在机械臂控制中，动作最典型的应用是follow_joint_trajectory——MoveIt2规划出一条关节轨迹后，通过动作接口发送给控制器执行。控制器在执行过程中持续反馈当前关节位置与剩余时间，客户端可以监控进度，也可以随时取消任务。

动作通信流程

实战案例：MoveIt2与控制器之间的动作交互

在MoveIt2的MoveGroup节点中，规划完成后会生成trajectory_msgs/msg/JointTrajectory。随后，MoveGroup作为动作客户端，将轨迹发送给arm_controller节点的follow_joint_trajectory动作服务器。控制器按轨迹点逐帧执行，每个控制周期（如2ms）发布一次反馈。若操作者按下急停，客户端发送取消请求，控制器立即停止电机并保持当前位置。

2.5 参数、命名空间与launch文件

核心原理

参数是节点的静态或动态配置项，如PID增益、最大速度限制、关节软限位。参数可以在启动时通过launch文件传入，也可以在运行时动态修改（ros2 param set）。命名空间用于逻辑隔离——当一台工控机控制两台机械臂时，可将节点分别置于/arm1/和/arm2/命名空间下，避免话题名冲突。launch文件是ROS2系统的编排脚本，用于同时启动多个节点、设置参数、加载配置文件。

launch文件示例

from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    return LaunchDescription([
        Node(
            package='arm_bringup',
            executable='joint_state_publisher',
            namespace='arm1',
            parameters=[{'joint_limits': [2.9, 2.9, 2.9]}]
        ),
        Node(
            package='arm_bringup',
            executable='arm_controller',
            namespace='arm1',
            parameters=['config/arm1_controller.yaml']
        ),
        Node(
            package='rviz2',
            executable='rviz2',
            arguments=['-d', 'config/arm1.rviz']
        )
    ])

参数动态调整场景

在调试机械臂时，经常需要在线调整PID参数。使用ros2 param set /arm1/arm_controller pid_gains.joint1.p 50.0即可实时修改比例增益，而无需重启节点。但需注意，参数修改后应通过话题或服务确认新值已生效，并观察机械臂响应是否稳定。

2.6 综合案例：双机械臂协作系统的启动与通信

假设需要搭建一个双机械臂装配工作站，两臂分别负责抓取和装配。系统启动时，launch文件依次执行：1) 启动两个joint_state_publisher节点，分别置于/left_arm/和/right_arm/命名空间；2) 启动两个arm_controller节点，加载各自的PID参数文件；3) 启动一个motion_planner节点，订阅两臂的状态话题，规划协同动作；4) 启动RViz可视化。

在运行过程中，motion_planner通过/left_arm/joint_states和/right_arm/joint_states获取两臂实时位置，计算避碰轨迹后，分别通过动作接口/left_arm/follow_joint_trajectory和/right_arm/follow_joint_trajectory发送指令。若左臂检测到异常力矩，通过服务/left_arm/emergency_stop请求急停，同时通过话题广播状态给右臂，右臂控制器收到后暂停运动。

该案例充分体现了ROS2各通信机制的协同：话题承载高频状态流，动作管理长时轨迹执行，服务处理紧急事件，参数提供灵活配置，命名空间实现设备隔离，launch完成系统编排。