1. 为什么选择 Mid360 加 FAST_LIO2 这套组合如果你正在找一套能快速跑起来、精度又足够能打的激光雷达 SLAM 方案Livox Mid360 配 FAST_LIO2 大概率是你绕不开的一个选项。我自己从最早的 Mid40 一路用到 Mid360中间换过好几套前端里程计方案最后还是回到 FAST_LIO2 这套组合上。原因不复杂Mid360 是非重复扫描的固态雷达FAST_LIO2 是专门针对这类雷达特性做过优化的紧耦合 LiDAR-惯性里程计两者在数据特性和算法假设上是天然匹配的。先说清楚这套东西到底能干什么。Mid360 是一台 360 度视场的固态激光雷达水平视场 360 度垂直视场 -7 度到 52 度测距范围官方标称 40 米对 80% 反射率目标点频大概 20 万点每秒。FAST_LIO2 则是一个基于迭代误差状态卡尔曼滤波IEKF的激光惯性里程计它把雷达点云和 IMU 数据做紧耦合输出高频的位姿估计和构建好的点云地图。这套组合的典型用途是室内外机器人建图、无人机导航、手持扫描建模、自动驾驶小车的定位前端。适合谁来参考这篇内容如果你已经装好了 ROS手上有 Mid360 和对应的 IMUMid360 内置了 IMU这点很关键想从零把这套系统跑通并且建出一张像样的地图那这篇就是写给你的。如果你连 ROS 都还没装建议先把 ROS 环境搞定再回来因为下面很多坑都建立在 ROS 已经能正常工作的前提上。我见过太多人卡在第一步——雷达连不上、点云不出来、FAST_LIO2 启动就崩。这些问题九成不是算法的问题而是环境、驱动、配置、时间同步这些脏活没做对。所以这篇不打算给你讲一堆卡尔曼滤波的公式推导而是把从零到建图这条链路上真正会绊倒你的地方一个个拆开讲。2. 环境准备阶段最容易翻车的几个点2.1 ROS 版本与系统版本的选择逻辑Mid360 的官方驱动 livox_ros_driver2 对 ROS 版本是有要求的。目前主流的两条路线是 Ubuntu 20.04 ROS Noetic或者 Ubuntu 22.04 ROS2 Humble。FAST_LIO2 本身在 ROS1 和 ROS2 下都有分支但社区里跑得最稳、资料最多的还是 ROS1 Noetic 这一套。如果你不是非要用 ROS2我建议第一遍跑通就用 Noetic能省掉大量编译和依赖的麻烦。这里有个很多人忽略的点Ubuntu 20.04 默认的 GCC 版本是 9而 livox_ros_driver2 在某些版本下用 GCC 9 编译会报一些奇怪的模板错误。如果你遇到编译报错先别急着怀疑代码检查一下 GCC 版本必要时装一个 GCC 8 或者用官方推荐的编译选项。我自己是在一台老机器上踩过这个坑折腾了一下午才发现是编译器版本的问题。另外提醒一句别在虚拟机上跑这套东西。Mid360 的数据量不小虚拟机的时间精度和 USB 吞吐都不够稳点云会丢帧建图直接飘。老老实实装双系统或者用物理机。2.2 网络配置Mid360 的 IP 是绕不过去的坎Mid360 通过网口和主机通信出厂默认 IP 是 192.168.1.1XX 这个网段具体最后一位和你的雷达序列号有关。你的主机网卡必须配成同一网段的静态 IP比如 192.168.1.50子网掩码 255.255.255.0。这一步看起来简单但翻车率极高。常见的错误有这么几种一是主机网卡还开着 DHCP结果拿到的 IP 和雷达不在一个网段ping 都 ping 不通二是同时开了 WiFi 和有线网卡路由表里默认路由走了 WiFi导致发往雷达的包出不去三是防火墙没关ICMP 和 UDP 包被拦了。我的做法是先把 WiFi 关掉只留有线和雷达直连网卡手动配静态 IP然后用ping 192.168.1.1XX确认能通。通了之后再往下走。如果 ping 不通先查ifconfig看网卡状态再查route -n看路由表最后查防火墙。这个排查顺序能解决 95% 的连接问题。提示Mid360 的 IP 最后一位可以通过 Livox Viewer 或者官方提供的配置工具修改但第一次连接时你得先知道它当前的 IP。如果实在不知道可以用官方工具扫描网段。2.3 livox_ros_driver2 的编译与配置细节驱动这块官方仓库是 livox_ros_driver2。克隆下来之后注意它有两个 launch 文件目录一个是launch_ROS1一个是launch_ROS2。用 ROS1 的话要进launch_ROS1目录去启动。很多人直接roslaunch livox_ros_driver2 xxx.launch发现找不到文件就是因为没注意这个目录结构。编译之前先确认依赖装齐了rosdep install跑一遍。编译的时候如果报找不到 Livox SDK 相关的头文件说明 SDK 没装或者路径没配好。官方驱动里其实带了 SDK但有时候需要你手动指定路径。配置文件MID360_config.json里有几个关键字段lidar_configs里的ip要改成你雷达的实际 IPhost_net_info里的cmd_data_ip、push_msg_ip、point_data_ip、imu_data_ip要改成你主机网卡的 IP。这几个 IP 如果配错表现就是驱动能启动但收不到数据或者收到数据但点云是空的。我第一次配的时候就因为host_net_info里还留着默认的 192.168.1.5 而自己的网卡是 192.168.1.50卡了半个多小时。启动驱动后用rostopic hz /livox/lidar看一下点云的发布频率正常应该在 10Hz 左右。再用rostopic hz /livox/imu看 IMU 频率Mid360 内置 IMU 大概是 200Hz。这两个频率正常说明驱动这层就通了。3. FAST_LIO2 的编译、配置与启动链路3.1 源码获取与依赖处理FAST_LIO2 的仓库在 GitHub 上注意要选对分支。ROS1 用ROS1分支ROS2 用ROS2分支。克隆到你的 catkin 工作空间的 src 目录下然后catkin_make。依赖方面它需要 Eigen、PCL、Sophus 这几个库。Eigen 和 PCL 一般 ROS 桌面版装的时候就带了Sophus 可能需要单独装。如果编译时报 Sophus 相关的错误去装一个libSophus-dev或者从源码编译一个。另外它依赖 livox_ros_driver2 的消息类型所以驱动必须先编译通过否则 FAST_LIO2 找不到livox_ros_driver2/CustomMsg这个消息类型。编译顺序很重要先编译 livox_ros_driver2再编译 FAST_LIO2。如果两个一起编译有时候会因为消息类型还没生成而报错。我习惯是分两次catkin_make第一次只编译驱动第二次再全量编译。3.2 配置文件里的参数到底该怎么调FAST_LIO2 的配置文件在config目录下Mid360 对应的通常是mid360.yaml或者类似的命名。这个文件里有几个参数直接决定你能不能建出图来。lid_topic和imu_topic必须和驱动实际发布的 topic 对上。驱动默认发的点云 topic 是/livox/lidarIMU 是/livox/imu。如果你改过驱动的配置这里也要同步改。extrinsic_T和extrinsic_R是雷达和 IMU 之间的外参。Mid360 是内置 IMU 的理论上外参是固定的官方也给了一组默认值。但如果你发现建图有明显的旋转漂移或者地面不平可以怀疑一下这个外参。不过大多数情况下用默认值就行别乱调。blind这个参数是盲区距离单位米。Mid360 最近测距大概在 0.1 米左右但太近的点噪声大一般设成 0.5 到 1.0 比较合适。设太小会有大量近处噪声点进入建图设太大又会丢失近处信息。det_range是有效测距范围Mid360 设成 40 到 50 都行。这个参数影响的是点云筛选设得比实际测距大一点没关系。filter_size_surf和filter_size_map是降采样体素大小。这两个参数直接关系到建图精度和计算量。室内场景我一般用 0.2 到 0.3室外大场景可以用 0.5。设太小计算量爆炸设太大地图会糊。acc_cov、gyr_cov、b_acc_cov、b_gyr_cov这几个是 IMU 的噪声协方差。Mid360 内置 IMU 的噪声特性官方有数据手册但实际用的时候如果发现建图在快速运动时飘得厉害可以适当调大这几个协方差值让滤波器更信任雷达观测而不是 IMU 预测。3.3 启动顺序与时间同步问题启动顺序这件事说简单也简单说坑也坑。正确的顺序是先启动雷达驱动确认点云和 IMU 都在正常发布再启动 FAST_LIO2。如果反过来FAST_LIO2 启动时收不到数据可能会直接退出或者卡住。时间同步是另一个大坑。Mid360 的点云和 IMU 时间戳来自雷达内部时钟而 ROS 系统用的是主机时钟。如果两者不同步FAST_LIO2 在做紧耦合的时候会出现时间对齐错误表现就是建图飘、重影、甚至直接发散。解决办法有几个一是用 PTP 或者 GPS 做硬件时间同步这个对普通玩家来说太重了二是确保驱动配置里开启了时间同步选项让雷达时间戳尽量贴近主机时间三是在 FAST_LIO2 里检查time_sync_en这个参数如果雷达和主机时间差太大可以打开软件时间同步。我自己的经验是大多数室内场景下只要主机和雷达都正常上电时间差不会大到影响建图。但如果你发现地图有明显的双层或者拖影第一时间去查时间戳。用rostopic echo /livox/lidar看一下 header 里的 stamp 和当前 ROS 时间差多少如果差了几秒甚至几十秒那就是时间同步没做好。4. 建图过程中那些让人抓狂的现象与排查4.1 点云稀疏或者干脆没有点云驱动启动了topic 也在发但 RViz 里看不到点云或者点云稀稀拉拉。这种情况先别怀疑 FAST_LIO2问题大概率在驱动层。第一步确认MID360_config.json里的 IP 配置全对。特别是host_net_info里的四个 IP必须是你主机网卡的实际 IP。第二步确认网卡是不是千兆的。Mid360 的数据量需要千兆网口百兆网口会丢包严重表现就是点云断断续续。第三步检查网线。别笑我真的遇到过网线接触不良导致点云时有时无的情况换根线就好了。如果点云能出来但特别稀疏检查一下publish_freq这个参数。驱动默认可能是 10Hz但如果你设成了 5Hz 或者更低点云密度就会下降。另外data_src要设成 0表示从雷达实时读取如果设成了 1从文件读取而你又没有文件那自然没有点云。4.2 建图飘移、重影、地面不平这是 FAST_LIO2 最常被吐槽的问题但绝大多数情况下不是算法本身的问题而是配置或者数据质量的问题。先看 IMU 数据质量。用rostopic echo /livox/imu看一下角速度和加速度的数值。静止状态下角速度应该在零附近小幅波动加速度的 Z 轴应该接近 9.8。如果角速度有几十度每秒的偏置或者加速度数值离谱那 IMU 可能有问题。Mid360 内置 IMU 一般不会坏但如果你把雷达装在振动很大的平台上IMU 数据会被振动污染建图必飘。再看外参。虽然 Mid360 是内置 IMU但雷达和 IMU 的坐标系定义如果和 FAST_LIO2 的假设不一致也会导致建图异常。检查配置文件里的extrinsic_R是不是单位矩阵或者官方推荐值。如果你自己改过改回去试试。还有一个容易被忽略的点point_filter_num这个参数。它控制每隔几个点取一个点参与计算。设成 1 表示全用设成 3 表示每三个点用一个。如果设得太大参与计算的点太少建图会不稳设得太小计算量又太大。Mid360 点频高一般设 2 到 3 比较平衡。4.3 FAST_LIO2 启动就崩或者跑几秒就退出这种情况通常有几个原因。一是消息类型不匹配比如 FAST_LIO2 订阅的是livox_ros_driver2/CustomMsg但驱动发的是sensor_msgs/PointCloud2类型对不上直接崩。检查驱动的xfer_format参数设成 1 是 CustomMsg设成 0 是 PointCloud2。FAST_LIO2 默认要 CustomMsg所以驱动这边要设成 1。二是配置文件路径不对。FAST_LIO2 启动时会去读 yaml 文件如果路径写错了或者文件不存在它会用默认值或者直接报错退出。检查 launch 文件里的config_file参数指向的路径是否正确。三是内存不够。FAST_LIO2 建图时会把点云地图存在内存里如果场景很大跑很久内存会持续增长。如果你机器内存只有 8G跑大场景可能会被 OOM killer 干掉。建议至少 16G 内存大场景最好 32G。5. 让建图效果更稳的几个实战技巧5.1 雷达安装位置与振动隔离Mid360 虽然叫固态但它对振动还是很敏感的。如果你把它刚性固定在一个振动很大的底盘上IMU 数据会被高频振动污染FAST_LIO2 的预测步骤就会出错。我的做法是在雷达和安装板之间加一层减震垫哪怕是一层薄薄的橡胶垫效果都很明显。安装位置也有讲究。尽量让雷达的视场不被遮挡特别是垂直视场。Mid360 的垂直视场是 -7 到 52 度如果你把它装得太低地面反射会占很大比例装得太高近处盲区又大。一般装在机器人顶部或者前方偏上的位置比较合适。5.2 建图前的静态初始化FAST_LIO2 启动后需要一段时间的静态初始化让 IMU 零偏收敛。这段时间里不要移动雷达让它静止几秒钟。如果你一启动就拿着雷达跑初始化没完成建图从一开始就是歪的。我一般会看 RViz 里的位姿输出等它稳定个三五秒再开始移动。另外初始化阶段最好让雷达对着一个有足够几何特征的环境比如墙角或者有家具的房间。如果对着白墙特征太少初始化也会不稳。5.3 大场景建图的回环与保存FAST_LIO2 本身不带回环检测它只做里程计。所以如果你建一个大场景走一圈回到原点地图可能会有累积误差首尾对不上。这是正常的不是 bug。要解决回环问题可以在 FAST_LIO2 后面接一个回环检测模块比如 SC-PGO 或者 LIO-SAM 里的回环部分。但那是另一套东西了这篇不展开。如果你只是建个小场景FAST_LIO2 的精度足够不回环也能看。保存地图的话FAST_LIO2 提供了rosrun fast_lio map_saver之类的工具或者你可以用pcl_ros把/cloud_registered这个 topic 存成 pcd 文件。注意保存的时候要等地图完全建完再存别建到一半就存那样存下来的地图是不完整的。5.4 计算资源与实时性的平衡FAST_LIO2 在 Mid360 上的计算量不算小特别是在降采样体素设得很小的时候。如果你发现建图时 CPU 占用率一直 100%位姿输出频率掉得很厉害那就要考虑降一下计算量。可以调的参数有增大filter_size_surf和filter_size_map增大point_filter_num减少max_iterationIEKF 的迭代次数。这几个参数调一调计算量能降不少精度损失在可接受范围内。另外编译的时候打开-O3优化对性能也有帮助。FAST_LIO2 的 CMakeLists 里默认可能是-O2改成-O3能快一些。6. 一些零散但重要的经验补充关于 IMU 频率Mid360 内置 IMU 是 200Hz但 FAST_LIO2 里有个imu_rate或者类似的参数要确保和实际频率一致。如果设错了滤波器的时间更新步长就不对建图会飘。关于点云格式如果你用 ROS2消息类型和 ROS1 不一样FAST_LIO2 的 ROS2 分支里订阅的 topic 类型要对应改。这个在 ROS2 下跑的时候特别容易忘。关于雷达固件Mid360 的固件版本会影响数据格式和稳定性。如果你的雷达是很早的固件建议升级到官方推荐版本。升级工具官方有提供过程不复杂但升级时别断电。关于多雷达如果你要同时用多个 Mid360配置会更复杂每个雷达的 IP 和 topic 都要区分开FAST_LIO2 那边也要改订阅逻辑。这个场景比较小众遇到问题去官方 issue 里搜大概率有人踩过。最后说一个我自己的习惯每次改完配置先不急着跑完整建图而是用rosbag record录一小段数据然后离线跑 FAST_LIO2。这样调试起来快不用每次都重新走一遍。录包的时候记得把点云和 IMU 都录上rosbag record /livox/lidar /livox/imu就行。离线跑通了再上实机效率高很多。这套 Mid360 加 FAST_LIO2 的组合跑通之后你会发现它真的很能打。但跑通之前的那些坑每一个都够你折腾半天。上面这些是我自己踩过并且印象比较深的希望能帮你少走点弯路。如果你遇到了上面没提到的问题大概率是环境或者硬件层面的回到最基础的检查IP 通不通、topic 有没有数据、时间戳对不对、IMU 数值正常不正常。把这四个问题排除了剩下的就好办了。
Mid360与FAST_LIO2激光SLAM从零搭建与避坑指南
1. 为什么选择 Mid360 加 FAST_LIO2 这套组合如果你正在找一套能快速跑起来、精度又足够能打的激光雷达 SLAM 方案Livox Mid360 配 FAST_LIO2 大概率是你绕不开的一个选项。我自己从最早的 Mid40 一路用到 Mid360中间换过好几套前端里程计方案最后还是回到 FAST_LIO2 这套组合上。原因不复杂Mid360 是非重复扫描的固态雷达FAST_LIO2 是专门针对这类雷达特性做过优化的紧耦合 LiDAR-惯性里程计两者在数据特性和算法假设上是天然匹配的。先说清楚这套东西到底能干什么。Mid360 是一台 360 度视场的固态激光雷达水平视场 360 度垂直视场 -7 度到 52 度测距范围官方标称 40 米对 80% 反射率目标点频大概 20 万点每秒。FAST_LIO2 则是一个基于迭代误差状态卡尔曼滤波IEKF的激光惯性里程计它把雷达点云和 IMU 数据做紧耦合输出高频的位姿估计和构建好的点云地图。这套组合的典型用途是室内外机器人建图、无人机导航、手持扫描建模、自动驾驶小车的定位前端。适合谁来参考这篇内容如果你已经装好了 ROS手上有 Mid360 和对应的 IMUMid360 内置了 IMU这点很关键想从零把这套系统跑通并且建出一张像样的地图那这篇就是写给你的。如果你连 ROS 都还没装建议先把 ROS 环境搞定再回来因为下面很多坑都建立在 ROS 已经能正常工作的前提上。我见过太多人卡在第一步——雷达连不上、点云不出来、FAST_LIO2 启动就崩。这些问题九成不是算法的问题而是环境、驱动、配置、时间同步这些脏活没做对。所以这篇不打算给你讲一堆卡尔曼滤波的公式推导而是把从零到建图这条链路上真正会绊倒你的地方一个个拆开讲。2. 环境准备阶段最容易翻车的几个点2.1 ROS 版本与系统版本的选择逻辑Mid360 的官方驱动 livox_ros_driver2 对 ROS 版本是有要求的。目前主流的两条路线是 Ubuntu 20.04 ROS Noetic或者 Ubuntu 22.04 ROS2 Humble。FAST_LIO2 本身在 ROS1 和 ROS2 下都有分支但社区里跑得最稳、资料最多的还是 ROS1 Noetic 这一套。如果你不是非要用 ROS2我建议第一遍跑通就用 Noetic能省掉大量编译和依赖的麻烦。这里有个很多人忽略的点Ubuntu 20.04 默认的 GCC 版本是 9而 livox_ros_driver2 在某些版本下用 GCC 9 编译会报一些奇怪的模板错误。如果你遇到编译报错先别急着怀疑代码检查一下 GCC 版本必要时装一个 GCC 8 或者用官方推荐的编译选项。我自己是在一台老机器上踩过这个坑折腾了一下午才发现是编译器版本的问题。另外提醒一句别在虚拟机上跑这套东西。Mid360 的数据量不小虚拟机的时间精度和 USB 吞吐都不够稳点云会丢帧建图直接飘。老老实实装双系统或者用物理机。2.2 网络配置Mid360 的 IP 是绕不过去的坎Mid360 通过网口和主机通信出厂默认 IP 是 192.168.1.1XX 这个网段具体最后一位和你的雷达序列号有关。你的主机网卡必须配成同一网段的静态 IP比如 192.168.1.50子网掩码 255.255.255.0。这一步看起来简单但翻车率极高。常见的错误有这么几种一是主机网卡还开着 DHCP结果拿到的 IP 和雷达不在一个网段ping 都 ping 不通二是同时开了 WiFi 和有线网卡路由表里默认路由走了 WiFi导致发往雷达的包出不去三是防火墙没关ICMP 和 UDP 包被拦了。我的做法是先把 WiFi 关掉只留有线和雷达直连网卡手动配静态 IP然后用ping 192.168.1.1XX确认能通。通了之后再往下走。如果 ping 不通先查ifconfig看网卡状态再查route -n看路由表最后查防火墙。这个排查顺序能解决 95% 的连接问题。提示Mid360 的 IP 最后一位可以通过 Livox Viewer 或者官方提供的配置工具修改但第一次连接时你得先知道它当前的 IP。如果实在不知道可以用官方工具扫描网段。2.3 livox_ros_driver2 的编译与配置细节驱动这块官方仓库是 livox_ros_driver2。克隆下来之后注意它有两个 launch 文件目录一个是launch_ROS1一个是launch_ROS2。用 ROS1 的话要进launch_ROS1目录去启动。很多人直接roslaunch livox_ros_driver2 xxx.launch发现找不到文件就是因为没注意这个目录结构。编译之前先确认依赖装齐了rosdep install跑一遍。编译的时候如果报找不到 Livox SDK 相关的头文件说明 SDK 没装或者路径没配好。官方驱动里其实带了 SDK但有时候需要你手动指定路径。配置文件MID360_config.json里有几个关键字段lidar_configs里的ip要改成你雷达的实际 IPhost_net_info里的cmd_data_ip、push_msg_ip、point_data_ip、imu_data_ip要改成你主机网卡的 IP。这几个 IP 如果配错表现就是驱动能启动但收不到数据或者收到数据但点云是空的。我第一次配的时候就因为host_net_info里还留着默认的 192.168.1.5 而自己的网卡是 192.168.1.50卡了半个多小时。启动驱动后用rostopic hz /livox/lidar看一下点云的发布频率正常应该在 10Hz 左右。再用rostopic hz /livox/imu看 IMU 频率Mid360 内置 IMU 大概是 200Hz。这两个频率正常说明驱动这层就通了。3. FAST_LIO2 的编译、配置与启动链路3.1 源码获取与依赖处理FAST_LIO2 的仓库在 GitHub 上注意要选对分支。ROS1 用ROS1分支ROS2 用ROS2分支。克隆到你的 catkin 工作空间的 src 目录下然后catkin_make。依赖方面它需要 Eigen、PCL、Sophus 这几个库。Eigen 和 PCL 一般 ROS 桌面版装的时候就带了Sophus 可能需要单独装。如果编译时报 Sophus 相关的错误去装一个libSophus-dev或者从源码编译一个。另外它依赖 livox_ros_driver2 的消息类型所以驱动必须先编译通过否则 FAST_LIO2 找不到livox_ros_driver2/CustomMsg这个消息类型。编译顺序很重要先编译 livox_ros_driver2再编译 FAST_LIO2。如果两个一起编译有时候会因为消息类型还没生成而报错。我习惯是分两次catkin_make第一次只编译驱动第二次再全量编译。3.2 配置文件里的参数到底该怎么调FAST_LIO2 的配置文件在config目录下Mid360 对应的通常是mid360.yaml或者类似的命名。这个文件里有几个参数直接决定你能不能建出图来。lid_topic和imu_topic必须和驱动实际发布的 topic 对上。驱动默认发的点云 topic 是/livox/lidarIMU 是/livox/imu。如果你改过驱动的配置这里也要同步改。extrinsic_T和extrinsic_R是雷达和 IMU 之间的外参。Mid360 是内置 IMU 的理论上外参是固定的官方也给了一组默认值。但如果你发现建图有明显的旋转漂移或者地面不平可以怀疑一下这个外参。不过大多数情况下用默认值就行别乱调。blind这个参数是盲区距离单位米。Mid360 最近测距大概在 0.1 米左右但太近的点噪声大一般设成 0.5 到 1.0 比较合适。设太小会有大量近处噪声点进入建图设太大又会丢失近处信息。det_range是有效测距范围Mid360 设成 40 到 50 都行。这个参数影响的是点云筛选设得比实际测距大一点没关系。filter_size_surf和filter_size_map是降采样体素大小。这两个参数直接关系到建图精度和计算量。室内场景我一般用 0.2 到 0.3室外大场景可以用 0.5。设太小计算量爆炸设太大地图会糊。acc_cov、gyr_cov、b_acc_cov、b_gyr_cov这几个是 IMU 的噪声协方差。Mid360 内置 IMU 的噪声特性官方有数据手册但实际用的时候如果发现建图在快速运动时飘得厉害可以适当调大这几个协方差值让滤波器更信任雷达观测而不是 IMU 预测。3.3 启动顺序与时间同步问题启动顺序这件事说简单也简单说坑也坑。正确的顺序是先启动雷达驱动确认点云和 IMU 都在正常发布再启动 FAST_LIO2。如果反过来FAST_LIO2 启动时收不到数据可能会直接退出或者卡住。时间同步是另一个大坑。Mid360 的点云和 IMU 时间戳来自雷达内部时钟而 ROS 系统用的是主机时钟。如果两者不同步FAST_LIO2 在做紧耦合的时候会出现时间对齐错误表现就是建图飘、重影、甚至直接发散。解决办法有几个一是用 PTP 或者 GPS 做硬件时间同步这个对普通玩家来说太重了二是确保驱动配置里开启了时间同步选项让雷达时间戳尽量贴近主机时间三是在 FAST_LIO2 里检查time_sync_en这个参数如果雷达和主机时间差太大可以打开软件时间同步。我自己的经验是大多数室内场景下只要主机和雷达都正常上电时间差不会大到影响建图。但如果你发现地图有明显的双层或者拖影第一时间去查时间戳。用rostopic echo /livox/lidar看一下 header 里的 stamp 和当前 ROS 时间差多少如果差了几秒甚至几十秒那就是时间同步没做好。4. 建图过程中那些让人抓狂的现象与排查4.1 点云稀疏或者干脆没有点云驱动启动了topic 也在发但 RViz 里看不到点云或者点云稀稀拉拉。这种情况先别怀疑 FAST_LIO2问题大概率在驱动层。第一步确认MID360_config.json里的 IP 配置全对。特别是host_net_info里的四个 IP必须是你主机网卡的实际 IP。第二步确认网卡是不是千兆的。Mid360 的数据量需要千兆网口百兆网口会丢包严重表现就是点云断断续续。第三步检查网线。别笑我真的遇到过网线接触不良导致点云时有时无的情况换根线就好了。如果点云能出来但特别稀疏检查一下publish_freq这个参数。驱动默认可能是 10Hz但如果你设成了 5Hz 或者更低点云密度就会下降。另外data_src要设成 0表示从雷达实时读取如果设成了 1从文件读取而你又没有文件那自然没有点云。4.2 建图飘移、重影、地面不平这是 FAST_LIO2 最常被吐槽的问题但绝大多数情况下不是算法本身的问题而是配置或者数据质量的问题。先看 IMU 数据质量。用rostopic echo /livox/imu看一下角速度和加速度的数值。静止状态下角速度应该在零附近小幅波动加速度的 Z 轴应该接近 9.8。如果角速度有几十度每秒的偏置或者加速度数值离谱那 IMU 可能有问题。Mid360 内置 IMU 一般不会坏但如果你把雷达装在振动很大的平台上IMU 数据会被振动污染建图必飘。再看外参。虽然 Mid360 是内置 IMU但雷达和 IMU 的坐标系定义如果和 FAST_LIO2 的假设不一致也会导致建图异常。检查配置文件里的extrinsic_R是不是单位矩阵或者官方推荐值。如果你自己改过改回去试试。还有一个容易被忽略的点point_filter_num这个参数。它控制每隔几个点取一个点参与计算。设成 1 表示全用设成 3 表示每三个点用一个。如果设得太大参与计算的点太少建图会不稳设得太小计算量又太大。Mid360 点频高一般设 2 到 3 比较平衡。4.3 FAST_LIO2 启动就崩或者跑几秒就退出这种情况通常有几个原因。一是消息类型不匹配比如 FAST_LIO2 订阅的是livox_ros_driver2/CustomMsg但驱动发的是sensor_msgs/PointCloud2类型对不上直接崩。检查驱动的xfer_format参数设成 1 是 CustomMsg设成 0 是 PointCloud2。FAST_LIO2 默认要 CustomMsg所以驱动这边要设成 1。二是配置文件路径不对。FAST_LIO2 启动时会去读 yaml 文件如果路径写错了或者文件不存在它会用默认值或者直接报错退出。检查 launch 文件里的config_file参数指向的路径是否正确。三是内存不够。FAST_LIO2 建图时会把点云地图存在内存里如果场景很大跑很久内存会持续增长。如果你机器内存只有 8G跑大场景可能会被 OOM killer 干掉。建议至少 16G 内存大场景最好 32G。5. 让建图效果更稳的几个实战技巧5.1 雷达安装位置与振动隔离Mid360 虽然叫固态但它对振动还是很敏感的。如果你把它刚性固定在一个振动很大的底盘上IMU 数据会被高频振动污染FAST_LIO2 的预测步骤就会出错。我的做法是在雷达和安装板之间加一层减震垫哪怕是一层薄薄的橡胶垫效果都很明显。安装位置也有讲究。尽量让雷达的视场不被遮挡特别是垂直视场。Mid360 的垂直视场是 -7 到 52 度如果你把它装得太低地面反射会占很大比例装得太高近处盲区又大。一般装在机器人顶部或者前方偏上的位置比较合适。5.2 建图前的静态初始化FAST_LIO2 启动后需要一段时间的静态初始化让 IMU 零偏收敛。这段时间里不要移动雷达让它静止几秒钟。如果你一启动就拿着雷达跑初始化没完成建图从一开始就是歪的。我一般会看 RViz 里的位姿输出等它稳定个三五秒再开始移动。另外初始化阶段最好让雷达对着一个有足够几何特征的环境比如墙角或者有家具的房间。如果对着白墙特征太少初始化也会不稳。5.3 大场景建图的回环与保存FAST_LIO2 本身不带回环检测它只做里程计。所以如果你建一个大场景走一圈回到原点地图可能会有累积误差首尾对不上。这是正常的不是 bug。要解决回环问题可以在 FAST_LIO2 后面接一个回环检测模块比如 SC-PGO 或者 LIO-SAM 里的回环部分。但那是另一套东西了这篇不展开。如果你只是建个小场景FAST_LIO2 的精度足够不回环也能看。保存地图的话FAST_LIO2 提供了rosrun fast_lio map_saver之类的工具或者你可以用pcl_ros把/cloud_registered这个 topic 存成 pcd 文件。注意保存的时候要等地图完全建完再存别建到一半就存那样存下来的地图是不完整的。5.4 计算资源与实时性的平衡FAST_LIO2 在 Mid360 上的计算量不算小特别是在降采样体素设得很小的时候。如果你发现建图时 CPU 占用率一直 100%位姿输出频率掉得很厉害那就要考虑降一下计算量。可以调的参数有增大filter_size_surf和filter_size_map增大point_filter_num减少max_iterationIEKF 的迭代次数。这几个参数调一调计算量能降不少精度损失在可接受范围内。另外编译的时候打开-O3优化对性能也有帮助。FAST_LIO2 的 CMakeLists 里默认可能是-O2改成-O3能快一些。6. 一些零散但重要的经验补充关于 IMU 频率Mid360 内置 IMU 是 200Hz但 FAST_LIO2 里有个imu_rate或者类似的参数要确保和实际频率一致。如果设错了滤波器的时间更新步长就不对建图会飘。关于点云格式如果你用 ROS2消息类型和 ROS1 不一样FAST_LIO2 的 ROS2 分支里订阅的 topic 类型要对应改。这个在 ROS2 下跑的时候特别容易忘。关于雷达固件Mid360 的固件版本会影响数据格式和稳定性。如果你的雷达是很早的固件建议升级到官方推荐版本。升级工具官方有提供过程不复杂但升级时别断电。关于多雷达如果你要同时用多个 Mid360配置会更复杂每个雷达的 IP 和 topic 都要区分开FAST_LIO2 那边也要改订阅逻辑。这个场景比较小众遇到问题去官方 issue 里搜大概率有人踩过。最后说一个我自己的习惯每次改完配置先不急着跑完整建图而是用rosbag record录一小段数据然后离线跑 FAST_LIO2。这样调试起来快不用每次都重新走一遍。录包的时候记得把点云和 IMU 都录上rosbag record /livox/lidar /livox/imu就行。离线跑通了再上实机效率高很多。这套 Mid360 加 FAST_LIO2 的组合跑通之后你会发现它真的很能打。但跑通之前的那些坑每一个都够你折腾半天。上面这些是我自己踩过并且印象比较深的希望能帮你少走点弯路。如果你遇到了上面没提到的问题大概率是环境或者硬件层面的回到最基础的检查IP 通不通、topic 有没有数据、时间戳对不对、IMU 数值正常不正常。把这四个问题排除了剩下的就好办了。
