Skip to main content
QUICK REVIEW

[论文解读] xVIO: A Range-Visual-Inertial Odometry Framework

Jeff Delaune, David S. Bayard|arXiv (Cornell University)|Oct 13, 2020
Robotics and Sensor-Based Localization参考文献 13被引用 6
一句话总结

xVIO 是一种由喷气推进实验室(JPL)开发的实时、测距-视觉-惯性里程计框架,专为自主旋翼飞行器导航设计,融合了摄像头(可见光或热红外)、IMU 和飞行时间测距传感器的数据。该系统采用混合 SLAM-MSCKF 扩展卡尔曼滤波器,并进行了严格的可观测性分析与雅可比矩阵推导,在市售硬件上实现了 30 Hz 的运行速度,表现出在昼夜、室内外以及飞行/手持等多种工况下的鲁棒性能。

ABSTRACT

xVIO is a range-visual-inertial odometry algorithm implemented at JPL. It has been demonstrated with closed-loop controls on-board unmanned rotorcraft equipped with off-the-shelf embedded computers and sensors. It can operate at daytime with visible-spectrum cameras, or at night time using thermal infrared cameras. This report is a complete technical description of xVIO. It includes an overview of the system architecture, the implementation of the navigation filter, along with the derivations of the Jacobian matrices which are not already published in the literature.

研究动机与目标

  • 解决在多样化环境(包括昼夜运行)中,对自主旋翼飞行器实现鲁棒、实时状态估计的挑战。
  • 将测距传感器测量值与视觉和惯性数据融合,以提升深度估计精度并减少视觉-惯性里程计中的漂移。
  • 开发一种灵活、模块化的框架,支持使用市售传感器与嵌入式系统的 VIO、测距-VIO 和惯性里程计模式。
  • 通过推导并分析可观测性矩阵,确保在恒定加速度和动态运动条件下状态估计的可观测性与稳定性。
  • 提供视觉与测距-视觉测量的雅可比矩阵的完整推导,以在 EKF 框架中实现精确的误差传播。

提出的方法

  • 采用混合 SLAM 与 MSCKF 范式构建视觉测量,结合两者优势以提升精度与计算效率。
  • 使用带滑动窗口的扩展卡尔曼滤波器(xEKF)进行状态估计,基于连续时间动力学传播位置、速度、姿态和 IMU 偏置状态。
  • 通过环形缓冲区管理实时运行中的传感器与处理延迟,确保 IMU、视觉与测距测量之间的同步。
  • 利用 FAST 进行特征检测,Lucas-Kanade 进行跟踪,通过基础矩阵估计结合 RANSAC 实现异常值剔除,构建视觉测量。
  • 通过测距-视觉更新模型融合深度数据与视觉特征,以约束状态估计并提升可观测性。
  • 以闭式形式推导出视觉与测距-视觉测量的完整雅可比矩阵,包括世界、相机与特征坐标系之间的变换,详细推导见附录。

实验结果

研究问题

  • RQ1如何有效融合测距传感器数据与视觉及惯性测量,以增强视觉-惯性里程计的精度与鲁棒性?
  • RQ2在视觉特征稀少或运动受限的情况下,添加测距测量对状态估计可观测性有何影响?
  • RQ3为确保 EKF 框架中误差传播的准确性,视觉与测距-视觉测量的雅可比矩阵应如何推导?
  • RQ4混合 SLAM-MSCKF 方法能否在嵌入式平台上高效实现实时运行,以支持自主旋翼飞行器导航?
  • RQ5在平台经历恒定加速度或激励运动受限时,系统状态估计在何种条件下是可观测的?

主要发现

  • xVIO 在市售嵌入式硬件(如高通 Snapdragon Flight Pro)上实现了 30 Hz 的实时性能,支持自主旋翼飞行的闭环控制。
  • 系统在白天(可见光谱摄像头)与夜间(长波红外摄像头)均能稳定运行,展现出对光照条件变化的鲁棒性。
  • 可观测性分析表明,系统在恒定加速度下具有可观测性,不可观测方向与 SLAM 特征中未形成平面的深度模糊性相关。
  • 视觉与测距-视觉测量的雅可比矩阵推导数学严谨,通过闭式推导验证,确保误差协方差传播的准确性。
  • 混合 SLAM-MSCKF 方法显著降低了漂移,尤其在视觉特征稀疏或运动受限时表现更优。
  • 测距-视觉更新显著改善了深度估计并减少了漂移,尤其在低纹理或动态环境中,传统视觉里程计失效时表现突出。

更好的研究,从现在开始

从阅读论文到最终审阅,大幅缩短您的研究时间。

无需绑定信用卡

本解读由 AI 生成,并经人工编辑审核。