FAST_LIO项目与Livox激光雷达数据格式兼容性问题深度解析

问题背景

在机器人SLAM领域，FAST_LIO作为一款基于紧耦合迭代卡尔曼滤波的激光惯性里程计算法，因其高效性和鲁棒性受到广泛关注。然而在实际部署过程中，开发者使用Livox Mid-70激光雷达时遇到了数据格式不匹配的典型问题，导致系统无法正常生成点云数据（PCD文件）。

核心问题分析

从错误信息可以看出，系统出现了ROS话题订阅/发布的数据类型不匹配：

• FAST_LIO节点期望接收livox_ros_driver/CustomMsg类型数据
• 实际Livox驱动发布的是sensor_msgs/PointCloud2类型数据

这种类型不匹配会导致ROS系统自动断开连接（Dropping connection），进而使得后续的点云处理流程完全中断。

技术原理剖析

1. 数据格式差异：

   • CustomMsg是Livox特有的数据格式，包含原始激光点的时间戳、反射率等丰富信息
   • PointCloud2是ROS标准点云格式，具有通用性但可能丢失部分Livox特有信息

2. FAST_LIO设计考量： 算法针对Livox雷达的独特扫描模式进行了优化，直接使用CustomMsg可以获得：

   • 更精确的时间戳对齐
   • 原始反射率信息
   • 点云属性标记（如无效点标记）

解决方案实施

对于使用真实Livox雷达的用户，可通过以下步骤解决：

1. 配置Livox驱动： 修改Livox ROS驱动启动参数，确保输出模式设置为CustomMsg格式。典型配置示例：

   publish_freq: 10.0
   data_type: 0  # 0表示CustomMsg格式
   

2. FAST_LIO参数适配： 检查FAST_LIO配置文件中lidar_topic参数是否对应正确的CustomMsg话题名称（通常为/livox/lidar）

3. 数据流验证： 使用rostopic echo命令确认话题数据类型：

   rostopic type /livox/lidar
   rostopic hz /livox/lidar
   

深入扩展知识

1. 格式转换的替代方案： 若必须使用PointCloud2格式，可考虑：

   • 开发中间转换节点
   • 修改FAST_LIO源码适配PointCloud2 （注意会损失部分时序精度）

2. 多雷达兼容设计： 高级用户可扩展FAST_LIO使其自动识别输入数据类型，这需要：

   • 实现多格式解析接口
   • 增加数据预处理模块
   • 维护时间同步机制

3. 性能影响评估： CustomMsg格式相比PointCloud2在Livox设备上通常具有：

   • 更低的数据延迟（约15-30%）
   • 更高的点云完整性
   • 更精确的运动畸变校正

实践建议

1. 对于科研用途，建议保持原始CustomMsg格式以获取最佳算法性能
2. 工业部署中若需与其他PointCloud2系统集成，建议在应用层做格式转换
3. 定期检查Livox驱动版本，确保与FAST_LIO的兼容性

通过正确理解数据格式差异并进行适当配置，可以充分发挥FAST_LIO与Livox雷达的组合优势，构建高性能的激光SLAM系统。