机器人 / 系统课时

时间戳错位为什么会扭曲扫描

时间戳错位为什么会扭曲扫描

机器人边移动边扫描时,一条 /scan 消息里的各束激光并非同时取得。如果把消息接收时间当成采样时间,或者给整帧使用同一份动态 TF,静止的直墙也可能变弯、出现重影。下面用数值算例复现误差,并给出 ROS 2 中的定位与补偿方法。

学习目标

  • 区分激光首束时间、逐束采样时间和消息接收时间。
  • 估算平移、旋转及时间延迟带来的扫描偏差。
  • 检查 ROS 2 时间源,并按每束采样时刻进行运动补偿。

采样时间、接收时间与 TF 时间

按照 ROS 2 的 LaserScan 消息定义,一帧扫描有三个容易混淆的时间量:

  • header.stamp:第一束激光的采样时刻,不是订阅回调收到消息的时刻。
  • time_increment:相邻两束测量的时间间隔,单位为秒。
  • scan_time:相邻两帧扫描的时间间隔,不能直接当作相邻两束的间隔。

设 ranges 有 NN 项,首束时间为 t0t_0,第 ii 束的采样时间为 ti=t0+iΔtt_i=t_0+i\Delta t,其中 Δt\Delta t 是 time_increment,ii 从 0 开始。例如 11 束、间隔 0.01 s,最后一束比首束晚 0.10 s。若驱动将 time_increment 填成 0,或错误地把收包时间写入 header.stamp,就必须先核对设备协议和驱动实现。

雷达与机体之间的 base_link → laser 通常是静态变换,但机器人运动时 odom → base_link 随时间变化。对第 ii 束投到 odom 时,应使用它在 tit_i 时刻对应的机体位姿,而不是整帧只查一次最新 TF。

扫描逐束采样、TF 历史与消息接收时间的错位

把时间差换算为空间误差

假设机器人以 1 m/s 前进、以 60°/s 转弯,扫描从首束到末束耗时 0.10 s。若把全部光束都当作首束时刻采样,末束会对应约 0.10 m 的平移差和 6° 的姿态差;在 5 m 距离上,6° 对应的横向偏差量级约为 0.52 m。若扫描结束后再延迟 0.08 s 才收到消息,错用接收时刻处理首束时,平移误差量级达到 0.18 m。

以下示例只计算时间错位的几何量级,不依赖 ROS 2,也不模拟完整激光投影:

python
from math import radians, sin

first_stamp = 2.0
beam_count = 11
time_increment = 0.01
linear_speed = 1.0
turn_rate_deg = 60.0
target_range = 5.0
arrival_after_last = 0.08

# 扫描跨度与扫描完成后的传输延迟是两种不同时间量
span = (beam_count - 1) * time_increment
last_stamp = first_stamp + span
receive_stamp = last_stamp + arrival_after_last

# 错用接收时刻,会把扫描跨度与后续延迟一起算进偏差
print(f"扫描末束时刻:{last_stamp:.2f} s")
print(f"首末束平移差:{linear_speed * span:.2f} m")
print(f"首束错用接收时刻的位移:{linear_speed * (receive_stamp - first_stamp):.2f} m")
print(f"首末束角度差:{turn_rate_deg * span:.1f}°")
print(f"5 m 目标的横向差约:{target_range * sin(radians(turn_rate_deg * span)):.2f} m")

预期输出:

text
扫描末束时刻:2.10 s
首末束平移差:0.10 m
首束错用接收时刻的位移:0.18 m
首末束角度差:6.0°
5 m 目标的横向差约:0.52 m

这不表示网络延迟本身会扭曲点云:只要保留正确采样时间,并查询相应时刻的 TF,晚到的消息仍可正确转换;问题出在错误盖戳或错误选取变换时间。

在 ROS 2 中定位错位来源

前提是 ROS 2 Jazzy 或兼容发行版已加载环境,雷达驱动正发布 /scan。分别执行下列命令,读取首束时间和逐束间隔:

bash
ros2 topic echo /scan --once --field header
ros2 topic echo /scan --once --field time_increment

预期输出形态如下;<TIME> 与 <ID> 只是动态值占位,实际数字及坐标系名由设备决定:

text
stamp:
  sec: <TIME>
  nanosec: <TIME>
frame_id: <ID>
---
<TIME>
---

依次核查三件事:

  1. 消息盖戳:header.stamp 是否来自实际首束采集时刻?若驱动在回调或收到数据包后才赋当前时间,扫描的历史位置已被改写。
  2. 同一时间源:激光、里程计与 /tf 是否共用时间基准?回放 bag 使用 /clock 时,相关节点应一致启用 use_sim_time;真实机器人跨机器采集时要同步设备与主机时钟。
  3. TF 历史覆盖:odom → base_link 的动态变换是否覆盖首束到末束的时间区间?ros2 run tf2_ros tf2_echo odom base_link 可先确认链路持续更新,但最终仍需在处理节点按目标时间查询 TF;单看最新一条变换不够。

如果 TF 查询报告过去或未来外推错误,先检查时间基准、缓冲区与数据到达顺序;不要靠无条件取“最新变换”压掉报错。

逐束补偿并验证直墙

  1. 在驱动端保留真实首束采样时刻,确保 time_increment 正确。若雷达使用自己的硬件时钟,先把设备时间可靠换算到 ROS 使用的时间基准。
  2. 遍历有效的 ranges[i],用 angle_min + i * angle_increment 求各束方向,用 header.stamp + i * time_increment 求采样时刻;舍弃超出 range_min、range_max 的无效距离。
  3. 在每个采样时刻查询或插值 odom → base_link,再结合固定的 base_link → laser 外参,将射线端点投到固定坐标系 odom。等所需 TF 到齐后再处理,不能把所有射线套用接收时刻的位姿。
  4. 对着同一面平直墙,分别录制停车、直行和转弯时的扫描。停车时直、运动时弯,优先排查时间与逐束补偿;停车时也整体偏移,再检查雷达安装外参和静态 TF。

可把时间误差单独设预算:仅考虑 1 m/s 的平移,要求其引入偏差小于 2 cm,则时间偏差需小于 20 ms;若以 60°/s 转弯且目标在 5 m 外,单就旋转引起的横向偏差小于 2 cm 来说,时间偏差需约小于 4 ms。这是时间对齐的误差预算,不是最终建图精度承诺。

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

目录与阅读设置

阅读设置

17

记录一个想法

时间戳错位为什么会扭曲扫描

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

登录哪都通