2、ROS2基础：节点、话题、服务、动作、参数、命名空间、launch文件、colcon构建

在进入机械臂控制与 MoveIt2 规划之前，必须先建立对 ROS2 核心通信机制与工程组织方式的系统认知。机械臂系统是一个典型的分布式实时控制系统：视觉传感器节点负责识别目标物体，运动学解算节点负责计算关节角度，轨迹规划节点负责生成平滑路径，而硬件驱动节点则负责将指令下发至伺服电机。这些节点之间如何高效、可靠地交换数据，如何管理共享参数，如何协同启动，以及如何构建整个工作空间，都依赖于 ROS2 的基础设施。本章将围绕这八个核心概念展开，为后续 MoveIt2 的深入学习打下坚实基础。

2.1 节点与话题：机械臂数据流的血脉

核心原理

在 ROS2 中，节点（Node）是执行计算任务的最小进程单元。一个机械臂控制系统通常由多个节点组成：arm_controller 节点负责接收目标位姿并计算关节角度，joint_state_publisher 节点发布当前关节角度，robot_state_publisher 节点负责发布 TF 变换关系。节点之间通过话题（Topic）进行异步通信，话题采用发布/订阅模式，发布者将消息写入话题，订阅者从话题读取消息，双方无需知道对方的存在。

话题通信的核心优势在于解耦。例如，机械臂的关节状态话题 /joint_states 可以被多个订阅者同时使用：MoveIt2 的规划器需要它来感知当前状态，RViz 可视化工具需要它来渲染模型，而安全监控节点需要它来检测异常。这种一对多的通信模式在机械臂系统中极为常见。

操作流程与判断方法

创建节点和话题的流程如下：

1. 初始化 ROS2 客户端库：rclcpp::init()
2. 创建节点实例：auto node = std::make_shared<rclcpp::Node>("arm_controller")
3. 创建发布者：node->create_publisher<sensor_msgs::msg::JointState>("/joint_states", 10)
4. 创建订阅者：node->create_subscription<geometry_msgs::msg::Pose>("/target_pose", 10, callback)
5. 使用 rclcpp::spin() 保持节点运行，处理回调

判断话题通信是否正常，可以使用以下命令：

# 查看所有活跃节点
ros2 node list

# 查看节点信息
ros2 node info /arm_controller

# 查看话题列表
ros2 topic list

# 实时监听话题数据
ros2 topic echo /joint_states

# 查看话题发布频率
ros2 topic hz /joint_states

案例拆解：关节状态发布与订阅

假设我们有一个六轴机械臂，需要实时获取每个关节的角度。我们创建 joint_state_publisher 节点，以 50Hz 的频率发布 sensor_msgs::msg::JointState 消息。该消息包含三个数组：name（关节名称）、position（关节角度）、velocity（关节速度）。

在实际调试中，我们发现 ros2 topic hz /joint_states 显示的频率只有 20Hz，远低于预期的 50Hz。通过 ros2 topic info /joint_states 查看发布者数量，发现有两个节点同时向该话题发布数据，导致 QoS 策略冲突。解决方法是统一 QoS 策略，或者将话题拆分为 /joint_states（真实传感器数据）和 /joint_states_estimated（滤波后数据）。

常见误区与总结

• 误区一：认为话题名称必须全局唯一。实际上，话题名称在同一个命名空间内唯一即可，不同命名空间可以有相同名称的话题。
• 误区二：忽略 QoS 匹配。发布者和订阅者的 QoS 不兼容时，通信会静默失败，不会报错。
• 误区三：在回调函数中执行耗时操作。这会阻塞节点的事件循环，导致话题频率下降。

2.2 服务与动作：同步请求与长时任务

核心原理

服务（Service）采用客户端/服务器模式，适用于一次性、短时、需要确认的请求-响应场景。例如，机械臂的运动学正解（Forward Kinematics）计算：客户端发送关节角度，服务器返回末端位姿。服务通信是同步的，客户端发送请求后会阻塞等待响应。

动作（Action）则专为长时任务设计，适用于需要持续反馈和可取消的场景。机械臂的轨迹规划与执行是动作的典型应用：客户端发送目标位姿，服务器持续反馈当前执行进度（如已完成 30%），并允许客户端在必要时取消任务。动作通信由三部分组成：目标（Goal）、反馈（Feedback）、结果（Result）。

操作流程与判断方法

创建服务端和客户端的核心代码模式：

// 服务端
rclcpp::Service<custom_srvs::srv::FK>::SharedPtr service =
  node->create_service<custom_srvs::srv::FK>("compute_fk", 
    [](const std::shared_ptr<custom_srvs::srv::FK::Request> req,
       std::shared_ptr<custom_srvs::srv::FK::Response> res) {
      // 计算正运动学
      res->pose = forward_kinematics(req->joint_angles);
    });

// 动作服务器
rclcpp_action::Server<control_msgs::action::FollowJointTrajectory>::SharedPtr action_server =
  rclcpp_action::create_server<control_msgs::action::FollowJointTrajectory>(
    node, "follow_joint_trajectory",
    handle_goal, handle_cancel, handle_accepted);

判断服务是否可用：ros2 service list 和 ros2 service type /compute_fk。测试服务调用：ros2 service call /compute_fk custom_srvs/srv/FK "{joint_angles: [0.1, 0.2, 0.3, 0.4, 0.5, 0.6]}"。

案例拆解：机械臂轨迹执行动作

我们设计一个完整的机械臂轨迹执行流程。客户端（MoveIt2 规划器）发送目标关节轨迹到动作服务器（硬件驱动节点）。动作服务器收到目标后，开始逐点执行轨迹，每执行一个轨迹点，就发布一次反馈（当前关节角度、剩余时间）。如果客户端检测到紧急停止信号，可以发送取消请求，动作服务器立即停止电机并返回取消确认。

关键参数设置：

参数	推荐值	说明
Goal 超时时间	5.0s	超过此时长未收到目标视为超时
反馈频率	20Hz	与关节状态发布频率一致
取消超时	1.0s	取消请求发出后等待服务器确认的时间

常见误区与总结

• 误区一：将动作用于短时任务。动作的通信开销远大于服务，短时任务使用动作会引入不必要的延迟。
• 误区二：忽略动作的取消机制。在机械臂控制中，取消动作必须能够快速停止物理运动，否则可能造成安全事故。
• 误区三：服务端处理耗时过长。服务是同步的，客户端会一直等待，如果服务端处理超过 10 秒，应改用动作。

2.3 参数、命名空间与工程组织

核心原理

参数（Parameter）是节点的配置项，可以在运行时动态修改。机械臂控制中，PID 增益、最大速度限制、加速度限制等都可以作为参数管理。ROS2 参数系统支持整数、浮点、字符串、布尔、数组等类型，并支持参数描述（类型、范围、描述信息）。

命名空间（Namespace）用于对节点、话题、服务等资源进行逻辑分组。例如，一个场景中有两台机械臂，可以将它们分别放在 /arm1 和 /arm2 命名空间下，这样 /arm1/joint_states 和 /arm2/joint_states 就不会冲突。命名空间还支持嵌套，如 /robot/left_arm/joint_states。

操作流程与判断方法

参数操作的核心命令：

# 列出节点所有参数
ros2 param list /arm_controller

# 获取参数值
ros2 param get /arm_controller max_velocity

# 设置参数值
ros2 param set /arm_controller max_velocity 0.5

# 保存参数到文件
ros2 param dump /arm_controller

# 从文件加载参数
ros2 param load /arm_controller params.yaml

在代码中声明参数：

node->declare_parameter<double>("max_velocity", 0.3, 
  rcl_interfaces::msg::ParameterDescriptor()
    .set__description("Maximum joint velocity (rad/s)")
    .set__floating_point_range({rcl_interfaces::msg::FloatingPointRange()
      .set__from_value(0.0).set__to_value(1.0)}));

案例拆解：多机械臂协同的命名空间设计

假设我们有一个双机械臂协作工作站，需要同时控制左右两个机械臂。合理的命名空间设计如下：

资源	命名空间	完整名称
左臂关节状态	/left_arm	/left_arm/joint_states
右臂关节状态	/right_arm	/right_arm/joint_states
左臂规划器	/left_arm	/left_arm/moveit_planner
共享视觉话题	/vision	/vision/object_pose

在 launch 文件中，可以通过 namespace 参数为节点指定命名空间：

from launch_ros.actions import Node

left_arm_node = Node(
    package="arm_controller",
    executable="arm_controller_node",
    namespace="left_arm",
    parameters=[{"max_velocity": 0.5}]
)

常见误区与总结

• 误区一：在代码中硬编码参数值。应通过参数系统动态配置，便于运行时调整。
• 误区二：命名空间使用路径。在 launch 文件中应使用相对路径，通过 namespace 参数统一管理。
• 误区三：忽略参数的类型和范围校验。ROS2 参数系统支持类型和范围校验，应充分利用。

2.4 Launch 文件与 Colcon 构建

核心原理

Launch 文件是 ROS2 中用于多节点协同启动的配置文件。一个完整的机械臂系统可能需要启动 10 个以上的节点，手动逐个启动不仅效率低，而且难以管理节点间的依赖关系。Launch 文件支持节点启动、参数加载、命名空间设置、条件判断、事件触发等高级功能。

Colcon 是 ROS2 的官方构建工具，用于编译工作空间中的多个包。它支持并行编译、增量编译、依赖排序等功能。Colcon 构建的核心概念包括：src（源码目录）、build（构建中间文件）、install（安装目录）、log（日志目录）。

操作流程与判断方法

Colcon 构建的标准流程：

# 创建工作空间
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws

# 构建所有包
colcon build

# 构建指定包
colcon build --packages-select arm_controller

# 构建并运行测试
colcon build --packages-select arm_controller --cmake-args -DBUILD_TESTING=ON

# 设置环境变量
source install/setup.bash

Launch 文件的基本结构（Python 格式）：

from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    return LaunchDescription([
        Node(
            package="arm_driver",
            executable="arm_driver_node",
            name="arm_driver",
            namespace="left_arm",
            parameters=["config/arm_params.yaml"],
            output="screen"
        ),
        Node(
            package="moveit2",
            executable="moveit_planner",
            name="moveit_planner",
            namespace="left_arm",
            parameters=[{"planning_time": 5.0}]
        )
    ])

案例拆解：完整的机械臂系统启动

我们设计一个完整的机械臂系统 launch 文件，包含以下节点：

1. 硬件驱动节点：负责与伺服电机通信，发布关节状态，接收速度指令
2. 关节状态发布节点：从驱动节点获取数据，发布标准化的 JointState 消息
3. 机器人状态发布节点：发布 TF 变换，维护机器人模型
4. MoveIt2 规划节点：接收目标位姿，规划轨迹
5. RViz 可视化节点：显示机器人模型和规划结果

启动顺序至关重要：必须先启动硬件驱动节点，等待其初始化完成（通过事件机制检测），再启动 MoveIt2 规划节点。Launch 文件支持事件驱动：

from launch.actions import RegisterEventHandler, TimerAction
from launch.event_handlers import OnProcessStart

def generate_launch_description():
    driver_node = Node(package="arm_driver", executable="arm_driver_node")
    
    # 等待驱动节点启动后，再启动规划器
    planner_node = Node(package="moveit2", executable="moveit_planner")
    
    return LaunchDescription([
        driver_node,
        RegisterEventHandler(
            OnProcessStart(
                target_action=driver_node,
                on_start=[TimerAction(period=2.0, actions=[planner_node])]
            )
        )
    ])

常见误区与总结

• 误区一：在 launch 文件中硬编码路径。应使用 os.path.join 和包路径查找函数，确保可移植性。
• 误区二：忽略节点启动顺序。机械臂系统中，驱动节点必须先于规划节点启动，否则规划器无法获取初始状态。
• 误区三：Colcon 构建时忽略依赖。应使用 rosdep 工具自动安装系统依赖，避免手动安装遗漏。

2.5 综合实战：构建一个最小机械臂控制工作空间

实战场景与目标

我们将构建一个包含两个包的工作空间：arm_msgs（自定义消息和服务）和 arm_controller（核心控制逻辑）。目标是实现一个简单的单关节机械臂控制：接收目标角度，通过 PID 控制到达目标位置，并实时发布关节状态。

实施步骤

第一步：创建包结构

cd ~/ros2_ws/src
ros2 pkg create arm_msgs --build-type ament_cmake
ros2 pkg create arm_controller --build-type ament_python --dependencies rclpy rclcpp std_msgs sensor_msgs arm_msgs

第二步：定义自定义消息

在 arm_msgs 包中创建 srv/SetAngle.srv：

float64 target_angle
---
bool success
string message

第三步：实现控制器节点

import rclpy
from rclpy.node import Node
from arm_msgs.srv import SetAngle
from sensor_msgs.msg import JointState

class ArmController(Node):
    def __init__(self):
        super().__init__('arm_controller')
        self.srv = self.create_service(SetAngle, 'set_angle', self.set_angle_callback)
        self.pub = self.create_publisher(JointState, 'joint_states', 10)
        self.current_angle = 0.0
        self.target_angle = 0.0
        self.timer = self.create_timer(0.02, self.control_loop)  # 50Hz
        
    def set_angle_callback(self, request, response):
        self.target_angle = request.target_angle
        response.success = True
        response.message = f"Target set to {request.target_angle}"
        return response
    
    def control_loop(self):
        # 简单的比例控制
        error = self.target_angle - self.current_angle
        self.current_angle += 0.1 * error
        
        # 发布关节状态
        msg = JointState()
        msg.name = ['joint1']
        msg.position = [self.current_angle]
        self.pub.publish(msg)

def main():
    rclpy.init()
    node = ArmController()
    rclpy.spin(node)
    rclpy.shutdown()

第四步：编写 launch 文件

from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    return LaunchDescription([
        Node(
            package='arm_controller',
            executable='arm_controller_node',
            name='arm_controller',
            output='screen'
        ),
        Node(
            package='rviz2',
            executable='rviz2',
            name='rviz2',
            arguments=['-d', 'config/arm.rviz']
        )
    ])

第五步：构建与测试

cd ~/ros2_ws
colcon build --packages-select arm_msgs arm_controller
source install/setup.bash
ros2 launch arm_controller arm_controller.launch.py

在另一个终端测试服务调用：

ros2 service call /arm_controller/set_angle arm_msgs/srv/SetAngle "{target_angle: 1.57}"
ros2 topic echo /arm_controller/joint_states

结果分析与复盘

通过这个实战，我们验证了 ROS2 核心机制在机械臂控制中的完整应用：服务用于接收目标角度，话题用于发布状态，参数可以扩展为 PID 增益，launch 文件实现了多节点协同启动，colcon 完成了工作空间构建。这个最小系统可以作为后续 MoveIt2 集成的基础框架。

总结与知识框架

本章覆盖了 ROS2 的八个核心概念，它们的关系可以总结为：节点是基本单元，话题/服务/动作是通信方式，参数是配置手段，命名空间是组织逻辑，launch 文件是启动编排，colcon 是构建工具。在机械臂控制系统中，这些机制协同工作：MoveIt2 规划器通过动作接口发送轨迹，硬件驱动节点通过话题发布状态，通过服务响应运动学计算，通过参数调整控制增益，通过命名空间隔离不同机械臂，通过 launch 文件一键启动整个系统，通过 colcon 完成编译部署。掌握这些基础，是深入理解 MoveIt2 规划与控制的前提。