Ubuntu 20.04 —— VINS-Fusion多传感器融合部署与EVO精度分析实战

1. 环境准备与依赖安装

在Ubuntu 20.04上部署VINS-Fusion前，需要先搭建好ROS环境。我推荐使用ROS Noetic版本，这是官方为Ubuntu 20.04适配的最新LTS版本。相比之前Ubuntu 18.04默认的ROS Melodic，Noetic对Python 3的支持更完善，也修复了不少底层依赖问题。

安装基础依赖时，建议先运行以下命令更新系统：

sudo apt update && sudo apt upgrade -y sudo apt install -y git cmake liblapack-dev libblas-dev libeigen3-dev

ROS Noetic的完整安装需要执行：

sudo sh -c 'echo "deb http://packages.ros.org/ros/ubuntu $(lsb_release -sc) main" > /etc/apt/sources.list.d/ros-latest.list' sudo apt-key adv --keyserver 'hkp://keyserver.ubuntu.com:80' --recv-key C1CF6E31E6BADE8868B172B4F42ED6FBAB17C654 sudo apt update sudo apt install -y ros-noetic-desktop-full echo "source /opt/ros/noetic/setup.bash" >> ~/.bashrc source ~/.bashrc

对于VINS-Fusion特有的依赖，还需要额外安装：

sudo apt install -y ros-noetic-cv-bridge ros-noetic-tf ros-noetic-message-filters ros-noetic-image-transport

这里有个小技巧：如果之前安装过其他ROS版本，建议先彻底清理旧环境。我就遇到过因为残留的Melodic包导致编译冲突的情况。可以通过dpkg -l | grep ros-melodic检查并卸载相关包。

2. VINS-Fusion源码编译实战

创建工作空间时，我习惯单独为每个SLAM算法创建独立的工作空间。这样可以避免不同项目的依赖冲突：

mkdir -p ~/vins_fusion_ws/src cd ~/vins_fusion_ws/src catkin_init_workspace

克隆源码时要注意，官方仓库有几个活跃分支。对于Ubuntu 20.04，建议使用noetic分支：

git clone -b noetic https://github.com/HKUST-Aerial-Robotics/VINS-Fusion.git

编译过程中最常见的坑是Eigen版本冲突。Ubuntu 20.04默认安装的是Eigen 3.3.7，而VINS-Fusion需要至少3.3.4版本。如果遇到奇怪的模板错误，可以尝试：

sudo apt install -y libeigen3-dev sudo ln -s /usr/include/eigen3/Eigen /usr/include/Eigen

完整编译命令如下：

cd ~/vins_fusion_ws catkin_make -j$(nproc) source devel/setup.bash

编译成功后，建议立即测试一个简单示例：

roslaunch vins vins_rviz.launch rosrun vins vins_node src/VINS-Fusion/config/euroc/euroc_mono_imu_config.yaml

如果RViz中能正常显示坐标系和图像，说明基础环境已经配置正确。

3. 多传感器配置与数据准备

VINS-Fusion的强大之处在于支持多种传感器组合。根据我的实测经验，不同配置需要特别注意以下细节：

单目+IMU配置：

• 需要标定好的相机内参和IMU-相机外参
• 建议IMU频率至少200Hz，相机不低于20Hz
• 修改euroc_mono_imu_config.yaml中的传感器参数

双目+IMU配置：

• 必须精确标定双目基线长度
• 左右相机需要硬件同步
• 配置文件对应euroc_stereo_imu_config.yaml

双目+GPS配置：

• GPS需要提供NMEA格式的GPRMC消息
• 注意设置正确的UTM区域参数
• 使用kitti_10_03_config.yaml模板

数据集方面，除了常用的EuRoC MAV数据集，我推荐使用：

• TUM VI数据集（更适合室内场景）
• KAIST Urban数据集（包含城市GPS信号）
• 自采数据时，建议先用Kalibr工具进行传感器标定

准备数据集时有个实用技巧：使用rosbag reindex命令修复可能损坏的bag文件。我遇到过多次因为录制中断导致的bag无法播放的问题，这个命令通常能解决。

4. 轨迹输出格式修改与优化

原始VINS-Fusion输出的轨迹格式与EVO不兼容，需要进行三处关键修改：

1. visualization.cpp修改：

// 修改前 ofstream foutC("result.csv", ios::app); foutC << turetime << " " << estimator.Ps[WINDOW_SIZE].x() << " " ...; // 修改后 ofstream foutC("result.tum", ios::app); foutC << fixed << setprecision(6) << turetime << " " << estimator.Ps[WINDOW_SIZE].x() << " " << estimator.Ps[WINDOW_SIZE].y() << " " << estimator.Ps[WINDOW_SIZE].z() << " " << tmp_Q.x() << " " << tmp_Q.y() << " " << tmp_Q.z() << " " << tmp_Q.w() << endl;

2. pose_graph.cpp修改：

// 修改循环闭合保存格式 ofstream loop_path_file("loop_result.tum", ios::app); loop_path_file << fixed << setprecision(6) << turetime << " " << P.x() << " " << P.y() << " " << P.z() << " " << Q.x() << " " << Q.y() << " " << Q.z() << " " << Q.w() << endl;

3. globalOptNode.cpp修改：

// 修改全局优化结果格式 ofstream foutC("vio_global.tum", ios::app); foutC << fixed << setprecision(6) << pose_msg->header.stamp.toSec() << " " << global_t.x() << " " << global_t.y() << " " << global_t.z() << " " << global_q.x() << " " << global_q.y() << " " << global_q.z() << " " << global_q.w() << endl;

修改后需要重新编译，建议先执行catkin clean清除缓存：

cd ~/vins_fusion_ws catkin clean catkin_make -j$(nproc)

5. EVO精度评估全解析

EVO工具的正确使用需要掌握几个关键点：

轨迹对齐：这是最容易被忽视但最重要的步骤。没有对齐的评估结果毫无意义：

evo_ape tum groundtruth.tum vins_result.tum -a --plot

-a参数表示自动进行SE(3)对齐，推荐始终开启。

指标解读：

• APE（绝对位姿误差）：反映整体轨迹精度
• RPE（相对位姿误差）：分析局部漂移情况
• 重点关注RMSE和median值，它们对异常值不敏感

完整评估流程示例：

# 1. 格式转换（如需要） evo_traj euroc data.csv --save_as_tum # 2. 轨迹可视化对比 evo_traj tum vins_result.tum --ref=groundtruth.tum -p --plot_mode=xyz # 3. APE评估 evo_ape tum groundtruth.tum vins_result.tum -r full -va --plot --plot_mode=xyz --save_results results/ape.zip # 4. RPE评估 evo_rpe tum groundtruth.tum vins_result.tum -r angle_deg --delta 1 --delta_unit m -va --plot --save_results results/rpe.zip # 5. 结果对比 evo_res results/*.zip -p --save_table results/table.csv

可视化技巧：

• 使用--plot_mode=xyz分离三维坐标
• 添加--save_plot参数保存高清图片
• 对于长时间轨迹，可以用--t_max_diff 0.1过滤时间不同步的数据

6. 不同传感器组合性能对比

通过大量实测，我总结了不同配置在EuRoC数据集上的典型表现：

从数据可以看出：

1. IMU对提升精度效果显著，特别是在快速运动场景
2. 双目比单目系统更稳定，但计算代价更高
3. GPS能有效抑制长时间漂移，但在室内会失效

实际部署时还有个重要发现：VINS-Fusion对IMU质量非常敏感。我用过几款不同价位的IMU，百元级和千元级IMU的精度差异能达到3-5倍。如果预算允许，建议至少选用BMI088或ICM-42688这个级别的IMU。

7. 常见问题排查指南

问题1：启动时报GLIBCXX版本错误解决方案：

sudo add-apt-repository ppa:ubuntu-toolchain-r/test sudo apt update sudo apt install -y gcc-9 g++-9 sudo update-alternatives --install /usr/bin/gcc gcc /usr/bin/gcc-9 60

问题2：RViz显示异常尝试修改显卡驱动配置：

sudo apt install -y nvidia-driver-510 sudo apt install -y libnvidia-gl-510

问题3：轨迹严重漂移检查以下配置项：

1. 相机曝光时间是否过短导致运动模糊
2. IMU噪声参数是否与硬件匹配
3. 特征点提取数量是否足够（建议150-200个）

问题4：EVO评估时报时间戳错误使用时间对齐工具预处理：

evo_traj tum vins_result.tum --ref groundtruth.tum --align --correct_time

8. 进阶调优技巧

经过多次项目实践，我总结出几个有效提升精度的技巧：

参数调优：

1. 调整config.yaml中的max_solver_time，复杂场景可以增加到0.05-0.1
2. 修改feature_threshold控制特征点数量，室内建议15-20，室外20-30
3. 对于高频IMU，适当增加imu_acc_noise和imu_gyro_noise的值

系统集成建议：

1. 使用ros::Time::now()替代传感器原始时间戳，确保时间同步
2. 对图像添加去畸变处理，可以提升特征匹配精度
3. 在GPS信号良好的区域，增加gps_weight权重到1.0-1.5

硬件选择经验：

1. 相机优先选择全局快门，如IMX296/IMX477
2. IMU推荐BMI088+IST8310组合，性价比高
3. 计算平台建议Jetson AGX Orin或i7-1185G7起步

最后分享一个实用脚本，可以自动运行所有评估流程：

#!/bin/bash # auto_eval.sh # 运行VINS-Fusion roslaunch vins_estimator euroc.launch & rosbag play $1 & wait # 格式转换 evo_traj tum result.tum --save_as_tum # 评估 evo_ape tum groundtruth.tum result.tum -a -p --save_results $1_ape.zip evo_rpe tum groundtruth.tum result.tum -a -p --save_results $1_rpe.zip # 生成报告 evo_res $1_*.zip -p --save_table $1_results.csv