FAST_LIO项目中使用Velodyne激光雷达数据的问题解析

问题背景

在使用FAST_LIO项目进行激光雷达惯性里程计开发时，许多开发者遇到了Velodyne激光雷达数据无法正常处理的问题。这个问题源于项目代码对点云数据字段的严格要求和实际提供的数据格式之间存在不匹配。

核心问题分析

FAST_LIO项目代码在处理Velodyne激光雷达数据时，对点云数据结构有以下硬性要求：

1. 必须包含x、y、z坐标字段
2. 必须包含intensity(强度)字段
3. 必须包含time(时间戳)字段

然而，项目提供的测试数据是通过Python脚本生成的，这些数据存在以下特点：

1. 使用了ring(环号)字段而非intensity字段
2. 数据结构定义中缺少了强度信息
3. 时间戳处理方式与主程序预期不符

技术细节解析

在预处理模块中，FAST_LIO通过velodyne_handler函数处理点云数据，该函数明确要求点云必须包含以下字段：

added_pt.x = pl_orig.points[i].x;
added_pt.y = pl_orig.points[i].y;
added_pt.z = pl_orig.points[i].z;
added_pt.intensity = pl_orig.points[i].intensity;
added_pt.curvature = pl_orig.points[i].time * time_unit_scale;

而提供的Python数据处理脚本生成的却是如下结构：

fields = [PointField('x', 0, PointField.FLOAT32, 1),
          PointField('y', 4, PointField.FLOAT32, 1),
          PointField('z', 8, PointField.FLOAT32, 1),
          PointField('time', 16, PointField.FLOAT32, 1),
          PointField('ring', 20, PointField.UINT16, 1)]

解决方案建议

针对这一问题，开发者可以采取以下几种解决方案：

1. 数据格式转换：

   • 修改Python数据处理脚本，确保输出包含intensity字段
   • 或者编写转换脚本，将ring字段映射为intensity字段

2. 代码适配：

   • 修改FAST_LIO的预处理代码，使其能够处理包含ring字段的点云数据
   • 添加字段检查逻辑，对不同格式的数据进行兼容处理

3. 使用标准数据集：

   • 采用KITTI等标准数据集，这些数据通常符合FAST_LIO的格式要求
   • 使用Velodyne官方工具生成符合标准格式的点云数据

实践建议

对于刚接触FAST_LIO的开发者，建议：

1. 仔细检查点云数据的字段结构
2. 使用rosbag info命令查看数据包详细信息
3. 在启动FAST_LIO时确保正确映射话题名称
4. 考虑使用PCL库的点云转换工具进行格式预处理

总结

这个问题典型地展示了在实际机器人开发中数据接口一致性的重要性。FAST_LIO作为一个高性能的激光雷达惯性里程计系统，对输入数据格式有特定要求。开发者在集成不同传感器时，必须确保数据格式的兼容性，这是实现系统稳定运行的基础条件之一。