Kalibrace IMU senzorů: Postupy pro rychlý odhad biasů a zlepšení přesnosti v terénu

Proč kalibrace IMU v terénu rozhoduje o navigační přesnosti

Inerciální měřicí jednotka (IMU) je základem autonomní navigace dronu. I dobře nakalibrovaná IMU v dílně se v terénu v důsledku teploty, vibrací a montážních tolerancí chová odlišně. Rychlá kalibrace přímo „na místě“ minimalizuje drift orientace, chyby odhadů rychlosti a zlepšuje fúzi s GNSS či vizuální odometrií. Cílem tohoto článku je nabídnout systematické, časově úsporné postupy kalibrace a praktický rámec pro odhad biasů gyroskopů a akcelerometrů v polních podmínkách.

Model senzorů: co přesně kalibrujeme

Pro 6D IMU (3× gyro, 3× akcelerometr) uvažujeme lineární model měření: měření = skutečná hodnota × (1 + scale factor) + bias + šum + křížové vazby. V praxi v terénu se zaměřujeme především na:

• Gyro bias (offset, deg/s): způsobuje drift yaw/pitch/roll při integraci úhlových rychlostí.
• Accel bias (mg): posouvá vektory zrychlení a tím i odhad náklonu vůči gravitaci.
• Teplotní závislost biasů (°C): posun offsetu při zahřívání elektroniky a mechaniky.
• Scale factor & misalignment: sekundární význam v terénu, ale důležité při přesné mapě nebo dlouhých tratích.

Biase často modelujeme jako náhodnou procházku (random walk) s pomalou dynamikou, aby je mohl filtr za letu adaptivně doladit.

Rychlý přehled postupů: pokud máte jen 5, 10 nebo 20 minut

Předpoklady a příprava: aby čísla dávala smysl

• Stabilní platforma: pevná, rovná plocha bez dotyků operátora; vypněte autolevel v gimblech připevněných k IMU.
• Teplota: po zapnutí nechte elektroniku prohřát 1–3 min; v zimě déle. Logujte teplotu IMU, pokud to jednotka podporuje.
• Jednotky a měřítko: ověřte, zda logujete v rad/s nebo deg/s a zda jsou zrychlení v m/s² nebo g.
• Čistá data: logujte surové hodnoty (raw) vedle filtrovaných; fúzované kvaterniony nestačí pro kalibraci.

Postup A – „Šest poloh“ pro akcelerometry v terénu

1. Položte IMU tak, aby osa +Z směřovala nahoru (normála k zemi). Logujte 20–30 s.
2. Otočte na −Z (nahoru nohama), poté +X, −X, +Y, −Y; každá poloha 20–30 s.
3. V každé poloze vypočítejte průměr vektoru a porovnejte s očekávaným (±g na dané ose, ~0 na ostatních).

Z rozdílů proti očekávání odhadnete bias na každé ose (posun) a hrubě také scale factor (pokud naměřené |a| ≠ g). Jednoduchá lineární regrese mezi očekávaným a naměřeným po všech pózách poskytne 3× (scale, bias). Pokud je to možné, spočítejte i 3×3 matici křížových vazeb (misalignment), ale v terénu často stačí předpoklad diagonální matice a korekce biasů.

Postup B – Statická identifikace gyro biasů

1. Po „šesti polohách“ nechte platformu 60–120 s zcela nehybnou.
2. Průměrujte měření ω_x, ω_y, ω_z. Výsledek je odhad b_g (bias) pro každou osu.
3. Pokud máte teplotu, uložte dvojici (T, b_g) pro další aproximaci lineární teplotní korekce b_g(T).

Očekávané pořadí velikosti: kvalitní MEMS gyroskopy ~0,005–0,05 deg/s, levné moduly 0,1–1 deg/s. Pokud jste výše, zkontrolujte vibrace, proudění vzduchu od vrtulí a elektromagnetický šum.

Postup C – Krátká „dynamika na zemi“

Po statice proveďte jemné rotace a mikronáklony (~5–15°) ve dvou-třech osách a plynulé yaw sweepy ±90°. Cílem je:

• Validovat, zda biasy z postupů A/B fungují i při malém pohybu.
• Odhadnout šum a vibrace v reálném prostředí (kola auta, generátor, vítr).
• Nastavit filtry (cut-off anti-vibrace, notch filtry pro vrtule).

Odhad biasů v letu: ZUPT a „otevřená smyčka“

Pokud vzlétnete bez ideální statiky, lze bias doladit během letu pomocí momentů s (téměř) nulovou rychlostí nebo známou kinematikou:

• ZUPT (Zero-Velocity Update): krátké „visy“ bez driftu větrem – nastavte práh rychlosti/úhlové rychlosti a aktualizujte odhad biasu, pokud je platforma kvazi stacionární.
• Známé manévry: jemné sinusové kývání v roll/pitch s malou amplitudou umožní oddělit bias od skutečné dynamiky.
• GNSS/VO aiding: pokud máte spolehlivou rychlost/pozici, použijte ji jako měření pro korekci driftu a tím nepřímo biasu.

Rozšířený stav ve filtru: nechte EKF „učit se“

Rozšířený Kalmanův filtr (EKF) doplňte o stavové proměnné biasů b_g, b_a s mírnou náhodnou procházkou. Nastavení kovariančních parametrů (procesní šum pro biasy) určuje, jak rychle se filtr přizpůsobí změnám. Praktické tipy:

• Rychlejší učení na začátku (vyšší procesní šum), po 1–2 minutách stáhněte na konzervativní hodnotu.
• Teplotně podmíněné Q: při rychlé změně T povolte rychlejší učení biasu.
• Brány (gating) měření z GNSS/VO, aby se zabránilo falešným korekcím při zhoršeném signálu.

Teplotní kalibrace „lehkou váhou“

Ideálně se provádí laboratorní cyklus, ale v terénu pomůže jednoduchý lineární model biasu vs. teplota:

1. Po zapnutí logujte statiku při T₁ (studená IMU) a po 5–10 minutách opakujte statiku při T₂ (zahřátá IMU).
2. Pro každou osu spočítejte sklon k = (b(T₂) − b(T₁)) / (T₂ − T₁).
3. Během mise aplikujte korekci b(T) ≈ b(T_ref) + k (T − T_ref).

I hrubá lineární korekce výrazně stabilizuje yaw drift při větších teplotních rozdílech (ráno vs. poledne, léto vs. zima).

Misalignment: když IMU není přesně v ose dronu

Pokud IMU není přesně zarovnaná s tělovými osami (roll/pitch/yaw offset), projeví se to systematickou chybou orientace. V terénu ji můžete odhadnout:

• Statika ±Z: určete vektor gravitace a porovnejte s očekávanou tělovou Z osou.
• Kontrolovaný yaw sweep na rovném povrchu: pokud se mění roll/pitch při čisté yaw rotaci, máte křížové vazby.
• Kalibrační matice 3×3 pro IMU→body transformaci, kterou následně aplikujete při zpracování měření.

Vibrace a filtrační strategie

Vibrace od vrtulí a rámu „přetěžují“ IMU a saturují integraci. Rychlá diagnostika:

• Statika s běžícími vrtulemi (bez vzletu): porovnejte varianci akcelerometrů a gyroskopů s vypnutými vrtulemi.
• Notch filtry na dominantních frekvencích (obvykle násobky otáček vrtulí).
• Mechanika: měkké silentbloky specifické pružnosti, vyvážení vrtulí, vzdálení IMU od motorů/regulátorů.

Kontrolní seznam rychlé kalibrace před letem

• IMU prohřát 1–3 min; zkontrolovat stav napájení a teplotu.
• Statika 60–120 s pro gyro bias; uložit.
• „Šest poloh“ pro akcelerometry (pokud je čas alespoň 10 min).
• Krátké yaw sweepy a mikronáklony; validace šumu a vibrací.
• Nastavit/ověřit teplotní korekci biasů (pokud podporováno).
• Synchronizace časové základny logů (IMU, GNSS, kamery).

Rámec kvality: jak poznáte, že kalibrace „sedla“

• Variance statiky gyroskopů < 0,005–0,05 deg²/s² (dle třídy IMU).
• Norma akcelerace při statice 0,98–1,02 g (kompenzované biasy).
• Drift yaw při 2-minutovém visu < 1–3° (s GNSS/VO aidingem ještě méně).
• Konzistentní teplotní křivka biasů po opakovaných startech.

Odhad nejistoty: aby EKF věřil správnému množství

Kromě samotných korekcí je klíčové nastavit R (měřicí šum) a Q (procesní šum) v souladu s pozorovanými variancemi. Tipy:

• R pro gyro určete z variance statiky (deg/s)²; totéž pro accel (m/s²)².
• Q pro biasy nastavte tak, aby filtr dokázal za 10–60 s absorbovat rozumnou změnu způsobenou teplotou.
• Ověřte NEES/NIS konzistenci, pokud máte nástroje – předejdete „příliš sebevědomým“ odhadům.

Praktické zlepšováky z terénu

• Značky poloh: na obalu dronu vyznačte šipky os, aby kolmé polohy ±X/±Y/±Z byly jednoznačné.
• „Rychlá kostka“: malé pěnové/3D tištěné hranoly 90°/45° pro opakovatelné polohy IMU na rovném podkladu.
• Logbook: uchovejte 2–3 poslední sady biasů s teplotou a výsledným driftem; pomáhá rychle odhalit degradaci senzoru.
• Bezpečnostní rutina: nikdy nemanipulujte s dronem při statice; mikropohyby kazí odhady.

Časté chyby a jejich diagnostika

• Bias z odečtení gravitace: při nesprávné konvenci os se „g“ míchá do odhadu biasu akcelerometru – ověřte znaménka a orientaci.
• Přehnané filtrování: příliš nízký cut-off způsobí fázový posun a chybnou fúzi s GNSS/VO.
• Teplotní šoky: spouštíte let bez předehřátí – bias se mění během startu a EKF nestíhá.
• Nesprávné jednotky: deg/s vs. rad/s v jedné z větví zpracování = rychlá cesta k saturaci filtru.

Rozšíření na 9D IMU: magnetometr v terénu

Pokud používáte magnetometr, v terénu proveďte alespoň figure-8 manévr a krátkou hard/soft-iron kalibraci mimo kovové objekty a kabely vysokého proudu. Magnetometr významně pomáhá stabilizovat yaw při slabém GNSS, ale jen pokud je čistý a správně kalibrovaný.

Minimální datový prot