1. Velodyne雷达时间戳"负值"现象解析
第一次用FastLIO处理Velodyne 16线雷达数据时,我发现点云中的时间戳全是负数,这跟之前用速腾雷达时的情况完全相反。当时盯着终端里打印的"-0.19902"这样的数值,差点以为是驱动出了问题。后来才发现,这是Velodyne雷达特有的时间戳机制在"作怪"。
具体来说,当雷达转速设为300 RPM(5Hz)时,每帧扫描周期是0.2秒。雷达驱动会将最后一个数据包的时间作为基准点,向前倒推计算各点时间。这就好比录像时用结束时间做标记,前面所有片段的时间戳自然都是负的。我在代码里打印原始点云数据验证时,确实发现只有最后约5%的点时间戳是正数,其他95%都是负值。
这种现象背后其实隐藏着雷达硬件的工作逻辑:Velodyne雷达的每个激光通道并非同时发射,而是按固定顺序轮询。当设置为5Hz低速扫描时,从第一个通道开始到最后一个通道结束,整个扫描过程持续约0.19秒。驱动为了保持时间基准统一,选择用扫描结束时刻作为零点,之前的所有点自然获得负时间戳。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 两种时间补偿方案的实战对比
2.1 首点基准补偿法
我最开始采用的方案非常简单粗暴——直接以第一个点的时间为基准。在preprocess.h中添加如下处理逻辑:
cpp复制float first_point_offtime = pl_orig.points[0].time; // 记录首点负时间
added_pt.curvature = pl_orig.points[i].time - first_point_offtime; // 时间归一化
这种方法的优势是实现简单,在5Hz测试数据上确实看到了改善:建图重影减少约60%,定位回环误差从1.2米降至0.5米。但存在两个明显缺陷:
- 当点云存在丢包时,首点可能不是真正的扫描起点
- 没有考虑雷达的机械扫描特性,时间线性假设不够准确
2.2 末包时间基准法
后来在查阅Velodyne官方文档时发现,其驱动设计确实是以末包时间为基准。于是在preprocess.cpp中重构了时间处理逻辑:
cpp复制// 获取点云消息头时间戳作为末包时间
double last_packet_time = msg->header.stamp.toSec();
