基于FastLIO2与TEB算法的机器狗自主导航系统实战

1. 从零到一：为什么选择FastLIO2与TEB来武装你的机器狗？

大家好，我是老张，一个在机器人圈子里折腾了十多年的“老炮儿”。这些年，从实验室的仿真模型到满屋子跑的实体机器狗，我踩过的坑可能比有些朋友走过的路还多。今天，我想和你聊聊一个特别实在的话题：怎么让你手头那个“铁疙瘩”机器狗，真正聪明地自己走起来？不是那种磕磕绊绊、动不动就撞墙的走，而是能稳健避障、自主规划路径的智能行走。

你可能已经尝试过ROS里那些经典的导航方案，比如用gmapping建图，再用move_base框架下的DWA局部规划器。但实操过的朋友都知道，这套组合在仿真里还行，一到真机，尤其是用固态激光雷达（比如Livox MID360）的机器狗上，问题就来了：定位容易飘、遇到复杂地形规划反应慢、转弯磕磕碰碰。根本原因在于，经典方案对高频、稠密的3D点云处理效率不够，规划算法也不够灵活。

所以，我决定换一套“组合拳”：FastLIO2 负责定位，TEB（Timed Elastic Band）负责局部路径规划。这不是拍脑袋想的，而是经过好几个项目验证后的最优解。FastLIO2是FAST-LIO的重大升级，它专门为像MID360这类固态激光雷达优化，计算效率极高，能提供稳定、低延迟的里程计和地图，这是机器狗不“晕头转向”的基础。而TEB算法，你可以把它想象成一根有弹性的橡皮筋，机器人的轨迹就是这根橡皮筋，它能在满足机器人运动学（比如最大速度、加速度）的前提下，被障碍物“推开”，被目标点“拉近”，实时优化出一条平滑、安全、快速的路径，特别适合机器狗这种需要灵活转向和动态避障的平台。

这套系统适合谁呢？如果你已经对ROS（Noetic或Melodic）有基本了解，会启动节点、看话题、用rviz，并且手头有一个带激光雷达（特别是Livox系列）的移动机器人或机器狗，想实现更鲁棒、更灵活的自主导航，那么这篇实战指南就是为你准备的。我们不谈空洞的理论，直接上代码、讲配置、说调参，目标就是让你能跟着步骤，把系统跑起来，看到机器狗稳稳当当地走向目标点。

2. 实战第一步：搭建你的ROS与感知硬件环境

工欲善其事，必先利其器。在开始算法折腾之前，一个干净、配置正确的软件和硬件环境是成功的一半。这里我会详细走一遍流程，并指出几个我踩过的大坑。

2.1 ROS Noetic与系统准备

我强烈推荐在 Ubuntu 20.04 上使用 ROS Noetic。这是目前最稳定、社区支持最完善的LTS组合。安装ROS有很多方法，但我最喜欢用“鱼香ROS”的一键安装脚本，真的省心。

wget http://fishros.com/install -O fishros && . fishros

运行后，跟着交互提示选择1（一键安装ROS），再选择noetic版本即可。它会帮你配置好源、安装桌面完整版以及初始化rosdep。安装完成后，别忘了在~/.bashrc文件末尾添加source /opt/ros/noetic/setup.bash，或者为每个终端手动source。

接下来，为我们的项目创建一个独立的工作空间。我习惯在home目录下创建，这样路径清晰。

mkdir -p ~/sentry_ws/src
cd ~/sentry_ws
catkin_make

2.2 Livox MID360雷达驱动安装与配置

Livox雷达性能很强，但它的驱动和常见ROS激光雷达话题格式不太一样，需要单独安装。这里有个关键点：我们需要同时安装livox_ros_driver和livox_ros_driver2。因为有些老代码依赖前者，而FastLIO2等新算法依赖后者。别担心，它们可以共存。

首先，安装Livox的核心SDK：

cd ~
git clone https://github.com/Livox-SDK/Livox-SDK2.git
cd Livox-SDK2
mkdir build && cd build
cmake ..
make -j$(nproc)
sudo make install

然后，分别克隆两个ROS驱动包到我们的工作空间src目录下：

cd ~/sentry_ws/src
git clone https://github.com/Livox-SDK/livox_ros_driver.git
git clone https://github.com/Livox-SDK/livox_ros_driver2.git

现在配置雷达IP，这是让电脑和雷达通信的关键。MID360默认出厂IP是192.168.1.12。我们需要将主机的有线网络（连接雷达的那个网口）配置到同一网段，比如192.168.1.5。

1. 打开“网络设置”，选择连接雷达的以太网连接。
2. 点击“IPv4”选项卡，方法选择“手动”。
3. 添加地址：192.168.1.5，子网掩码：255.255.255.0，网关可以不填。
4. 保存并应用。

配置好后，用网线连接电脑和雷达，打开终端，尝试ping 192.168.1.12，如果通，就说明连接成功。如果不