机器人 / 系统课时

连接温度发布与监测节点

连接温度发布与监测节点

本课将一个每 0.5 秒发布温度的 Python 节点和一个监测订阅者接入同一 Launch 文件。完成后可以一次启动两个节点,核对温度消息字段、运行日志,并用命令检查约 2 Hz 的实际接收频率。

学习目标

  • 使用 sensor_msgs/msg/Temperature 传递带时间戳、温度和方差的读数。
  • 为两个 Python 节点注册可执行入口,并通过一个 Launch 文件启动。
  • 从话题、日志和接收频率三个角度验收通信链路。

创建功能包并约定消息

适用环境为 Ubuntu 24.04、ROS 2 Jazzy,已安装 colcon 和 ROS 2 Python 开发组件。以下以全新工作空间 ~/ros2_ws 为例;如果已有同名功能包,请在原包中添加文件,不要重复创建。

bash
source /opt/ros/jazzy/setup.bash
mkdir -p ~/ros2_ws/src
cd ~/ros2_ws/src
ros2 pkg create temperature_demo --build-type ament_python --license Apache-2.0 --dependencies rclpy sensor_msgs launch launch_ros
mkdir -p temperature_demo/launch
test -f temperature_demo/setup.py && echo "package ready"

预期输出(末行,前面的创建日志可能不同):

text
package ready

采用标准消息 sensor_msgs/msg/Temperature,不必自行定义 .msg 文件。发布者与订阅者统一使用 /room/temperature,其关键字段为:

字段 本例取值或含义
header.stamp 发布时的 ROS 时间戳
header.frame_id room_sensor,测量坐标系标识
temperature 22.0、22.5、23.0 循环变化,单位 °C
variance 0.04,单位 °C²,不是温度值

实现发布者与监测者

在 ~/ros2_ws/src/temperature_demo/temperature_demo/temperature_publisher.py 写入以下完整代码。定时器周期为 0.5 秒,理论采样率为 1 / 0.5 = 2 Hz。生成固定循环读数,便于判断订阅端是否解析错字段。

python
import rclpy
from rclpy.node import Node
from sensor_msgs.msg import Temperature

class TemperaturePublisher(Node):
    def __init__(self):
        super().__init__('temperature_publisher')
        self.publisher = self.create_publisher(
            Temperature, '/room/temperature', 10
        )
        self.sample_index = 0
        # 每 0.5 秒发布一次;两端均使用兼容的默认可靠 QoS
        self.timer = self.create_timer(0.5, self.send_sample)

    def send_sample(self):
        msg = Temperature()
        msg.header.stamp = self.get_clock().now().to_msg()
        msg.header.frame_id = 'room_sensor'
        # 循环发送三个可预测的摄氏温度,方便端到端验收
        msg.temperature = 22.0 + (self.sample_index % 3) * 0.5
        msg.variance = 0.04
        self.publisher.publish(msg)
        self.sample_index += 1

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

if __name__ == '__main__':
    main()

预期结果:节点运行时向 /room/temperature 发布 Temperature 消息;temperature 按 22.0、22.5、23.0 循环,variance 始终为 0.04。实际时间戳每次不同。

在同级目录新建 temperature_monitor.py。订阅回调先检查来源标识和数值有效性,再输出便于检索的结构化日志。方差不能当作第二个温度值。

python
import math

import rclpy
from rclpy.node import Node
from sensor_msgs.msg import Temperature

class TemperatureMonitor(Node):
    def __init__(self):
        super().__init__('temperature_monitor')
        # 话题名、消息类型必须与发布者一致
        self.subscription = self.create_subscription(
            Temperature, '/room/temperature', self.on_sample, 10
        )

    def on_sample(self, msg):
        if msg.header.frame_id != 'room_sensor':
            self.get_logger().warn('unexpected frame_id')
            return
        if (not math.isfinite(msg.temperature)
                or not math.isfinite(msg.variance)
                or msg.variance < 0.0):
            self.get_logger().warn('invalid temperature fields')
            return
        # 解析真实字段;variance 的单位是摄氏度平方
        self.get_logger().info(
            f'sensor={msg.header.frame_id} '
            f'temp={msg.temperature:.1f} C '
            f'variance={msg.variance:.2f} C^2'
        )

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

if __name__ == '__main__':
    main()

预期结果:收到有效消息后,监测节点逐条记录 sensor、temp 和 variance;来源不符或数值无效时记录警告,不输出正常读数。

注册可执行入口并编排 Launch

将功能包根目录的 setup.py 替换为以下内容。console_scripts 让 ros2 run 和 Launch 找到两个 Python 入口;data_files 将 Launch 文件安装到功能包共享目录。保留 ros2 pkg create 生成的 setup.cfg、package.xml 和 resource/temperature_demo。

python
from glob import glob
from os.path import join
from setuptools import setup

package_name = 'temperature_demo'

setup(
    name=package_name,
    version='0.0.0',
    packages=[package_name],
    data_files=[
        ('share/ament_index/resource_index/packages',
         ['resource/' + package_name]),
        (join('share', package_name), ['package.xml']),
        # 不安装 launch 文件就无法通过包名找到它
        (join('share', package_name, 'launch'), glob('launch/*.launch.py')),
    ],
    install_requires=['setuptools'],
    zip_safe=True,
    maintainer='demo',
    maintainer_email='demo@example.com',
    description='Temperature topic integration demo',
    license='Apache-2.0',
    entry_points={
        'console_scripts': [
            'temperature_publisher = temperature_demo.temperature_publisher:main',
            'temperature_monitor = temperature_demo.temperature_monitor:main',
        ],
    },
)

预期结果:构建安装后将出现两个可执行入口,且 temperature_pair.launch.py 可由 ros2 launch 按包名定位。

在 ~/ros2_ws/src/temperature_demo/launch/temperature_pair.launch.py 写入:

python
from launch import LaunchDescription
from launch_ros.actions import Node

def generate_launch_description():
    # Launch 负责拉起两个独立进程,不负责转发话题消息
    return LaunchDescription([
        Node(
            package='temperature_demo',
            executable='temperature_publisher',
            name='temperature_publisher',
            output='screen',
        ),
        Node(
            package='temperature_demo',
            executable='temperature_monitor',
            name='temperature_monitor',
            output='screen',
        ),
    ])

预期结果:一次 Launch 启动发布与监测两个节点,节点通过 ROS 2 话题传递消息;output='screen' 使监测日志显示在启动终端。

Launch 启动双节点与温度话题的数据流

构建启动并核对结果

在终端 A 构建并加载工作空间。第一次编译要从工作空间根目录执行,修改 setup.py 或 Launch 文件后也应重新构建。

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

预期输出(构建日志节选;耗时不同):

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

然后在终端 A 启动:

bash
ros2 launch temperature_demo temperature_pair.launch.py

预期输出(监测日志的正文节选,省略进程前缀和时间戳):

text
[temperature_monitor]: sensor=room_sensor temp=<TEMP> C variance=0.04 C^2
[temperature_monitor]: sensor=room_sensor temp=<TEMP> C variance=0.04 C^2

其中 <TEMP> 是 22.0、22.5、23.0 之一;最初收到哪一条与节点发现时机有关。实际日志还包含 <TIME> 和进程标识。终端 A 保持运行,打开终端 B 并加载相同环境:

bash
source /opt/ros/jazzy/setup.bash
source ~/ros2_ws/install/setup.bash
ros2 node list
ros2 topic type /room/temperature
ros2 topic info /room/temperature

预期输出(节点顺序可能不同):

text
/temperature_monitor
/temperature_publisher
sensor_msgs/msg/Temperature
Type: sensor_msgs/msg/Temperature
Publisher count: 1
Subscription count: 1

进一步核对完整消息,而不仅是监测日志:

bash
ros2 topic echo /room/temperature --once

预期输出(动态字段用占位符表示):

text
header:
  stamp:
    sec: <TIME>
    nanosec: <TIME>
  frame_id: room_sensor
temperature: <TEMP>
variance: 0.04

这里 <TEMP> 仍为三个固定温度之一,两个 <TIME> 对应真实时间戳整数,显示值每次不同。最后测量消息接收频率:

bash
ros2 topic hz /room/temperature

预期输出(约收集数秒后出现,按 Ctrl+C 停止):

text
average rate: <RATE>
    min: <TIME>s max: <TIME>s std dev: <TIME>s window: <ID>

<RATE> 应接近 2.0 Hz,平均消息间隔约 0.5 秒;实际值随调度、系统负载和接收端 QoS 变化,不能把一次测量的末位数字当作精确承诺。

定位最常见的联调失败

  • ros2 launch 找不到文件:核对文件确实在 launch/,并确认 setup.py 的 data_files 包含 glob('launch/*.launch.py');重新运行 colcon build 并执行 source install/setup.bash。
  • 能看到发布者却没有监测日志:先看 ros2 topic info /room/temperature 是否为 1 个发布者、1 个订阅者;再确认两端话题名、Temperature 类型和 ROS_DOMAIN_ID 一致。两个节点若位于不同计算机,还要检查网络发现条件。
  • 日志出现 unexpected frame_id:检查发布端写入的 msg.header.frame_id 是否为 room_sensor;不要把话题名 /room/temperature 当作 frame_id。
  • ros2 topic hz 明显低于 2 Hz:先检查 create_timer(0.5, ...),再看终端是否存在持续报错或 CPU 高负载;hz 衡量的是接收速率,不等于传感器硬件的精密采样频率。

验收以三项同时成立为准:两个节点存在,/room/temperature 恰有一个发布者和一个订阅者,监测日志的温度序列与约 2 Hz 的接收频率都符合约定。

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

目录与阅读设置

阅读设置

17

记录一个想法

连接温度发布与监测节点

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

登录哪都通