4、传感器时间戳机制：各说各话的时钟

做多传感器融合，最头疼的是什么？

我个人觉得，不是算法选型，也不是标定精度。而是——时间戳。

你想想看，相机说「我在 12:00:00.100 拍了这张图」，IMU 说「我在 12:00:00.102 测了加速度」，激光雷达说「我在 12:00:00.098 扫完了一圈」。

这三个时间，真的是同一个「时间」吗？

嗯，大概率不是。每个传感器都有自己的时钟源，有自己的触发机制，甚至有自己的「性格」——有的爱迟到，有的爱早退。

这一节，我们就来扒一扒四种主流传感器的时间戳机制。我在项目里被它们坑过无数次，今天把经验全倒出来。

4.1 相机时间戳：曝光开始 vs 曝光结束

相机的时间戳，是坑最多的一个。为什么？

因为相机不是「瞬间」拍一张图的。它有一个曝光过程。曝光开始、曝光结束、数据读出、帧中断——这四个时间点，完全不一样。

我见过太多团队，直接用 ROS 驱动里回调函数的时间作为图像时间戳。这其实是个大坑。回调时间 = 数据读出时间 + 传输延迟 + CPU 调度延迟。这个延迟可能高达几十毫秒。

正确的做法是什么？

1. 硬件触发模式： 用 GPIO 或 STROBE 信号，在曝光开始瞬间打一个时间戳。这是最准的。
2. 帧中断模式： 很多相机（如 FLIR、Basler）在曝光结束时产生帧中断。这时要记录中断时间，然后减去曝光时间的一半。
3. 软件时间戳： 如果硬件不支持，那就只能靠驱动里尽量靠近硬件层打时间戳。但精度嘛……看运气。

这里有个公式，我建议你记下来：

图像真实时间 ≈ 帧中断时间 - 曝光时间 / 2

当然，前提是你的相机驱动能拿到曝光时间参数。有些低成本相机不提供这个信息，那就只能靠经验值去估了。

4.2 IMU 时间戳：数据就绪中断

IMU 的时间戳，相对简单一些。但简单不代表没坑。

IMU 通常是「数据就绪中断」模式。芯片内部完成一次测量后，拉高一个中断引脚。主控收到中断，立刻读取数据并打时间戳。

这个机制的好处是：时间戳非常接近真实测量时刻。延迟通常只有几十微秒。

但要注意两个问题：

• 中断响应延迟： 如果主控正在处理高优先级任务，中断可能被延迟。我建议把 IMU 中断设为最高优先级。
• 时钟漂移： IMU 内部的时钟可能不准。尤其是低成本 MEMS IMU，温度变化会导致时钟频率偏移。我曾经测过一款 IMU，温度从 25°C 升到 60°C，时钟漂移了 0.5%。

对于 IMU 时间戳，我的建议是：

1. 使用硬件中断，不要用轮询模式。
2. 在中断服务函数里只做「打时间戳 + 存数据」两件事，不要做复杂处理。
3. 定期校准 IMU 的时钟，或者用 PTP（精确时间协议）同步。

4.3 激光雷达时间戳：旋转角度编码器

激光雷达的时间戳，是最有意思的。因为它不是「一帧一个时间」，而是「每个点都有自己的时间」。

你想想看，机械式激光雷达旋转一圈，360° 扫描。第一个点和最后一个点的时间差，可能就是 100ms（10Hz 情况下）。

如果你给整帧打同一个时间戳，那误差就大了去了。

正确的做法是：

• 利用激光雷达内部的旋转角度编码器，记录每个点云对应的角度。
• 根据角度和时间的关系，插值出每个点的时间戳。
• 或者，至少把一帧分成若干段，每段打一个时间戳。

我常用的做法是：

// 假设激光雷达 10Hz，一圈 360°，共 36000 个点
// 每个点的时间 = 帧起始时间 + (点索引 / 总点数) * 帧周期
float point_time = frame_start_time + (point_index / 36000.0) * 0.1;

当然，这只是一个近似。更精确的做法是读取编码器的角度值，然后根据角速度计算时间。

4.4 轮速计时间戳：被忽视的角落

轮速计（或者叫里程计）的时间戳，往往被大家忽视。但它在低速场景下非常重要。

轮速计的数据通常是 CAN 总线或串口传输的。时间戳的精度取决于：

• CAN 总线的时间戳精度（通常由 CAN 控制器提供）
• 或者，主控收到数据时打的时间戳

这里有个问题：轮速计的数据是「累积值」还是「瞬时值」？

• 如果是累积值（比如编码器脉冲数），那时间戳应该对应累积周期的结束时刻。
• 如果是瞬时值（比如速度），那时间戳应该对应测量时刻。

对于轮速计，我的建议是：

1. 尽量使用 CAN 总线自带的硬件时间戳。
2. 如果不行，记录数据接收时间，然后根据采样周期做补偿。
3. 轮速计的采样周期要固定，不要用「有数据就发」的模式。

4.5 四种传感器时间戳对比

我把四种传感器的时间戳机制整理成了一张表，方便你对比：

4.6 一张图看懂时间戳机制

下面这张 SVG 图，展示了四种传感器的时间戳生成流程。我画了很久，希望能帮你理清思路。

这张图的核心逻辑是：每个传感器都有自己的时间戳生成方式，但最终都要汇聚到统一的时间同步模块里，做偏移补偿和延迟校正。

说白了，时间戳机制就是「各说各话」，而时间同步就是「翻译官」。

好了，这一节的内容就到这里。四种传感器的时间戳机制，你记住了吗？

可可精品资料库