机器人 / 系统课时
连接温度发布与监测节点
连接温度发布与监测节点
本课将一个每 0.5 秒发布温度的 Python 节点和一个监测订阅者接入同一 Launch 文件。完成后可以一次启动两个节点,核对温度消息字段、运行日志,并用命令检查约 2 Hz 的实际接收频率。
学习目标
- 使用
sensor_msgs/msg/Temperature传递带时间戳、温度和方差的读数。 - 为两个 Python 节点注册可执行入口,并通过一个 Launch 文件启动。
- 从话题、日志和接收频率三个角度验收通信链路。
创建功能包并约定消息
适用环境为 Ubuntu 24.04、ROS 2 Jazzy,已安装 colcon 和 ROS 2 Python 开发组件。以下以全新工作空间 ~/ros2_ws 为例;如果已有同名功能包,请在原包中添加文件,不要重复创建。
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"预期输出(末行,前面的创建日志可能不同):
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。生成固定循环读数,便于判断订阅端是否解析错字段。
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。订阅回调先检查来源标识和数值有效性,再输出便于检索的结构化日志。方差不能当作第二个温度值。
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。
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 写入:
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' 使监测日志显示在启动终端。

构建启动并核对结果
在终端 A 构建并加载工作空间。第一次编译要从工作空间根目录执行,修改 setup.py 或 Launch 文件后也应重新构建。
cd ~/ros2_ws
colcon build --packages-select temperature_demo
source install/setup.bash预期输出(构建日志节选;耗时不同):
Starting >>> temperature_demo
Finished <<< temperature_demo [<TIME>]
Summary: 1 package finished [<TIME>]然后在终端 A 启动:
ros2 launch temperature_demo temperature_pair.launch.py预期输出(监测日志的正文节选,省略进程前缀和时间戳):
[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 并加载相同环境:
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预期输出(节点顺序可能不同):
/temperature_monitor
/temperature_publisher
sensor_msgs/msg/Temperature
Type: sensor_msgs/msg/Temperature
Publisher count: 1
Subscription count: 1进一步核对完整消息,而不仅是监测日志:
ros2 topic echo /room/temperature --once预期输出(动态字段用占位符表示):
header:
stamp:
sec: <TIME>
nanosec: <TIME>
frame_id: room_sensor
temperature: <TEMP>
variance: 0.04这里 <TEMP> 仍为三个固定温度之一,两个 <TIME> 对应真实时间戳整数,显示值每次不同。最后测量消息接收频率:
ros2 topic hz /room/temperature预期输出(约收集数秒后出现,按 Ctrl+C 停止):
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 的接收频率都符合约定。