机器人 / 系统课时

编写定时发送消息的发布者

编写定时发送消息的发布者

让 ROS 2 节点每隔一秒生成一个模拟温度值,并通过话题持续发布,是实现传感器数据流的基本操作。本篇使用 Python 和 rclpy 完成发布者节点,构建运行后,通过命令行验证消息内容、发布频率和节点连接状态。

学习目标

  • 使用 create_publisher() 创建指定消息类型和话题名称的发布端点。
  • 使用 create_timer() 周期性生成、封装并发布模拟传感器数据。
  • 通过 ros2 topic 命令验证消息类型、内容与发布频率。

准备 Python 功能包

以下操作适用于 Ubuntu 24.04、ROS 2 Jazzy 和 Python 3.12。开始前应已安装 ROS 2、colcon 及 rclpy、std_msgs,并使用 Bash 终端。

本例创建名为 sensor_demo 的 ament_python 功能包,其中的可执行节点命名为 sensor_publisher。

bash
source /opt/ros/jazzy/setup.bash
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws/src
ros2 pkg create sensor_demo --build-type ament_python --license Apache-2.0 --node-name sensor_publisher --dependencies rclpy std_msgs

预期结果:在 ~/ros2_ws/src/sensor_demo/ 下生成 package.xml、setup.py、setup.cfg 和 Python 包目录,其中包含 sensor_demo/sensor_publisher.py。

--node-name sensor_publisher 会生成节点入口文件,并在 setup.py 的 console_scripts 中注册对应入口,因此本例不需要手动追加注册项。--dependencies 则将 rclpy 和 std_msgs 声明为功能包依赖。

编写定时发布节点

打开 ~/ros2_ws/src/sensor_demo/sensor_demo/sensor_publisher.py,用以下完整代码替换自动生成的模板。

python
import rclpy
from rclpy.executors import ExternalShutdownException
from rclpy.node import Node
from std_msgs.msg import Float32


class TemperaturePublisher(Node):
    def __init__(self):
        super().__init__('sensor_publisher')

        # 消息类型为 Float32,队列深度为 10
        self.publisher = self.create_publisher(
            Float32, '/sensor/temperature', 10
        )
        self.counter = 0

        # 每隔 1 秒由执行器触发一次回调
        self.timer = self.create_timer(1.0, self.publish_temperature)

    def publish_temperature(self):
        msg = Float32()
        # 六个采样值循环,模拟缓慢变化的温度
        msg.data = 22.0 + 0.5 * (self.counter % 6)

        self.publisher.publish(msg)
        self.get_logger().info(f'temperature={msg.data:.1f} C')
        self.counter += 1


def main(args=None):
    rclpy.init(args=args)
    node = TemperaturePublisher()

    try:
        rclpy.spin(node)
    except (KeyboardInterrupt, ExternalShutdownException):
        pass
    finally:
        node.destroy_node()
        if rclpy.ok():
            rclpy.shutdown()


if __name__ == '__main__':
    main()

预期行为:节点启动后约每秒发布一条 std_msgs/msg/Float32 消息,温度值依次为 22.0、22.5、23.0、23.5、24.0、24.5,然后重新从 22.0 开始。

这里有三个关键接口:

  • create_publisher(Float32, '/sensor/temperature', 10):创建发布端点,约定消息类型、话题名称和 QoS 队列深度。
  • create_timer(1.0, callback):注册周期为 1.0 秒的定时器,达到触发时间后由执行器调度回调。
  • publisher.publish(msg):将已经赋值的 ROS 消息交给发布端点发送,而不是直接发送 Python 数字。

Float32 只有 data 字段,没有时间戳或单位字段。本例约定单位为摄氏度;真实传感器需要时间戳、单位语义和测量方差时,应根据业务需求选择更完整的消息类型,例如 sensor_msgs/msg/Temperature。

理解定时器与消息的数据流

创建发布者并不会自动产生数据。真正触发发布操作的是定时器回调,而 rclpy.spin(node) 让执行器持续处理准备就绪的回调。若缺少 spin() 或其他等效执行器调度,即使定时器已经创建,也不能按照预期持续执行回调。

定时器触发温度消息发布及话题订阅的数据流

self.counter % 6 让数据按照六个离散值循环,便于观察是否漏发或重复。定时器周期为 1.0 秒,对应目标频率为 1 Hz;实际回调时刻会受到操作系统调度、执行器负载和回调耗时影响,不保证严格实时。

这里的队列深度 10 表示采用 Keep Last 历史策略时最多保留最近十条待处理消息的深度设置,并不意味着每秒发布十条,也不意味着订阅者加入后一定可以读取之前的十条数据。默认的 Volatile 持久性不会为后加入的订阅者重放历史消息。

构建并运行发布者

保存代码后,回到工作空间根目录。使用 --packages-select 只构建当前功能包,避免对无关项目执行完整构建。

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

预期输出的关键部分如下,实际构建耗时可能不同:

text
Starting >>> sensor_demo
Finished <<< sensor_demo [<TIME>]
Summary: 1 package finished [<TIME>]

<TIME> 代表实际构建耗时。若工作空间内已有旧版本同名功能包,应确认当前终端加载的是本工作空间的安装环境。

在终端 A 启动发布者:

bash
ros2 run sensor_demo sensor_publisher

预期输出示例:

text
[INFO] [<TIME>] [sensor_publisher]: temperature=22.0 C
[INFO] [<TIME>] [sensor_publisher]: temperature=22.5 C
[INFO] [<TIME>] [sensor_publisher]: temperature=23.0 C
[INFO] [<TIME>] [sensor_publisher]: temperature=23.5 C

日志中的 <TIME> 是运行时生成的时间戳,实际值不同。节点会持续运行;此时不要关闭终端 A。在需要停止发布时按 Ctrl+C,程序将释放节点资源,并在通信上下文仍有效时调用 rclpy.shutdown()。

验证消息内容与通信频率

打开终端 B,先加载 ROS 2 与工作空间环境,再订阅温度话题。这里使用 --csv 输出简洁的单字段数值,避免完整 YAML 消息反复显示字段名。

bash
source /opt/ros/jazzy/setup.bash
source ~/ros2_ws/install/setup.bash
ros2 topic echo --csv /sensor/temperature

预期输出示例:

text
22.5
23.0
23.5
24.0

由于订阅者可能从发布循环的任意时刻加入,第一条不一定是 22.0。只要后续数值按 0.5 的间隔递增,在 24.5 后回到 22.0,就符合本例生成逻辑。保持此终端运行,便于继续检查连接数量。

再打开终端 C,加载相同环境,检查消息类型与发布、订阅端点数量:

bash
source /opt/ros/jazzy/setup.bash
ros2 topic type /sensor/temperature
ros2 topic info /sensor/temperature

在终端 A 和 B 都正常运行、且没有其他节点使用该话题时,预期输出为:

text
std_msgs/msg/Float32
Type: std_msgs/msg/Float32
Publisher count: 1
Subscription count: 1

最后统计实际接收频率:

bash
ros2 topic hz /sensor/temperature

预期结果:经过若干条消息后显示 average rate,稳定状态下应接近 1.0 Hz,允许存在少量调度抖动。此命令测量的是订阅端收到消息的频率,并非定时器绝对精度。

如果没有收到数据,按以下顺序排查:

  1. 无法运行节点:检查 colcon build 是否成功、是否执行 source ~/ros2_ws/install/setup.bash,并核对 setup.py 中的可执行入口。
  2. 话题列表没有目标话题:确认发布者进程仍然运行,代码中的名称确实是 /sensor/temperature,而不是 /temperature。
  3. 话题存在但订阅无输出:比较终端的 ROS_DOMAIN_ID、检查 ros2 topic info 中发布者数量,并确认双方使用兼容的 QoS 配置。
  4. 频率明显低于 1 Hz:检查 CPU 负载和回调是否包含阻塞操作,避免在定时器回调中执行长时间等待或复杂计算。

完成验收后,终端 B 能持续接收循环变化的温度数值,终端 C 能确认消息类型和约 1 Hz 的接收频率。由此可以验证从定时器回调、消息封装、Publisher 发布到独立订阅端接收的完整数据链路。

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

目录与阅读设置

阅读设置

17

记录一个想法

编写定时发送消息的发布者

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

登录哪都通