[論文レビュー] VR-SLAM: A Visual-Range Simultaneous Localization and Mapping System using Monocular Camera and Ultra-wideband Sensors

Thien Hoang Nguyen, Shenghai Yuan+1 more|arXiv (Cornell University)|Mar 20, 2023

Robotics and Sensor-Based Localization被引用数 5

ひとこと要約

本稿では、メトリックスケールで、ドリフトなしで、グローバルに一貫性のある同時位置特定と地図作成を実現する、単眼カメラと超広帯域（UWB）センサの融合システムであるVR-SLAMを提案する。UWBを用いた初期化、密結合なバンドル調整、ポーズグラフ最適化を活用することで、トラッキング障害の処理や長期間にわたるドリフトの除去において、ループクロージャーに依存せずに優れた精度と耐障害性を達成する。

ABSTRACT

In this work, we propose a simultaneous localization and mapping (SLAM) system using a monocular camera and Ultra-wideband (UWB) sensors. Our system, referred to as VRSLAM, is a multi-stage framework that leverages the strengths and compensates for the weaknesses of each sensor. Firstly, we introduce a UWB-aided 7 degree-of-freedom (scale factor, 3D position, and 3D orientation) global alignment module to initialize the visual odometry (VO) system in the world frame defined by the UWB anchors. This module loosely fuses up-to-scale VO and ranging data using either a quadratically constrained quadratic programming (QCQP) or nonlinear least squares (NLS) algorithm based on whether a good initial guess is available. Secondly, we provide an accompanied theoretical analysis that includes the derivation and interpretation of the Fisher Information Matrix (FIM) and its determinant. Thirdly, we present UWBaided bundle adjustment (UBA) and UWB-aided pose graph optimization (UPGO) modules to improve short-term odometry accuracy, reduce long-term drift as well as correct any alignment and scale errors. Extensive simulations and experiments show that our solution outperforms UWB/camera-only and previous approaches, can quickly recover from tracking failure without relying on visual relocalization, and can effortlessly obtain a global map even if there are no loop closures.

研究の動機と目的

• 屋内やGPSが利用できない環境において、正確でドリフトのない、グローバルに一貫性のある位置特定を達成する挑戦に応える。
• スケールの曖昧さやドリフトといった単眼ビジュアルオドメトリの限界を、UWB距離測定データの統合によって克服する。
• ビジュアル再ロケリゼーションやループクロージャーに依存せずに、ビジュアルトラッキング障害からの回復が可能な耐障害性の高いシステムを開発する。
• ループクロージャーが存在しない状況でも、グローバルマップの一貫性と複数セッションにわたるマップ統合を可能にする。
• フィッシャー情報行列（FIM）分析とクラーマー・ラオ低限界（CRLB）導出を用いて、グローバルアフィン変換（GAT）問題の理論的基盤を提供する。

提案手法

• UWBで定義された世界座標系において、ビジュアルオドメトリを初期化するため、2次制約付き二次計画（QCQP）または非線形最小二乗（NLS）を用いたUWB支援7自由度グローバルアライメントモジュールを導入する。
• フィッシャー情報行列（FIM）とその行列式に基づく理論的枠組みを用いて、グローバルアフィン変換（GAT）問題のクラーマー・ラオ低限界（CRLB）を分析する。
• UWB支援バンドル調整（UBA）とUWB支援ポーズグラフ最適化（UPGO）を適用し、ビジュアル測定と距離測定を密結合に融合することで、ドリフトを低減し、スケールおよびアライメント誤差を補正する。
• マルチステージフレームワークを採用する：(1) UWBとVOによる緩く結合された初期化、(2) 密結合なビジュアル・レンジオドメトリ、(3) 故故復旧のためのUWB支援再ロケリゼーション。
• 回転行列パラメータライゼーションと単位ベクトル分解を用いてFIMの解析的勾配を導出し、正確な不確実性評価を可能にする。
• UWBアンカー数が異なる複数のデータセット（公的および自作）を用いた合成シミュレーションと実世界実験により、システムを検証する。

実験結果

リサーチクエスチョン

• RQ1 UWB距離測定データをどのように単眼ビジュアルオドメトリと効果的に統合することで、メトリックスケールでドリフトなしでグローバルに一貫性のあるSLAMを達成できるか？
• RQ2 ビジュアルレンジSLAMにおけるグローバルアフィン変換（GAT）問題の理論的性能限界（CRLB）は何か？ そして、それはシステムの不確実性を評価するためにどのように利用できるか？
• RQ3 ビジュアル測定とUWB測定を密結合に統合することで、単独のシステムに比べて、長期間にわたるドリフト低減およびスケール・アライメント誤差の補正をより効果的に行えるか？
• RQ4 ビジュアル再ロケリゼーションやループクロージャーに依存せずに、トラッキング障害からの回復はどの程度達成可能か？
• RQ5 視線内（LoS）のUWBアンカー数が、システムの長期間にわたるドリフトと精度にどのように影響するか？

主な発見

• VR-SLAMは、UWBのみ、またはカメラのみのSLAMシステムに比べて、位置特定の精度とドリフト低減において顕著に優れている。
• 2つ以上のUWBアンカーが視線内にある場合（¯N = 2 または 3）、システムはミッション全体を通じて低い並進ドリフトを維持し、優れた長期的安定性を示している。
• 1つのUWBアンカー（¯N = 1）の状況では、ドリフトは依然として低減されるが、誤差の顕著な補正にはビジュアルループクロージャーに依存する必要があることが示され、アンカー数の重要性が浮き彫りになった。
• UWB支援再ロケリゼーションのおかげで、ビジュアル再ロケリゼーションに依存せずにトラッキング障害からの回復が成功しており、世界座標系における迅速な再初期化が可能である。
• ループクロージャーが存在しない状況でも、UWBベースの初期化と最適化によってグローバル一貫性が保たれ、複数セッションにわたるマップ統合が達成された。
• 理論的FIMおよびCRLB分析により、特異な構成が特定され、スケール、位置、姿勢における不確実性が定量的に評価され、システムの耐障害性と設計制約に関する洞察が得られた。