Pitot-Aided Attitude and Air Velocity Estimation with Almost Global Asymptotic Stability Guarantees
Melone Nyoba Tchonkeu, Soulaimane Berkane, Tarek Hamel
TL;DR
This work addresses the problem of estimating the attitude $R \in SO(3)$ and the body-frame air velocity $V_a \in \mathbb{R}^3$ for fixed-wing UAVs using IMU data, Pitot measurements, and magnetometer readings. It introduces a two-stage cascade observer: first, a Riccati-type filter on a linear time-varying model jointly estimates $V_a$ and the gravity-direction tilt $z=R^\top e_3$ under a uniform observability (and persistent excitation) condition, then an $SO(3)$-based nonlinear observer fuses the tilt with magnetometer information to recover the full attitude with AGAS guarantees. Theoretical results show global exponential convergence of the reduced-state errors and almost global asymptotic stability for the complete attitude estimator, while experiments on a wind-affected UAV validate accurate air velocity and full attitude estimation and demonstrate the observability gains from a zero-sideslip constraint. The approach provides a rigorous Pitot-aided estimation framework suitable for GNSS-denied or highly dynamic flight regimes, with practical implications for robust UAV navigation and control.
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.
