Tightly-coupled vs Loosely-coupled

カメラとIMUを融合する際、最初のアーキテクチャ上の決定は融合がどこで行われるかである。

**疎結合(Loosely-coupled)**システムは、個別の推定器を実行する — カメラポーズを生成する視覚オドメトリパイプラインと、IMU観測を統合する慣性ナビゲーションパイプライン — その後、それらの出力(ポーズ、速度)を第二段階で、典型的にはカルマンフィルタを用いて融合する。各サブシステムは互いをブラックボックスとして扱う。

camera → [ VO pipeline ]  → pose estimate ─┐
                                           ├→ [ fusion filter ] → fused state
IMU    → [ INS integration ] → pose/vel  ──┘

**密結合(Tightly-coupled)**システムは、両センサの生の観測を単一の推定器に投入する:画像特徴観測(再投影残差)とIMU観測(プレインテグレーションされた慣性残差)が、ポーズ、速度、IMUバイアスを含む一つの共有状態上で同時に最適化される。現代のVIOシステムのほぼ全て — MSCKF、OKVIS、VINS-Mono、Kimera-VIO、Basalt — は密結合である。

結合状態の見た目

密結合のスライディングウィンドウ推定器は、各キーフレームiiについて

xi=(Ri,  pi,  vi,  big,  bia)\mathbf{x}_i = \left(\mathbf{R}_i,\; \mathbf{p}_i,\; \mathbf{v}_i,\; \mathbf{b}^g_i,\; \mathbf{b}^a_i\right)

に加えてランドマークパラメータ(あるいは構造レスな等価物)を保持し、以下の形のコストを最小化する。

minX  rp2  +  (i,j)rIMU(xi,xj)Σ12  +  k,iρ ⁣(rreproj(lk,xi)2).\min_{\mathcal{X}} \; \|\mathbf{r}_p\|^2 \;+\; \sum_{(i,j)} \|\mathbf{r}_{\text{IMU}}(\mathbf{x}_i, \mathbf{x}_j)\|^2_{\Sigma^{-1}} \;+\; \sum_{k,i} \rho\!\left(\|\mathbf{r}_{\text{reproj}}(\mathbf{l}_k, \mathbf{x}_i)\|^2\right).

両方のセンサモダリティが同じ解の中で同じ変数を制約する — これが密結合の定義である。疎結合の設計では代わりに、融合フィルタにポーズ観測T^i\hat{\mathbf{T}}_iが与えられるが、その内部構造(どの方向がよく制約されていたか、どの特徴からそれが生成されたか)はすでに圧縮されて失われている。

比較

疎結合密結合
融合レベルポーズ/速度の推定値生の観測
精度低い(インターフェースで情報が失われる)高い(センサ間の相関を活用)
複雑さ低い;サブシステムの再利用が可能高い;結合状態とヤコビアン
故障時の挙動一つのサブシステムが独立に故障できる視覚の外れ値が結合状態を汚染しうるが、IMUもビジョンを補助する(例:特徴予測)
バイアス推定融合後のポーズのみからはIMUバイアスは観測不能バイアスは結合的に推定され、ビジョンによって制約される
ポーズ融合EKF(例:ethzasl MSF系のフレームワーク)、古典的なGNSS/INS統合MSCKF、OKVIS、VINS-Mono、Kimera-VIO、Basalt

なぜ密結合が精度で優れるのか

視覚情報と慣性情報の間の相関こそが、結合システムを強力にしている要因である。

その代償と、疎結合が正しい場合

密結合は、一貫した時刻同期(数ミリ秒のカメラ-IMUオフセットでも精度が低下する)、正確なカメラ-IMU外部キャリブレーション、注意深い初期化手順(重力、速度、バイアス、スケール)、および状態を有界にするためのマージナライズの仕組みを要求する。疎結合の設計は、モジュール性が最高精度よりも重要な場合に生き残る:既存のオドメトリソース(車輪オドメトリ、独自仕様のVOブラックボックス、GNSS/INS)を迅速に統合する場合、冗長/フェイルオーバーアーキテクチャを構築する場合、あるいはプロトタイピングの場合である。あるサブシステムの出力がすでにほぼ最適であり、その故障モードを封じ込めておく必要がある場合、疎結合は正当な、単に劣ったものではない工学的選択である。

よくある落とし穴

SLAMにおける意義

この区別は、あらゆるVIO論文について最初に問うべき質問であり、同じ語彙は他のすべてのマルチセンサ融合の文脈(LiDAR-視覚-慣性、GNSS融合)にも繰り返し現れる。密結合が精度で優れる理由 — 保持されたセンサ間相関 — を理解することは、計算資源が許す限り分野が常に結合推定へ向かっていく理由も説明する。

関連ノート