[論文レビュー] Real-time tightly coupled GNSS and IMU integration via Factor Graph Optimization

Radu-Andrei Cioaca, Paul Irofti+4 more|arXiv (Cornell University)|Mar 3, 2026

GNSS positioning and interference被引用数 0

ひとこと要約

論文は、incremental iSAM2と固定遅延平滑化を用いた因子グラフ最適化によるリアルタイムの tightly coupled GNSS–IMU ナビゲーション手法を提案し、都市部のGNSS劣化データで評価しています。

ABSTRACT

Reliable positioning in dense urban environments remains challenging due to frequent GNSS signal blockage, multipath, and rapidly varying satellite geometry. While factor graph optimization (FGO)-based GNSS-IMU fusion has demonstrated strong robustness and accuracy, most formulations remain offline. In this work, we present a real-time tightly coupled GNSS-IMU FGO method that enables causal state estimation via incremental optimization with fixed-lag marginalization, and we evaluate its performance in a highly urbanized GNSS-degraded environment using the UrbanNav dataset.

研究の動機と目的

• 信号遮蔽とマルチパスがある都市環境における堅牢なリアルタイム GNSS–IMU 融合の動機付け。
• 因子グラフ最適化に基づくリアルタイム、因果的な tight-coupling 手法の開発。
• 複雑さと待機時間を抑えるための固定遅延限界付きインクリメンタル最適化の活用。
• 難易度の高いシナリオにおける GNSS のみおよび緩結合手法に対する性能向上を実証。

提案手法

• GNSS pseudorange および Doppler、IMU 事前積分、時計状態を残差ブロックとする因子グラフ最適化フレームワークを採用。
• 固定遅延のインクリメンタルソルバー（iSAM2）を用いて古い状態を周辺化しつつ因果的・リアルタイムな更新を実現。
• GNSS Doppler（pseudorange-rate）因子を組み込み、速度と時計ドリフトを制約。
• 外部姿勢制約なしに速度と位置との動的結合を通じて姿勢を暗黙的に推定。
• グラフ内の複数衛星運用に対して、姿勢・速度・IMU バイアス・受信機時計状態を表現。

Figure 1: Tightly coupled GNSS/IMU integration scheme.

実験結果

リサーチクエスチョン

• RQ1 固定遅延平滑化を用いた因子グラフ最適化でリアルタイム、 tightly coupled GNSS–IMU 融合を達成できるか。
• RQ2 都市部 GNSS チャレンジ環境における GNSS Doppler 因子の追加が速度・姿勢・位置精度へ与える影響は。
• RQ3 リアルタイム TC FGO は LC および GNSS のみの解法と比較して可用性と水平/鉛直精度に差はあるか。
• RQ4 マージナリゼーション遅延長、推定精度、計算時間のトレードオフは RTFGO-TC でどうなるか。

主な発見

Method	Loop 1 2D RMSE (m)	Loop 1 3D RMSE (m)	Loop 2 2D RMSE (m)	Loop 2 3D RMSE (m)
GNSS-only (RTKLIB)	8.87	30.54	8.25	12.23
RTFGO-LC	10.92	34.25	8.24	10.75
RTFGO-TC	6.44	29.60	7.16	22.88
SFGO-LC	5.87	27.78	6.44	8.12
SFGO-TC	4.79	21.79	4.72	9.73

• RTFGO-TC はループ間を通じて、緩結合解法および GNSS のみの解法と比較して 2D 位置精度を改善。
• 2D RMSE 阈値 10 m のサービス可用性は SFGO-TC および RTFGO-TC が約 80%、LC および GNSSのみ法が約 40% 程度。
• RTFGO-TC は 2D RMSE を Loop 1 が 6.44 m、Loop 2 が 7.16 m（いずれも 2D）とし、水平精度で GNSS のみおよび RTFGO-LC を上回る。
• 垂直方向（3D）RMSE は一部ループで observability の弱さや高さの先験値・地図制約の欠如により劣化することがある。
• 固定遅延ウィンドウを大きくすると 2D/3D 精度の改善は限定的だが、平均最適化時間は増加する（例：60 サンプルのウィンドウで約 59 ms）。
• SFGO-TC と比較して、RTFGO-TC は都市環境でリアルタイム動作を提供し、水平精度が競合的または改善される。

Figure 2: Tightly coupled GNSS and IMU factor graph architecture.