Pitot-Aided Attitude and Air Velocity Estimation with Almost Global Asymptotic Stability Guarantees

Technische Samenvatting: Pitot-ondersteunde houdings- en luchtsnelheidschatting met garanties voor bijna globale asymptotische stabiliteit

Probleemstelling
Betrouwbare houdingschatting voor fixed-wing UAV's is uitdagend in omgevingen zonder GNSS (Global Navigation Satellite System) of in zeer dynamische omgevingen. Standaardmethoden die vertrouwen op Inertial Measurement Units (IMU's) leiden vaak de richting van de zwaartekracht af uit versnellingsmeters, een benadering die faalt tijdens voortdurende voorwaartse vlucht of agressieve manoeuvres waarbij niet-gravitatieversnellingen significant zijn. Hoewel Velocity-Aided Attitude (VAA) chatting een oplossing biedt, gaan veel bestaande methoden uit van volledige snelheidsmetingen (inertieel of lichaamsgefixeerd), wat beperkend is voor kleine UAV's. Fixed-wing UAV's meten de luchtsnelheid doorgaans via een eenassige Pitotbuis die is uitgelijnd met de longitudinale lichaamsas. Eerdere pogingen om Pitot- en IMU-gegevens te combineren, vertrouwden ofwel op slecht bekende aerodynamische parameters of resulteerden in observers met slechts lokale convergentiegaranties. Bovendien lijden eenassige Pitot-metingen aan axiale symmetrie, waardoor de gierhoek (yaw) onwaarneembaar blijft zonder een inertieel koersreferentiepunt, wat de schatting beperkt tot een verminderde houding (tilt).

Methodologie
De auteurs stellen een twee-traps cascade-observer architectuur voor die de aerodynamisch ondersteunde tilt-chatting scheidt van de volledige houdingschatting, gebruikmakend van IMU-gegevens, ten minste één Pitot-meting en magnetometergegevens.

1. Fase 1: Tilt- en luchtsnelheidschatting (Riccati Observer)

   • Het systeem definieert de "tilt" als de richting van de zwaartekracht uitgedrukt in het lichaamsgefixeerde frame ($z = R^\top e_3$).
   • Door de luchtsnelheidsdynamica en de tilt-dynamica te combineren, formuleren de auteurs een Linear Time-Varying (LTV) systeem waarbij de uitgebreide toestand (augmented state) de lichaamsgefixeerde luchtsnelheidsvector ($V_a$) en de tilt-vector ($z$) omvat.
   • Een continu-tijd Riccati/Kalman-type observer wordt ontworpen om deze uitgebreide toestand te schatten. De observer gebruikt de Pitot-meting (scalair projectie van $V_a$) als output.
   • De stabiliteit van deze fase rust op de Uniform Observability (UO) van het LTV-systeem. De auteurs bewijzen dat onder milde excitatievoorwaarden (specifiek, persistente excitatie van de richting van de Pitot-sonde ten opzichte van de voertuigoriëntatie), de schattingsfoutdynamica Globally Uniformly Exponentially Stable (GES) is.
   • Om de observatiebeperkingen van een eenassige Pitotbuis aan te pakken (die complexe gier- en pitchbewegingen vereist voor volledige excitatie), introduceren de auteurs een zero-sideslip pseudo-meting ($V_{a,2} = 0$). Dit is geldig bij gecoördineerde vluchten en vergroot effectief de meetvector, waardoor de eisen voor excitatie worden versoepeld tot enkel aanhoudende gierbeweging.

2. Fase 2: Volledige houdingschatting (Nietlineaire Observer op SO(3))

   • De geschatte tilt-vector ($\hat{z}$) uit Fase 1 wordt gefuseerd met magnetometergegevens ($m_B$) in een nietlineaire observer gedefinieerd op de Special Orthogonal group $SO(3)$.
   • Deze observer, gebaseerd op geometrische filterprincipes, lost de gierambiguïteit op die inherent is aan Pitot-gebaseerde sensing.
   • De correctieterm maakt gebruik van de geschatte tilt en de bekende inertiële magnetische veldvector om de houdingschatting aan te sturen.

Belangrijkste Bijdragen

• Cascade Architectuur: Het papier introduceert een verenigd framework dat de luchtsnelheid/tilt-chatting ontkoppelt van de volledige houdingschatting, wat een rigoureuze stabiliteitsanalyse van het onderling verbonden systeem mogelijk maakt.
• AGAS-garanties: In tegen tegenstelling tot eerdere Pitot-gebaseerde benaderingen die slechts lokale convergentieresultaten boden, vestigt dit werk Almost Global Asymptotic Stability (AGAS) voor de gehele cascade-structuur. Dit wordt bereikt door de UO-voorwaarde in de eerste fase te voldoen en de topologische eigenschappen van de $SO(3)$-observer in de tweede fase te benutten.
• Zero-Sideslip Augmentatie: De auteurs demonstreren dat het opnemen van de zero-sideslip-restrictie als een pseudo-meting de observatie-eigenschappen van het systeem aanzienlijk verbetert, waardoor de afhankelijkheid van agressieve manoeuvres voor toestandconvergentie wordt verminderd.
• Rigoureuze Analyse: Het artikel biedt een gedetailleerd bewijs van uniforme observabiliteit voor het uitgebreide LTV-systeem en stelt de stabiliteit van de evenwichtspunten vast, waarbij wordt aangetoond dat de verzameling instabiele evenwichten een maat nul heeft.

Experimentele Resultaten
De voorgestelde observer werd gevalideerd met echte vluchtgegevens van een MakeFlyEasy Fighter VTOL UAV uitgerust met een IMU, een naar voren gerichte Pitotbuis en een magnetometer. De experimenten werden uitgevoerd in een winderige omgeving om robuustheid te testen. Twee configuraties werden vergeleken:

1. Configuratie 1: Maakte gebruik van de zero-sideslip pseudo-meting.
2. Configuratie 2: Vertrouwde uitsluitend op de eenassige Pitot-meting.

Bevindingen:

• Configuratie 1 vertoonde superieure prestaties, waarbij de fouten in de luchtsnelheid convergeren naar ongeveer 3 m/s tijdens significante pitch-variaties. De conditiegetal van de observability Gramiaan bleef laag, wat wijst op robuuste observabiliteit.
• Configuratie 2 vertoonde grote root-mean-square fouten (ongeveer 12 m/s lateraal, 9 m/s verticaal) en slechte numerieke conditionering, wat de loss van observabiliteit bevestigt wanneer de excitatie beperkt is.
• In segmenten van gecoördineerde vlucht bleven alle schattingsfouten in Configuratie 1 begrensd en convergeerden ze naar nul, wat de theoretische AGAS-claims valideert. De resultaten bevestigen dat de pseudo-meting fungeert als een effectief mechanisme om observabiliteit te herstellen onder zwakke excitatie.

Betekenis en Claims
Het artikel claimt bestaande Pitot-ondersteunde schattingsframeworks uit te breiden voorbij lokale convergentieresultaten. Door een verenigd framework te bieden voor volledige luchtsnelheid en houdingschatting met rigoureuze stabiliteitsgaranties, adresseert dit werk een kritiek gat in de UAV-navigatie voor GNSS-denied omgevingen. De auteurs stellen dat hun aanpak de beperkingen van een eenassige Pitot-sensing effectief overwint zonder dat volledige snelheidsmetingen of complexe aerodynamische modellen nodig zijn. Hoewel de theoretische analyse uitgaat van begrensde, langzaam variërende wind en niet expliciet sensor-biases schat, demonstreert de experimentele validatie in een winderige omgeving de praktische robuustheid van de observer. De auteurs identificeren de gezamenlijke schatting van windcomponenten en inertiële sensor-biases als een natuurlijke richting voor toekomstig werk.