FAST_LIO项目中激光雷达倾斜安装时的点云坐标系转换方案

概述

在使用FAST_LIO项目进行3D建图时，用户经常会遇到需要调整激光雷达安装角度的情况。特别是当需要同时捕捉地面信息时，将激光雷达倾斜安装是一个常见做法。本文将详细介绍在FAST_LIO项目中处理激光雷达倾斜安装时的坐标系转换方案。

激光雷达倾斜安装的常见场景

在实际应用中，将Livox Mid 360等激光雷达以约40度角倾斜安装（绕Y轴旋转）可以带来以下优势：

1. 同时获取地面和周围环境的点云数据
2. 改善地面特征的提取效果
3. 为后续2D地图生成提供更完整的数据基础

坐标系转换的核心思路

FAST_LIO作为激光惯性里程计系统，其核心依赖于精确的传感器坐标系关系。当物理安装角度发生变化时，需要通过坐标变换来校正数据流。

静态变换解决方案

最直接的方法是在ROS系统中添加静态坐标变换：

1. 对于ROS1系统，可以使用static_transform_publisher节点：

rosrun tf static_transform_publisher x y z yaw pitch roll body base_link 1000

其中，当传感器倾斜40度时，roll参数应设置为-40/180*π。

2. 对于ROS2系统，命令类似：

ros2 run tf2_ros static_transform_publisher x y z yaw pitch roll parent_frame_id child_frame_id

集成到启动文件的方案

为了更永久性地解决这个问题，可以将变换集成到启动文件中：

1. 修改FAST_LIO的ROS2启动文件(mapping.launch.py)
2. 在启动配置中添加静态变换发布器
3. 确保变换参数与物理安装角度一致

代码层面的深度修改方案

对于需要深度定制的用户，可以在FAST_LIO的代码层面实现变换：

1. 在TF和里程计数据发布模块中，将原始变换映射到Eigen矩阵
2. 应用传感器安装角度对应的变换矩阵
3. 将变换后的Eigen矩阵重新映射回ROS话题

这种方案虽然更复杂，但可以避免依赖ROS的TF树，适合对系统有深度定制需求的用户。

实际应用建议

1. 对于大多数用户，推荐使用静态变换方案，简单可靠
2. 变换参数应根据实际安装角度精确测量
3. 建议在系统集成测试阶段验证变换效果
4. 注意坐标系定义的一致性（ROS通常采用Z轴向前，X轴向右，Y轴向下的右手系）

总结

处理FAST_LIO项目中激光雷达倾斜安装的情况，核心在于正确表达物理安装角度与系统坐标系之间的关系。通过静态变换或代码层面的修改，可以确保系统正确理解和处理倾斜安装带来的数据变化，为后续的3D建图和2D地图生成提供准确的数据基础。