可観測性

状態(または状態空間内の方向)は、利用可能な測定値がそれを制約する場合に可観測である;非可観測な方向は、いかなる測定値も変化させることなく自由にドリフトできる。形式的には、状態を方向$\mathbf{n}$に沿って摂動させてもすべての測定値が不変であるとき、$\mathbf{n}$は非可観測部分空間に属する——線形化されたシステムでは、$\mathbf{n}$は積み重ねられた$\mathbf{H}\boldsymbol{\Phi}$ブロックから構成される可観測性行列の零空間を張る。VIOにおいて正確にどの方向が非可観測であるかを知ることは、一貫性のある推定器を構築するために必須である。

VIOの4自由度の非可観測性

ビジュアル・インエルシャルシステムは、ランドマークへの方位角(カメラ)と比力および角速度(IMU)を測定する。重力はロールとピッチに絶対的な基準を与え、加速度計は一般的な運動下でメトリックスケールを可観測にする。残るのは以下である:

• 3自由度のグローバル並進 — 軌跡とマップ全体を一緒にシフトさせても、カメラの測定値は変化しない(姿勢とランドマーク間の方位角は変化しない)し、IMUの測定値も変化しない(加速度は並進不変である)。
• 1自由度のグローバルヨー — 重力方向を軸にして全体を回転させても方位角は変化せず、重力自体もその軸に関して対称であるため、IMUもこの対称性を破ることができない。対照的に、ロールとピッチは重力が加速度計にどう投影されるかを変えるため、可観測である。

したがって単眼VIOには正確に4自由度の非可観測性が存在する。比較すると:

運動依存の退化

いくつかの状態は、十分に励起する運動の下でのみ可観測になる:

• 一定加速度(ホバリングや等速運動を含む)の下では、メトリックスケールはさらに非可観測になる——加速度計の読みをスケールと加速度に分離できない。これが、一定速度の地上車両や穏やかなドローンのホバリングでVIOが劣化する理由であり、高速道路走行でスケールドリフトが見られる理由であり、初期化手順が動的な運動を要求する理由である。
• 純粋な回転またはゼロ回転は、加速度計バイアス、重力、外部キャリブレーション状態の分離可能性を弱める;オンラインのカメラ・IMUキャリブレーションも複数軸周りの回転励起を必要とする。
• 実用的な原則:運動が豊富であればあるほど(多様な加速度と回転)、スケール、バイアス、外部パラメータの収束は速くなる。DM-VIOのようなシステムは、初期の運動がスケールを十分に励起していない可能性があるため、初期化後も明示的にスケールの最適化を続ける。

直感チェック

なぜヨーは非可観測でロール/ピッチは可観測なのか?世界全体(軌跡+マップ)を重力ベクトルを軸に角度$\alpha$だけ回転させてみる:すべてのカメラは依然として同じ方位角でランドマークを見る(回転は両方に適用される)し、加速度計も同じ重力投影を測定する(重力が回転軸なので、変化しない)。どの測定値も回転後の世界と元の世界を区別できない——ヨーは自由である。今度は水平軸周りに世界を傾けてみると:方位角は依然として一致するが、重力は加速度計に異なる投影をする——IMUが気づく。ロールとピッチは固定される。

同じ様式の議論により、グローバル並進が自由であること(方位角と加速度は並進不変)、そして加速度計が一般的な運動下でスケールを固定する理由が示される:マップと軌跡を2倍にすると真の加速度も2倍になり、これは加速度計が検出する——ただし加速度が一定である場合を除く。その場合、変化はバイアス/重力推定の中に隠れてしまう。

一貫性とFirst-Estimate Jacobians(FEJ)

時間とともに異なる推定値で測定値を線形化するEKFは、非可観測方向に沿って情報を不正に得てしまうことがある:各ヤコビアンは単独では正しいが、積み重ねると、真の非可観測部分空間より小さい非可観測部分空間を持つ線形化システムが定義される(通常、実際には非可観測なヨーが可観測に見えてしまう)。フィルタは過信状態になる——非一貫である——最も目に見える形では、正当な理由なくヨー共分散が縮小する。

FEJによる対処:各状態のヤコビアンをその最初の推定値で評価し、その線形化点を使い続ける。これにより、積み重ねられたすべてのヤコビアンが一貫した線形化を共有し、正しい4次元の非可観測部分空間が構造的に保存される。これはOpenVINSと現代のMSCKF変種における標準であり、同じ考え方がスライディングウィンドウ最適化器における周辺化事前分布の扱いを支配する(代替的な扱いとして、Basaltの非線形ファクタ復元やDM-VIOの遅延周辺化がある)。

実践上の帰結

• ゲージを明示的に固定する。 最初の姿勢(位置+ヨー)を固定するか事前分布を追加する;そうしなければソルバーは自由方向に沿って迷走し、ヘッセ行列が特異になる。
• 4自由度ループクロージャ。 VIOのポーズグラフにおけるループクロージャ補正はヨー+並進のみを調整すべきである(VINS-Monoのように)——ロール/ピッチを歪めることは、重力によって可観測にされた方向を破壊してしまう。
• 4自由度の軌跡アライメント。 VIOシステムをグラウンドトゥルースに対して評価する際は、視覚のみのオドメトリに適した6自由度や7自由度($Sim(3)$)のアライメントではなく、4自由度(ヨー+並進)のアライメントを用いる。
• 共分散の読み方。 ループクロージャや絶対的な基準(GPS、事前マップ)がない場合、グローバルな$x, y, z$とヨーに沿った不確かさは無限に増大するべきである;縮小するヨー不確かさを報告するフィルタは、それが正確であることを示しているのではなく、非一貫であることを示している。

よくある落とし穴

• ステレオがすべてのスケールの懸念を取り除くと信じること:ステレオはスケールの可観測性を固定するが、グローバル並進とヨーは依然非可観測であり続ける——ループクロージャや絶対的測定値がなければ、それらの方向のドリフトは避けられない。
• ヨードリフトや高速道路でのスケールドリフトをバグとして診断すること:これらはセンサ構成の構造的な性質であり、情報を追加すること(ループ、GPS、ホイールオドメトリ、事前マップ)によってのみ緩和される。
• VIOの結果に完全な6/7自由度の評価アライメントを適用すること——これはヨー誤差を隠し、数値を見栄えよくしてしまう。

SLAMにおける意義

可観測性解析は、そうでなければバグのように見える挙動を説明する:決して止まらないヨードリフト、高速道路走行でのスケールドリフト、長時間の走行後の過信的な共分散。これは初期化(励起が必要)、ループクロージャ(4自由度)、フィルタの一貫性機構(FEJ)の設計を規定する。VIO論文を読む出発点は、「このシステムはどの状態を可観測として扱っているか、そしてどのような運動の下でか」と問うことである。

関連ノート

• MSCKF — VIO可観測性解析のフォローアップ文献を生み出したフィルタ。
• OpenVINS — FEJベースの可観測性制約付き推定を実装。
• スケール可観測性 — スケールに関するステレオの視点。
• スケール曖昧性 — 純粋な単眼の場合(非可観測7自由度)。
• 一貫性 — 可観測性解析が保護する推定器の性質。
• メトリクス — 4自由度アライメントの慣習が評価に現れる場所。