机器人 / 系统课时
编写定时发送消息的发布者
编写定时发送消息的发布者
让 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。
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,用以下完整代码替换自动生成的模板。
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 只构建当前功能包,避免对无关项目执行完整构建。
cd ~/ros2_ws
colcon build --packages-select sensor_demo
source install/setup.bash预期输出的关键部分如下,实际构建耗时可能不同:
Starting >>> sensor_demo
Finished <<< sensor_demo [<TIME>]
Summary: 1 package finished [<TIME>]<TIME> 代表实际构建耗时。若工作空间内已有旧版本同名功能包,应确认当前终端加载的是本工作空间的安装环境。
在终端 A 启动发布者:
ros2 run sensor_demo sensor_publisher预期输出示例:
[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 消息反复显示字段名。
source /opt/ros/jazzy/setup.bash
source ~/ros2_ws/install/setup.bash
ros2 topic echo --csv /sensor/temperature预期输出示例:
22.5
23.0
23.5
24.0由于订阅者可能从发布循环的任意时刻加入,第一条不一定是 22.0。只要后续数值按 0.5 的间隔递增,在 24.5 后回到 22.0,就符合本例生成逻辑。保持此终端运行,便于继续检查连接数量。
再打开终端 C,加载相同环境,检查消息类型与发布、订阅端点数量:
source /opt/ros/jazzy/setup.bash
ros2 topic type /sensor/temperature
ros2 topic info /sensor/temperature在终端 A 和 B 都正常运行、且没有其他节点使用该话题时,预期输出为:
std_msgs/msg/Float32
Type: std_msgs/msg/Float32
Publisher count: 1
Subscription count: 1最后统计实际接收频率:
ros2 topic hz /sensor/temperature预期结果:经过若干条消息后显示 average rate,稳定状态下应接近 1.0 Hz,允许存在少量调度抖动。此命令测量的是订阅端收到消息的频率,并非定时器绝对精度。
如果没有收到数据,按以下顺序排查:
- 无法运行节点:检查
colcon build是否成功、是否执行source ~/ros2_ws/install/setup.bash,并核对setup.py中的可执行入口。 - 话题列表没有目标话题:确认发布者进程仍然运行,代码中的名称确实是
/sensor/temperature,而不是/temperature。 - 话题存在但订阅无输出:比较终端的
ROS_DOMAIN_ID、检查ros2 topic info中发布者数量,并确认双方使用兼容的 QoS 配置。 - 频率明显低于 1 Hz:检查 CPU 负载和回调是否包含阻塞操作,避免在定时器回调中执行长时间等待或复杂计算。
完成验收后,终端 B 能持续接收循环变化的温度数值,终端 C 能确认消息类型和约 1 Hz 的接收频率。由此可以验证从定时器回调、消息封装、Publisher 发布到独立订阅端接收的完整数据链路。