4、第一个ROS2程序：编写并运行发布者-订阅者节点，理解rclpy/rclcpp基础API与节点生命周期

在完成了ROS2环境安装与核心概念学习之后，我们正式进入第一个实战程序：编写并运行一个发布者-订阅者（Publisher-Subscriber）节点对。这是ROS2通信机制中最基础、最核心的模型，也是后续学习服务、动作、参数等高级特性的基石。本章将带领你使用Python（rclpy）和C++（rclcpp）两种语言分别实现一个“字符串发布者”与“字符串订阅者”，并深入剖析节点生命周期、上下文（Context）、节点句柄（Node Handle）以及rclpy/rclcpp中的关键API。通过本章学习，你将能够独立创建、编译、运行并调试一个最小化的ROS2通信系统。

上图展示了本章将要实现的通信架构。左侧的发布者节点（talker）负责创建发布器（Publisher），周期性地向话题 /chatter 发送 std_msgs/String 类型的消息；右侧的订阅者节点（listener）创建订阅器（Subscription），监听同一话题并处理接收到的消息。图中下半部分展示了ROS2节点的生命周期状态机，这是理解节点行为的关键。接下来，我们将从核心原理出发，逐步拆解实现过程。

4.1 核心原理：rclpy/rclcpp API 与节点生命周期

ROS2的客户端库（rclpy和rclcpp）是对底层C库（rcl）的封装，提供了面向对象的编程接口。理解这些API的设计哲学，是编写高质量节点的前提。

节点（Node）是ROS2中一切通信和计算的基本单元。每个节点在系统中拥有唯一的名称，并可以创建发布器、订阅器、服务服务器、客户端、参数等。节点生命周期（Lifecycle）是ROS2引入的受控状态机，用于管理节点的资源初始化和运行状态，尤其在需要确定性启动顺序或优雅关闭的场景下非常有用。默认情况下，我们创建的节点是“非生命周期”节点，直接进入激活状态；但理解生命周期有助于我们使用rclpy.lifecycle或rclcpp_lifecycle编写更健壮的组件。

在rclpy中，核心API包括：

• rclpy.init()：初始化客户端库，创建全局上下文（Context）。
• rclpy.create_node(name)：创建节点实例。
• node.create_publisher(msg_type, topic, qos)：创建发布器。
• node.create_subscription(msg_type, topic, callback, qos)：创建订阅器。
• rclpy.spin(node)：阻塞式处理回调，直到节点被关闭。

在rclcpp中，对应API为：

• rclcpp::init()
• std::make_shared<rclcpp::Node>(name)
• node->create_publisher<std_msgs::msg::String>(topic, qos)
• node->create_subscription<std_msgs::msg::String>(topic, qos, callback)
• rclcpp::spin(node)

生命周期状态机包含四个主状态：未配置（Unconfigured）、未激活（Inactive）、激活（Active）和已销毁（Finalized）。转换由回调函数触发，例如on_configure()、on_activate()、on_deactivate()和on_shutdown()。对于普通节点，我们可以忽略这些状态，直接使用默认的激活状态。

4.2 操作流程：编写、编译与运行发布者-订阅者节点

我们将以Python为例，展示完整的开发流程。C++流程类似，但需要额外配置CMakeLists.txt。

步骤1：创建工作空间与包

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

# 创建Python包（使用ament_python）
ros2 pkg create --build-type ament_python py_talker_listener

# 创建C++包（使用ament_cmake）
ros2 pkg create --build-type ament_cmake cpp_talker_listener

步骤2：编写Python发布者节点

编辑py_talker_listener/py_talker_listener/talker.py：

import rclpy
from rclpy.node import Node
from std_msgs.msg import String

class Talker(Node):
    def __init__(self):
        super().__init__('talker')
        self.publisher_ = self.create_publisher(String, 'chatter', 10)
        self.timer = self.create_timer(0.5, self.timer_callback)
        self.count = 0

    def timer_callback(self):
        msg = String()
        msg.data = f'Hello, ROS2! {self.count}'
        self.publisher_.publish(msg)
        self.get_logger().info(f'Publishing: "{msg.data}"')
        self.count += 1

def main(args=None):
    rclpy.init(args=args)
    node = Talker()
    try:
        rclpy.spin(node)
    except KeyboardInterrupt:
        pass
    finally:
        node.destroy_node()
        rclpy.shutdown()

if __name__ == '__main__':
    main()

步骤3：编写Python订阅者节点

编辑py_talker_listener/py_talker_listener/listener.py：

import rclpy
from rclpy.node import Node
from std_msgs.msg import String

class Listener(Node):
    def __init__(self):
        super().__init__('listener')
        self.subscription = self.create_subscription(
            String, 'chatter', self.listener_callback, 10)

    def listener_callback(self, msg):
        self.get_logger().info(f'I heard: "{msg.data}"')

def main(args=None):
    rclpy.init(args=args)
    node = Listener()
    try:
        rclpy.spin(node)
    except KeyboardInterrupt:
        pass
    finally:
        node.destroy_node()
        rclpy.shutdown()

if __name__ == '__main__':
    main()

步骤4：配置setup.py并编译

在setup.py中添加入口点：

entry_points={
    'console_scripts': [
        'talker = py_talker_listener.talker:main',
        'listener = py_talker_listener.listener:main',
    ],
}

然后编译并运行：

cd ~/ros2_ws
colcon build --packages-select py_talker_listener
source install/setup.bash

# 终端1运行发布者
ros2 run py_talker_listener talker

# 终端2运行订阅者
ros2 run py_talker_listener listener

观察终端输出，订阅者应能持续打印接收到的消息。

4.3 案例拆解：从零调试一个“静默”的通信故障

假设你按照上述步骤操作，但订阅者终端没有任何输出。这是一个典型的初学者问题。我们通过一个案例来拆解排障过程。

背景与现象：在Ubuntu 22.04 + ROS2 Humble环境下，发布者正常打印“Publishing”，但订阅者无任何反应。

关键输入数据：ros2 node list 显示两个节点都在；ros2 topic list 显示 /chatter 存在；ros2 topic info /chatter 显示有1个发布者和1个订阅者。

分析判断过程：既然节点和话题都存在，问题可能出在消息类型不匹配或QoS策略不一致。检查发现，发布者使用了默认QoS（深度10），订阅者也使用了默认QoS，理论上应该兼容。进一步检查发现，订阅者回调函数中使用了self.get_logger().info()，但日志级别可能被设置为WARN，导致INFO级别的日志被过滤。

实际操作步骤：

1. 在订阅者节点初始化时，添加self.get_logger().set_level(rclpy.logging.LoggingSeverity.DEBUG)，观察是否有更详细的日志输出。
2. 使用rqt_console工具查看所有日志消息。
3. 检查代码缩进和回调函数注册是否正确。

结果对比：通过设置DEBUG级别，发现订阅者确实收到了消息，但INFO日志被抑制。修改日志级别后，问题解决。

风险与代价：此问题不影响通信本身，但会误导开发者认为通信失败。建议在开发阶段使用DEBUG级别，生产环境再调整。

复盘经验：遇到“静默”问题，优先检查日志级别、QoS兼容性和消息类型，而不是盲目修改代码。

4.4 常见误区与总结复盘

在编写第一个ROS2程序时，以下误区值得警惕：

误区	后果	正确做法
忘记调用rclpy.init()	运行时抛出rclpy._rclpy_pybind11.RCLError	在创建节点前必须初始化
发布器或订阅器被垃圾回收	节点运行但无通信	将发布器/订阅器保存为成员变量（如self.publisher_）
回调函数执行时间过长	阻塞事件循环，导致其他回调延迟	使用多线程执行器或异步处理
话题名称拼写不一致	节点无法发现对方	使用ros2 topic list验证
QoS策略不匹配（如Best Effort vs Reliable）	订阅者收不到消息	确保发布者和订阅者QoS兼容

总结复盘：本章通过一个最小化的发布者-订阅者示例，完整展示了ROS2节点开发的核心流程。重点在于理解rclpy.init()、create_node()、create_publisher()、create_subscription()和spin()这几个API的协作关系。节点生命周期虽然在本例中未显式使用，但它是理解ROS2节点状态管理的基础。建议读者在完成Python版本后，尝试用C++重写一遍，对比两种语言的API差异，这将极大加深对ROS2抽象层的理解。