[論文レビュー] Pitot-Aided Attitude and Air Velocity Estimation with Almost Global Asymptotic Stability Guarantees

Méloné Nyoba Tchonkeu, Soulaimane Berkane+1 more|arXiv (Cornell University)|Feb 9, 2026

Aerospace and Aviation Technology被引用数 0

ひとこと要約

この論文は、IMUとPitot測定を統合して空気速度と傾斜を推定し、次に磁力計データを用いてSO(3)上でほぼ全局適合性を持つ全姿勢を推定する二段階のカスケードオブザーバを提案し、実飛行データで検証する。

ABSTRACT

This paper investigates the problem of attitude and air velocity estimation for fixed-wing unmanned aerial vehicles (UAVs) using IMU measurements and at least one Pitot tube measurement, with almost global asymptotic stability (AGAS) guarantees. A cascade observer architecture is developed, in which a Riccati/Kalman-type filter estimates the body-fixed frame air velocity and the vehicle's tilt using IMU data as inputs and Pitot measurements as outputs. Under mild excitation conditions, the resulting air velocity and tilt estimation error dynamics are shown to be uniformly observable. The estimated tilt is then combined with magnetometer measurements in a nonlinear observer on SO(3) to recover the full attitude. Rigorous analysis establishes AGAS of the overall cascade structure under the uniform observability (UO) condition. The effectiveness of the proposed approach is demonstrated through validation on real flight data.

研究の動機と目的

• GNSSが使えない環境や加速度計だけでは不十分なダイナミック環境における信頼性の高い姿勢推定を促進する。
• 穏やかな励起条件の下でIMUとPitot測定から空気速度と傾斜を推定するカスケードオブザーバを開発する。
• 推定された傾斜と磁力計データを融合してSO(3)上の全姿勢をAGAS保証付きで復元する。
• 一様可観測性と全球収束性を確立する厳密な可観測性解析を提供する。
• 実飛行データで手法を実証し、実用条件下での性能を検証する。

提案手法

• IMU入力とPitot出力の下で身体固定空気速度V_aと傾斜zを共同推定する縮約階 Riccati/カルマン型オブザーバを定式化する。
• Pitot測定をy_p = B^T V_aとしてモデル化し、拡張状態x = [V_a^T, z^T]^Tの線形時変システムを導出する。
• 方向Sigma(t) = φ(t)Bに対する持続励起条件の下で一様可観測性を証明し、推定誤差の全局指数安定性を保証する。
• ジャイロデータと磁力計補正を用いた非線形SO(3)姿勢オブザーバを適用し全姿勢を復元、一様可観測性の下でAGASを達成する。
• IMUのサンプリングと多レート sensing に対応する離散時間実装を提供し、Rodriguesの公式による増分回転を用いる。

Figure 3 : Onboard Air-velocity Components.

実験結果

リサーチクエスチョン

• RQ1 Pitotを用いたセンシングはどの励起条件下で空気速度と傾斜の全球可観測性をもたらすか。
• RQ2 Riccatiベースの空気速度/傾斜推定とSO(3)姿勢オブザーバを組み合わせたカスケードオブザーバは全姿勢推定においてAGASを達成できるか。
• RQ3 ゼロ横滑り疑似測定の組込みは可観測性と推定精度を実用飛行で改善するか。
• RQ4 実飛行データと現実的なセンサ配置（単Pitot対複数Pitot、磁力計有無）で提案手法はどう機能するか。

主な発見

• Ricattiオブザーバは持続励起条件の下で空気速度と傾斜推定誤差の一様可観測性と全局指数収束を達成する。
• 二段階のカスケード推定器はSO(3)上で全姿勢推定を可能にし、ほぼ全局漸近安定性の保証を提供する。
• ゼロ横滑り疑似測定は実用的な協調飛行における可観測性を強化し推定誤差を減少させる。
• 実飛行データでの実験結果は空気速度と姿勢推定の収束を示し、励起が可観測性に及ぼす影響を例示する。
• 本手法は風の仮定に対して頑健であり、Pitot、IMU、磁力計データを用いた固定翼UAV設定でアーキテクチャを検証する。

Figure 4 : Comparison between measurement of $V_{a,1}$ (Red) and $\bar{V}_{a,1}$ (Blue) in the real flight data set.