Přesná barometrická altimetrie: algoritmy kompenzace teploty a driftu pro výškové určení

Proč barometrická altimetrie a kde selhává bez kompenzace

Barometrický výškoměr patří mezi nejenergeticky efektivní a rychlé snímače výšky pro drony. Tlak vzduchu klesá se stoupající nadmořskou výškou, proto z měření statického tlaku lze odvodit výšku nad referenční hladinou. Problémem však je, že tlak se mění i časem (počasí) a lokálně (teplotní gradienty, ohřev elektroniky, proudění od vrtulí). Bez inteligentní kompenzace teploty a driftu se barometrická výška může během několika minut rozcházet o desítky metrů. Tento článek nabízí systémový návod, jak realizovat kompenzaci v reálném čase v praxi – od fyziky, přes umístění snímače a filtraci, po fúzi s IMU/GNSS a online odhad zaujatosti (biasu).

Fyzikální základ: z tlaku na výšku

  • Hypsometrická rovnice (ISA, troposféra): při standardním teplotním gradientu L ≈ 0,0065 K/m platí:
    h = (T0/L) · [1 − (p/p0)R·L/g],
    kde R je plynová konstanta pro suchý vzduch a g tíhové zrychlení.
  • Lokální linearizace: v blízkosti pracovního bodu je Δh ≈ −(RT/g) · (Δp/p). Prakticky: při hladině moře ~1 hPa ≈ 8–9 m, s rostoucí výškou citlivost (Pa/m) klesá.
  • Teplota: výška závisí na teplotě vzduchu ve sloupci, nejen na teplotě čipu. Nesprávné teplotní předpoklady vedou k systematické chybě.

Zdroj chyb: z čeho vzniká drift

  • Počasí: barický trend (±2–3 hPa během několika hodin) → desítky metrů chyby bez opětovného referencování (QNH/QFE).
  • Teplota snímače: samoohřev a ohřev od elektroniky mění offset tlaku i jeho citlivost (typicky desítky Pa na 10 °C).
  • Dynamický tlak a proudění: „prop wash“, boční vítr, ventilace trupu → lokální podtlaky/nadtlaky.
  • Vibrace: mikromechanické šumy, akustické vlivy vrtulí → vysokofrekvenční šum.
  • IMU/GNSS chyby při fúzi: pokud se baro „táhne“ za driftující vertikální rychlostí z IMU, vzniká pomalý posun.

Umístění a mechanika: statický tlak bez rušení

  • Statický port: pokud je možné, používejte externí statický otvor/komoru s labyrintem a filtrační membránou; vyhýbejte se přímým proudovým liniím od vrtulí.
  • Termální izolace: snímač oddělte od horkých komponentů (regulátory, procesor) a stíněním snižujte teplotní gradienty.
  • Anti-vibrace: měkké uložení PCB a krátké hadičky/komory snižují akustické buzení.
  • Redundance: dva různé baro snímače na různých pozicích (interní + externí) pomáhají detekovat lokální chyby.

Teplotní kompenzace: od výrobních polynomů po online adaptaci

  • Výrobní koeficienty: moderní snímače mají interní kalibrační konstanty (offset, citlivost). Použijte je, ale počítejte s reziduem.
  • Vlastní model: v teplotní komoře změřte pmer vs. T při referenčním tlaku a fitujte polynom 2.–3. řádu pro offset(T) a scale(T). Uložte koeficienty do FW.
  • Online korekce: během letu sledujte pomalý drift δp(T,t) přes inovační sekvenci EKF (baro – predikce z IMU/GNSS) a adaptujte offset s dlouhou časovou konstantou (např. 100–300 s).
  • Warm-up fáze: prvních 60–120 s po zapnutí je kritických. Aplikujte zvýšené filtrování a do not trust flag pro autopilota až do stabilizace teploty.

Filtrační řetězec: od surového tlaku po „flight-grade“ výšku

  1. Oversampling/decimace: čtěte snímač rychle (100–200 Hz), zprůměrujte na 50–100 Hz, snižujete kvantizační šum.
  2. IIR nízkoprůchodný filtr: α v rozsahu 0,05–0,2 podle dynamiky platformy (prudké manévry vyžadují vyšší pásmo).
  3. Notch/median filtr: potlačení prop-harmonických špiček (např. 80–200 Hz) nebo medián z 3–5 vzorků pro potlačení „spikes“.
  4. Detektor proudění: pokud je přítomen diferenciální tlak nebo zvýšené vibrace IMU, dočasně snižte důvěru v baro měření (zvyšte R v EKF).

Fúze senzorů: EKF/komplementární přístup

  • Krátkodobá stabilita: IMU (vertikální zrychlení integrováno na rychlost/výšku) s silným vysokofrekvenčním pásmem.
  • Střednědobá reference: barometrická výška udržuje pomalé změny (sekundy až minuty) ale je náchylná k barickým trendům.
  • Dlouhodobě: GNSS (geodetická výška) nebo radar/laser altimetr (nad zemí) slouží jako „kotva“ proti barickému driftu.
  • Odhad biasu: rozšířený KF obsahuje stav bbaro (zaujatost). Jeho derivaci svazujte na nulovou průměrnou vertikální rychlost v časových oknech (zero-mean constraint).
  • Zero-velocity updates (ZUPT): při stabilním visení z Vision/IMU (vertikální rychlost ~0) korigujte baro bias tak, aby ∂h/∂t → 0.

QNH, QFE a reference v autonomii dronů

  • QNH: tlak redukovaný na hladinu moře → absolutní nadmořská výška. Vhodné pro konzistentní geo-referenci.
  • QFE: tlak na místě startu → výška nad bodem T/O (h = 0 na startu). Praktické pro bezpečnostní výšky v lokální misi.
  • QNE (1013,25 hPa): standardní reference pro letové hladiny – méně běžná v nízkých UAS operacích.
  • Praxe: při autonomii používejte QFE pro relativní výšku a GNSS/DEM pro absolutní kontrolu nad terénem.

Reálný časový management driftu: praktický algoritmus

  1. Inicializace: 10–20 s průměrování tlaku v klidu, nastavit pref a Tref; pokud jsou dostupné QNH/QFE ze země, použijte je.
  2. Teplotní korekce: aplikovat polynom offset(T) a scale(T) na surové měření.
  3. Filtrace: přefiltrujte přes medián (odstraňovač špiček) → IIR LPF → decimace na 50 Hz.
  4. EKF fúze: stavy: h, vz, bbaro. Měření: baro h, IMU az, GNSS h (nízká frekvence), laser/radar hAGL (je-li k dispozici).
  5. Adaptivní R: zvyšujte měřicí kovarianci baro, pokud RMS vibrací IMU nebo Δp′ překročí práh.
  6. Anchor aktualizace: každých 30–120 s porovnejte trend baro s GNSS/AGL; přiřaďte malé časové konstantě db/dt pro vyrovnání dlouhodobého driftu.
  7. ZUPT/hover: pokud |vz| < prah a držení polohy je aktivní, stahujte bbaro k hodnotě, která zruší vertikální drift.

Šum a stabilita: jak nastavit časové konstanty

  • Allanova analýza: odhadněte bílý šum a nestabilitu biasu snímače. Na jejím základě nastavte LPF a Q/R v EKF.
  • Časová konstanta biasu: typicky 100–300 s (elektrické drony), rychlejší při výrazném teplotním gradientu, pomalejší v stabilní troposféře.
  • Zisk pro GNSS anchor: malý (např. 0,001–0,01 s⁻¹), aby krátkodobé výkyvy GNSS neovládly baro.

Kompenzace při manévrech a vliv dynamického tlaku

  • Detekce režimu: při prudkých změnách plynu nebo náklonu rostou chyby baro. V autopilotu během „aggressive“ flight módu snižte váhu baro.
  • Model prop-wash: pokud znáte RPM/tah, můžete aditivně korigovat baro o funkci f(RPM). Jednodušší je robustní filtrování a vhodné umístění portu.

Fúze s AGL (laser/radar) a DEM

  • AGL senzor: výborný do ~30–50 m nad zemí; nad touto hranicí jeho šum a spotřeba rostou – baro přebírá roli.
  • Terrain following: kombinujte baro (absolutní trend) + AGL (relativní reference) + DEM (digitální model reliéfu) pro bezpečný clearance nad terénem.

Redundance a validace měření

  • Dual-baro voting: pokud je rozdíl > práh (např. 1,5–2,5 hPa), označte chybu a snižte váhu problematického kanálu.
  • Reasonableness checks: odvozená vertikální rychlost z baro by neměla dlouhodobě odporovat IMU/GNSS (testy konzistence v EKF).

Provozní praxe: kalibrace a misijní návyky

  • Před letem: reset QFE/QNH, krátké zahřívání (≥60 s), kontrola stability čtení (σ < prah).
  • Během letu: pokud je dostupný pozemní barograf nebo meteostanice, přenášejte trend (telemetrie) a aktualizujte referenci dlouhým filtrem.
  • Po letu: porovnejte baro „hlanding“ s nulou; zaznamenejte bias drift pro účely adaptace koeficientů.

Bezpečnostní limity a fallbacky

  • Geofence v Z: absolutní max/min výšky vázané na GNSS a AGL, ne pouze baro.
  • RTH profil: návratová trajektorie použijte výšku s „kotvou“ (GNSS/AGL) a konzervativní rezervu nad terénem.
  • Degradované módy: při baro chybě přepněte na GNSS+IMU s oznámenou degradací přesnosti výšky.

Metodika testování a validace

  1. Bench test: stabilní tlak (uzavřená komora), teplotní cyklus 0–50 °C, změřte offset(T) a hysterézu.
  2. Prop-wash test: spuštění motorů na stojanu, hodnocení spektra rušení a optimalizace filtru/notch.
  3. Field test – statika: dlouhý hover (5–10 min) s AGL; sledujte drift baro po aplikaci ZUPT korekcí.
  4. Field test – stoupání/klesání: kalibrujte zpoždění a nadměrnou filtraci (phase lag) vůči referenci (AGL/RTK).
  5. Metoo test: paralelní záznam baro ze dvou dronů, stejný profil letu, porovnání trendů a reakce na frontu.

Implementační tipy pro firmware a autopilota

  • Časové značky: všechna měření časujte na společnou časovou bázi; kompenzujte latenci filtrů (predikcí stavu).
  • Stavový stroj důvěry: flagy warming, valid, degraded, fault; řízení vah v EKF podle stavu.
  • Logování: ukládejte surový tlak, T, filtrovaný tlak, inovaci EKF, odhad biasu, váhy měření; zjednodušuje ladění.
  • Konfigurovatelnost: oddělené parametry pro LPF cut-off, zisk kotvy, prahy vibrací, časové konstanty biasu podle typu platformy (MR/FW/VTOL).

Co očekávat: realistická přesnost po kompenzaci

  • Krátkodobě (sekundy): šum ±0,1–0,3 m při kvalitním snímači a vhodném LPF.
  • Střednědobě (minuty): drift ≤ ±1–2 m při stabilním počasí s aktivním bias trackingem.
  • Dlouhodobě (desítky minut až hodiny): bez kotvy (GNSS/