Diagnostika senzorů v bezpilotních létajících prostředcích

Diagnostika senzorů v UAV: proč je „zdraví dat“ kritické

Bezpečná navigace dronů závisí na přesnosti a konzistenci senzorů: IMU (akcelerometr, gyroskop), magnetometr, barometr, GNSS (GPS/Galileo/GLONASS), vizuální odometrie (kamera), LiDAR nebo radar. I menší závada – od driftu gyroskopu po saturaci barometru – deformuje odhady stavu a může spustit řetězec chyb v řízení. Cílem diagnostiky je závady detekovat, izolovat a rekonfigurovat fúzi tak, aby byla zachována integrita navigace a ovladatelnost stroje.

Typy poruch a symptomy napříč senzory

IMU: bias drift, náhodný šum (RW), saturace při vibracích, osově závislé chyby, teplotní nestabilita. Symptomy: rostoucí divergence orientace, zvýšené inovace v EKF, vysoké spektrum výkonové hustoty (PSD) na frekvencích motorů.
Magnetometr: tvrdé/měkké železo, lokální rušení, saturace os. Symptomy: náhlý skok směru, nekonzistence s odhady slunečního směru či gyro ose yaw.
Barometr: drift s tlakovým frontem, teplotní offset, nárazové změny tlaku při rychlé změně výšky. Symptomy: pomalé „plavání“ výšky, anti-korelace s teplotou, skoky při rotaci vrtulí.
GNSS: multipath efekt, výpadky satelitů, vysoký DOP, skokové přechody RTK fix→float, spoofing/jamming. Symptomy: skoky polohy, prudký nárůst horizontální/vertikální chyby, fluktuace počtu viditelných satelitů.
Vizualizace (VO/VIO): málo textury, oslnění, rolling shutter, degradace kalibrace kamera-IMU. Symptomy: pokles počtu klíčových bodů, vysoká reprojekční chyba, nekonzistentní škálování.
LiDAR/Radar: nízká hustota bodů (mlha/dešť), saturace blízkými odrazy, kalibrační posuny. Symptomy: prudké zředění pointcloudu, nekonzistentní odometrie, skoky nadmořské výšky nad terénem.
Časová synchronizace: drift TSC/PTS, jitter v časových značkách. Symptomy: systematický fázový posun inovací, zdánlivé zpoždění měření v EKF.

Základy FDI: detekce, izolace a identifikace

FDI (Fault Detection and Isolation) využívá rezidua mezi naměřenými a predikovanými hodnotami. Ve stavových filtrech (EKF/UKF/MHE) je přirozeným zdrojem diagnózy inovace (měřicí odchylka) a její kovariance.

Statistické testy: χ² test inovací, Mahalanobisova vzdálenost s prahy přizpůsobenými rychlosti letu a manévrování.
Paritní rovnice: nezávislé lineární kombinace měření, které by ideálně měly být nulové (detekce odchylek bez explicitního modelu).
Banka pozorovatelů: více filtrů specializovaných na hypotézy (např. GNSS OK vs. GNSS degradovaný vs. GNSS vypnutý), hlasování podle pravděpodobnosti.
Spektrální ukazatele: PSD/FFT pro detekci vibrací způsobujících aliasing IMU; sledování pásem kolem harmonických motorů.
Integrity metriky: RAIM-like testy pro GNSS (redundantní satelity → izolace satelitů s nejvyšším reziduem).

Diagnostické metriky a prahy (praktické hodnoty)

IMU Allanova variance: online odhad biasu/Random Walk. Pokud bias drift > 0,5 °/s/h (gyro) nebo ARW > 0,2 °/√h, aktivujte zvýšení matice R (měřicí šum) pro danou osu.
Vibrace: RMS akcelerací > 0,5 g v pásmu 80–200 Hz → hrozí saturace; spusťte notch filtry a snižte váhu IMU.
GNSS: HDOP > 2,5 nebo < 10 satelitů → přepněte do režimu „GNSS degradovaný“; při ztrátě RTK fixu > 3 s → plynulý přechod na vážení VO/VIO/INS.
VO/VIO: průměrná reprojekční chyba > 1,5 px nebo méně než 80 aktivních tracků → snižte váhu vizuálního měření; pokud < 30 tracků → vypněte VO vstup.
Barometr: drift > 0,5 m/min bez korelace s teplotou → přeslaďte vůči GNSS/laserovému altimetru; při nárazech aktivujte mediánový filtr nebo klouzavé okno.

Diagnostika v EKF/UKF: inovace, gating a konzistence

Každé měření prochází gatingem. Pokud Mahalanobisova vzdálenost překročí práh (např. 95. percentil), měření se do aktualizace nezahrne. Dlouhodobé překračování prahů vede k trvalému snížení váhy (inflace R) nebo vyloučení senzoru. Konzistenci filtru sledujte přes NIS (Normalized Innovation Squared) a NEES (Normalized Estimation Error Squared) v čase – systematické odchylky označují špatnou kalibraci nebo nastavení prahů.

Re-konfigurace fúze: strategie a pořadí kroků

Měkké převažování (soft re-weighting): adaptivně upravujte měřicí kovarianci R podle kvality (např. funkce R = f(HDOP, počet tracků, RMS vibrací).
Exkluze senzoru: dočasně vyřaďte senzor po N neúspěšných gatingech; ponechte watchdog pro jeho opětovnou reintegraci po stabilizaci.
Přepínání modelů (IMM/MMAE): paralelně běžte více modelů (GNSS+INS, VIO+INS, INS-only) a směrujte pravděpodobnosti; řízení využívá stav z nejpravděpodobnějšího modelu.
Správa kovariancí: při ztrátě klíčového senzoru (GNSS) proveďte reset kovariancí vybraných stavů (např. horizontální pozice), jinak hrozí numerická degenerace.
Náhradní módy: INS-only (krátkodobě), VIO-only (interiéry), altimetrie z LiDARu. Pro každý mód definujte limity rychlosti a vzdálenosti.

Speciální případy: GPS-chudé, magneticky rušné, vizuálně chudé prostředí

Urban canyon: HDOP prudce kolísá; aktivujte VO/VIO a omezte horizontální rychlost. GNSS používejte pouze jako „slabý prior“.
Magnetické rušení: heading z magnetometru silně omezujte; yaw odvoďte z gyra a vizuálních orientačních bodů.
Slabě texturované scény: pokud VO degradují (málo funkcí), preferujte LiDAR odometrii; snižte výšku a rychlost pro bezpečnost.

Kalibrace a její online dohled

Kalibrační parametry (měřítko, nesouosost, časová zpoždění) musí mít hlídací mechanismy:

Sledujte drift odhadnutých extrinsic parametrů (kamera↔IMU, LiDAR↔IMU); pokud překročí práh (např. 0,5°/5 mm), požadujte překalibraci.
Online časová kalibrace: odhadujte Δt mezi senzorem a IMU pomocí korelace signálů; pokud Δt > 5 ms, zaveďte kompenzaci nebo měření vypněte.
Teplotní kompenzace: použijte teplotní modely biasů IMU; bez kompenzace roste NIS při dynamickém pohybu.

Diagnostika synchronizace: když je čas nepřítel

Asynchronní timestampy způsobují, že i správná měření vypadají „špatně“. Sledujte latencní histogramy a drift PTP/Chrony. V EKF zaveďte delay state nebo použijte out-of-sequence update s re-propagací. Pokud jitter přesáhne 10–15 ms při dynamice, spusťte „low-dynamics“ bezpečnostní režim.

Fúze s integritním pojištěním: RAIM a integrity budget

Koncept integrity budget rozděluje přípustnou chybovost mezi zdroje (GNSS, VO, barometr). RAIM-like testy vypočítají parciální rezidua pro subset měření; měření s nejvyšším reziduem je dočasně vyloučeno. Tato metodika funguje i pro VO (subset tracků) a LiDAR (subset korelací scan matchingu).

Algoritmické vzory pro implementaci

Innovation-based Adaptive Estimation (IAE): přímo upravuje R podle statistiky inovací; jednoduché a robustní.
IMM: více modelů s různou dostupností senzorů; vhodné pro přechody GNSS↔VO↔INS.
MHE (Moving Horizon Estimation): lépe zvládá saturace a omezení; vyšší výpočetní náročnost, vhodné pro edge GPU/CPU.
Robustní náklady: Huber/Tukey při VO/LiDAR matchingu snižují vliv odlehlých hodnot dříve, než se dostanou do EKF.

Testování: SIL/HIL, injekce chyb a ověření prahů

SIL: simulujte v plné dynamice větru, výpadky GNSS, nízkou texturu; validujte NIS/NEES a reakci na prahy.
HIL: reálná IMU a kamery přes senzorové rozhraní; ověřte latence a synchronizaci.
Fault injection: skok biasu gyra, lineární drift barometru, whiteout kamery, multipath GNSS; měřte TTD (time-to-detect) a TTR (time-to-recover).

KPI diagnostiky a fúze

TTD/TTR: čas do detekce/obnovy definovaných poruch.
Integrity Risk: pravděpodobnost překročení chybového limitu bez detekce.
Dostupnost: podíl letu s plnohodnotnou fúzí versus fallback módy.
Konzistence: průměr NIS v očekávaném pásmu (např. 95 % kvantil).
False Alarm Rate: počet falešných vyloučení senzoru za hodinu letu.

Provozní „playbooky“: rychlé rozhodování za letu

GNSS degradace: snižte horizontální rychlost pod 5 m/s, přepněte na prioritu VO/VIO, aktivujte výškový limit; pokud se HDOP nezlepší do 10 s, proveďte návrat (RTH) podle inerciální trajektorie a posledního spolehlivého fixu.
IMU vibrace: zapněte notch/low-pass filtry, snížte váhu IMU, přepněte do režimu pouze orientace (attitude-only) s udržením výšky z barometru/laseru.
Selhání VO: zvyšte osvětlení (pokud možné), snižte rychlost a výšku, aktivujte LiDAR odometrii; pokud počet tracků přes 5 s klesne pod 20, vypněte VO měření.

Bezpečnostní limity a degradované módy

Pro každý fallback mód definujte „letový obal“: maximální rychlost, náklon, stoupavost, vzdálenost od startu. Například INS-only: max 2 m/s, max 10° náklon/pitch, dolet < 150 m; VO-only: max 5 m/s, výška 3–30 m nad texturou.

Telemetrie, logging a post-mortem analýza

Logujte inovace, NIS/NEES, prahy gatingu, váhy měření, latence timestampů, HDOP, počet VO tracků, hustotu bodů LiDARu.
Ukládejte „snapshot“ konfigurace (R/Q, modely IMM) při každé změně; umožní reprodukovatelné analýzy.
Vizualizujte časové průběhy s událostmi (fault flags) a zásahy re-konfigurace.

Architektura systému: bezpečnostní domény a redundance

Oddělte kritické letové smyčky (orientace/radiová stabilizace) od misijní fúze. Kritické smyčky by měly fungovat na minimálním setu IMU + altimetrie; vyšší vrstvy mohou být restartovány či rekonfigurovány bez ztráty ovladatelnosti. Pro důležité mise zvažte dvojitou IMU (různí výrobci) a nezávislé GNSS moduly s diverzními anténami.