时间 API 与双时钟体系

01问题引入：时间不对齐，数据全白采

生活化地说：多传感器融合就像一场合唱——IMU 是快声部（200 拍/秒），相机是慢声部（30 拍/秒），必须都看着同一个指挥（统一时钟）才能合上拍。谁自己偷偷看手机计时（time.time()），整团就乱。

02先看现象：让时间看得见

跑起 time_demo_node，用三条命令把"时间"变成看得见的数据。命令背后的代码在 05 节逐行拆。

cd ~/ros2_ws/src/xflz_eai_car1/driver/ros_sensor/ros_sensor/ros_sensor
python3 time_demo_node.py

2echo：看消息里的时间戳终端 B

stamp 的 sec 一格一格 +1——这就是"时间在数据里流动"的样子：

ros2 topic echo /sensor_data

$ ros2 topic echo /sensor_data stamp: sec: 1786615681 nanosec: 444421522 frame_id: sensor_frame --- stamp: sec: 1786615682 nanosec: 445804769 frame_id: sensor_frame # sec 逐条递增，nanosec 在 0~999999999 内补齐亚秒精度

3hz：验证定时器节拍终端 B

平均频率应贴近 1.000 —— 偏差大说明回调太重拖了后腿（03 节原理）：

ros2 topic hz /sensor_data

$ ros2 topic hz /sensor_data average rate: 1.000 min: 0.997s max: 1.002s std dev: 0.00187s window: 3

ros2 topic delay /sensor_data

03原理讲解

一行调用，两套时钟，一个 bool 开关

① 调用：想获取现在的时间戳，命令行里写 now = self.get_clock().now()，功能就一句话——问当前的钟"现在几点"。
② now 是什么：now 是一个 ROS 2 时间对象（rclpy 的 Time），里面装着 sec（秒）和 nanosec（纳秒）两段数值；它不是字符串，调用 now.to_msg() 就能变成 Header.stamp 那样的时间戳，直接盖到消息上。
③ 和 /clock 什么关系：这个 now 的时间从哪来，由钟自己决定——当 use_sim_time 开成 true 时，get_clock().now() 读的就是 /clock 话题馈进来的时间；普通模式下读的则是操作系统墙上钟。
④ 两套钟，一个开关：系统墙上钟、仿真钟两套并存，靠 use_sim_time 这个 bool 值切换（false 用墙钟、true 用 /clock）——你自己的代码一行都不用改，永远只有上面那一行调用。先看框图，再看详解：

node.get_clock().now()
      │
      ├── use_sim_time = false（默认）
      │     时间源：操作系统墙钟（现实时间）
      │     特征：和现实世界一秒一秒同步，不能快进/暂停
      │     适用：真机、真实传感器（USB 相机 / IMU / 雷达）
      │
      └── use_sim_time = true
            时间源：订阅 /clock 话题
            特征：Gazebo / rosbag play 说了算——可 0.5 倍速、可暂停、可回退
            适用：仿真、录包回放

⚠️ 坑：true 了却没人发 /clock → 节点拿不到时间，死等不走（04 节实操 A）

下面的交互演示可以亲手切换时间源，建议把每个按钮都点一遍：

图 11-1 · 一行代码，两种世界 ｜ 回答：切换时间源后节点的 stamp 跟着怎么变？

时间的两副面孔：代码里一副，网络上一副

同一个"时刻"在两个场合长得不一样：写代码时要能加减比较（好算逻辑），发消息时要紧凑可序列化（好传输）。ROS2 干脆拆成两个类型，分工明确：

now = clock.now()
later = now + Duration(seconds=5.0)  # Time ± Duration
dt = t2 - t1                          # → 得 Duration
now > past                            # 可直接比较

stamp:
  sec: 1786615681     # int32 · Unix 秒
  nanosec: 44442152  # uint32 · 纳秒

create_timer 的真实行为与 stamp 规范

04实验步骤

工程化顺序：先看全景（图 11-3）→ 再看节点内流程（图 11-4）→ 最后逐行读代码。

time_demo_node 逐行拆解

源码来自指导手册实验 11 的 time_demo_node.py：全文件只做三件事——两个定时器、盖时间戳、发摘要。

第一站 · __init__：发布器 + 两个定时器

# 来源：time_demo_node.py __init__
self._publisher = self.create_publisher(Header, 'sensor_data', 10)
# 用 Header 消息演示 stamp 字段——它正是所有传感器消息"头部"的原型

self._timer1 = self.create_timer(1.0, self._timer1_callback)   # 1Hz：采样发布
self._sample_count = 0
self._timer2 = self.create_timer(5.0, self._timer2_callback)   # 0.2Hz：状态摘要

self.get_logger().info(f'系统时钟模式: use_sim_time={self.get_parameter("use_sim_time").value}')
# use_sim_time 是系统预声明参数——不用 declare 就能 get，它由 --ros-args -p 控制

第二站 · timer1_callback：盖时间戳的规范姿势

# 来源：time_demo_node.py _timer1_callback（每秒一次）
now = self.get_clock().now()      # ① 在"采集动作"这一行取时间——不是函数末尾
now_msg = now.to_msg()            # ② API 类型 → 消息类型（rclpy.time.Time → builtin_interfaces/Time）

msg = Header()
msg.stamp = now_msg               # ③ ⭐ 核心：把采集时刻盖进消息头
msg.frame_id = 'sensor_frame'    #     坐标系名，TF2 章节会再见到它
self._publisher.publish(msg)

self.get_logger().info(
    f'采样 #{self._sample_count:04d} | stamp: {now_msg.sec}.{now_msg.nanosec:09d} | ...')
# nanosec 用 :09d 补零到 9 位——否则 44442152 会被误读成更高精度

第三站 · timer2_callback 与时间运算

# 来源：time_demo_node.py _timer2_callback（每 5 秒摘要）
self.get_logger().info(
    f'[状态摘要] 累计采样次数: {self._sample_count}, '
    f'当前ROS2时间: {self.get_clock().now().nanoseconds} ns')
# nanoseconds：Unix 纪元起的总纳秒数（int，无溢出风险；C++ 要用 uint64_t）

# 时间运算三件套（可加进节点练习）
from rclpy.time import Duration
future = now + Duration(seconds=5.0)   # Time ± Duration = Time
diff   = now - past                    # Time − Time = Duration（.nanoseconds/1e9 得秒）
print(now > past)                      # Time 之间可直接比较

亲手"接管"一个节点的时间轴

让节点不再看墙上钟，改听手动发布的 /clock——卡在哪、怎么复活，看图 11-5：

cd ~/ros2_ws/src/xflz_eai_car1/driver/ros_sensor/ros_sensor/ros_sensor
python3 time_demo_node.py --ros-args -p use_sim_time:=true

ros2 topic pub /clock rosgraph_msgs/msg/Clock "{clock: {sec: 100, nanosec: 0}}" --rate 1

05注意事项与验收清单

06本课总结与验证题