Proč je mapování magnetického rušení kritické pro heading UAV
Bezpečná a přesná navigace UAV závisí na spolehlivém odhadu směru (headingu). Ten se často opírá o magnetometr (kompas), který doplňuje gyroskop a GNSS/INS fúze. Magnetické rušení – přirozené i umělé – může způsobit odchylky od desítek po stovky stupňů, což vede k driftu, špatné orientaci při startu/návratu nebo spuštění failsafe režimů. Mapování magnetického pole v prostředí, v trupu dronu i v jeho okolí umožňuje prediktivní zmírnění chyb, lepší plánování misí a robustnější fúzi senzorů.
Zdroj magnetického rušení: hard-iron, soft-iron a dynamické jevy
- Hard-iron efekty: Permanentně zmagnetizované části (šrouby, motory, magnety v gimbalech) přidávají konstantní vektor k poli. Projevují se jako posun elipsy měření od středu.
- Soft-iron efekty: Feromagnetické materiály bez permanentní magnetizace deformují a anizotropně zesilují pole. Projevují se eliptičností a rotací měřicí elipsy.
- Elektromagnetické zdroje: Proud v kabelech, spínání ESC, vysokoproudové kabely baterií, invertory, solární regulátory.
- Okolní infrastruktura: Vysokonapěťová vedení, trafostanice, kolejnice, výtahové motory, automobily, ocelové konstrukce, armovaný beton.
- Geomagnetické jevy: Lokální anomálie hornin, magnetické bouře, svahované gradienty deklinace.
- Dynamické vlivy: Zahřívání motorů, změna proudu při akceleraci, pohyb serv, přehazování kabelů při manévrech.
Fyzika a metrika: co přesně měříme
Magnetometr měří vektor magnetické indukce 𝐁 v osách senzoru. Pro navigaci se porovnává s modelem Země (deklinace D, inklinace I, intenzita |B|). Heading je odvozen z horizontální projekce vektoru po odrollování a odpitchování (kompenzace postavení z gyroskopu/akcelerometru). Základní metriky pro kvalitu jsou:
- Norma vektoru |B|: odchylka od očekávané intenzity (např. 45–55 µT) signalizuje rušení.
- Skalární součin s referencí: úhly mezi měřeným a referenčním polem.
- Rezidua po kalibraci: zbytkové chyby po hard/soft-iron kompenzaci.
- Heading error (HE): rozdíl mezi magnetickým a referenčním headingem (GNSS-course při konstantní rychlosti > 3 m/s, optická reference).
Architektura mapování: tři vrstvy
- Mapa „on-frame“ (interní): magnetické pole vs. poloha senzoru v trupu, otáčky motorů, proudové zatížení, poloha baterie a kabelů.
- Mapa „on-site“ (místní): raster pole nad plánovaným letištěm/trajektorií ve výškách 0–30 m AGL kvůli infrastruktuře; identifikace „no-compass“ zón.
- Mapa „regional“ (globální): deklinace a její gradienty z geomagnetického modelu (WMM/IGRF) a známé anomálie.
Postup kalibrace hard/soft-iron: robustní 3D fitování
- Sběr dat: rotace ve všech osách („racek“/„8“), ideálně 500–2000 vzorků v různých postaveních a proudech. Sbírejte B, teplotu, RPM, proud, napětí.
- Model: Elipsoidové fitování (M, b), kde M je 3×3 matice (soft-iron) a b je posun (hard-iron). Normalizujte na jednotkovou kouli.
- Validace: Zkontrolujte rezidua, normu |B| a stabilitu parametrů při různých proudech (ESC vypnuto/zapnuto).
- Online adaptace: Udržujte pomalý adaptační filtr pro korekci teplotního driftu a dlouhodobých změn montáže.
Mapování „on-frame“: kde a jak umístit magnetometr
- Vzdálenost od zdrojů: 10–20 cm od vysokoproudových svazků, mimo uzly ESC; preferujte mast-mount (na stožáru) u větších UAV.
- Twisted pairs a hvězdicové uzemnění: minimalizujte smyčky; orientujte kabely tak, aby vektor proudů neprocházel blízko senzoru.
- Diferenciální mapování: zaznamenejte |B| při různých RPM (0 %, 25 %, 50 %, 100 %) a proudech; vytvořte charakteristiku „B vs. I“.
- Fyzická orientace: přesně dokumentujte montážní offsety pro správnou transformaci do NED rámce.
Mapování „on-site“: předletový magnetický průzkum
- Ground scan: ruční magnetometr (nebo UAV v manuálním režimu ve výšce 1–2 m) v rastru 2×2 m; vzorkování 10–20 Hz.
- Identifikace hotspotů: místa s |B| > ±15 % oproti regionálnímu průměru nebo s prudkým gradientem (> 5 µT/m).
- Výškový profil: krátké stoupání do 10–30 m AGL nad podezřelými body; často rušení rychle klesá s výškou.
- Maska pro plánovač misí: vyznačte no-compass zóny, kde autopilot nesmí spoléhat na magnetometr (přepnutí na gyroskopickou integraci + GNSS yaw).
Referenční modely Země: deklinace, inklinace a aktualizace
Heading musí být korigován o magnetickou deklinaci (úhel mezi geografickým a magnetickým severem). Používejte aktuální koeficienty WMM/IGRF pro danou polohu a datum. V oblastech s rychlými změnami nebo anomáliemi ověřte model lokálním měřením. Pro přesnost < 1° je vhodné sezónně aktualizovat a při přeletu > 500 km re-evaluovat deklinaci.
Fúze senzorů: EKF, odmítání magnetometru a fallback
- EKF s gatingem: používejte Mahalanobisův gate na rezidua magnetometru. Při nadbytku reziduí → snížit váhu nebo dočasně vypnout magnetometr.
- GNSS yaw: při RTK dual-anténě GNSS lze získat absolutní yaw bez magnetometru (výborný fallback do kovových prostředí).
- Optický flow / vizuální odometrie: doplňkový heading při nízkých rychlostech a v interiéru.
- Detekční logika: pravidla „noisy mag“: prudká změna |B|, nesoulad s gyrem > X°, korelace s PWM motorů.
Datový pipeline pro magnetický survey a mapu
- Sběr: logujte čas, lat, lon, alt, Bx, By, Bz, |B|, roll, pitch, yaw, I (proud), RPM, teplota.
- Čištění: odstraňte saturace, outliery (Hampelův filtr), synchronizujte časové značky.
- Normalizace: transformujte měření do lokálního NED rámce; kompenzujte postoj.
- Interpolace: Kriging nebo IDW pro 2D/3D mřížku (x, y, z → |B|, Δheading).
- Publikace: raster (GeoTIFF) + vektorové masky (GeoJSON) pro plánovače misí a GCS.
Modelování dopadu na heading: odchylka a pravděpodobnost selhání
Heading error závisí na vektoru rušení a směru skutečného pole. Praktická aproximace:
- Lokální lineární citlivost: malá parazitní složka horizontálního pole způsobí odchylku ~ arctan(ΔBh / Bh).
- Pravděpodobnostní model: použijte empirickou distribuci ΔBh z mapy → Monte Carlo simulace profilu letu → distribuce HE(t).
- Rizikové KPI: P(HE > 10°) během startu/přistání; MTTF do „mag reject“ události.
Experimentální design: jak spolehlivě validovat heading
- Statické testy: UAV na nevodivém stojanu, porovnání s referenčním kompasem ve vzdálenosti > 3 m; test s ESC vypnuto/zapnuto.
- Taxi test: pojíždění v známém azimutu (dráhový heading) – porovnání s magnetometrem.
- Letové průlety: rovné úseky > 5 s při rychlosti > 5 m/s; porovnání s GNSS course a dual-anténním yaw (pokud je).
- Step test otáček: postupné zvyšování PWM; sledujte korelaci heading vs. RPM.
Praktická inženýrská pravidla návrhu kabeláže a mechaniky
- Trasy kabelů: vysokoproudové svazky vést co nejdále od senzoru, krátké přímky, minimum smyček.
- Symetrie proudů: odchozí a vracející proud vést spolu (twisted pairs), aby se rušivá pole částečně rušila.
- Materiály: vyhněte se feromagnetickým držákům u senzoru; používejte kompozity, hliník (pozor na vodivost, ale je nemagnetický).
- Připevnění senzoru: pevná, vibracím odolná montáž; vibrace ovlivňují gyra, ale i mikropohyby vůči lokálním zdrojům.
Algoritmické techniky: od elipsoid fitu po ML detekci rušení
- Elipsoid fit (Gauss-Newton, Taubin): odstranění zkreslení + whitening měření pro hard/soft-iron kompenzaci.
- Adaptive weighting: vážení měření podle odchylky |B| a korelace s RPM.
- Outlier rejection: RANSAC/Huber loss pro robustnost vůči krátkým pulzům rušení.
- ML klasifikátor: detekce „rušených“ segmentů podle feature setu: Δ|B|, d|B|/dt, spektrum PWM, teplota; výstup → flag pro EKF.
Integrace do plánování misí a GCS
- Předletová kontrola: GCS varování, pokud lokální raster naznačuje hotspot ve startovací zóně; doporučení „armovat s mag ignore“ nebo přesun startu.
- Trajektorie: vyhýbání se koridorům s vysokou P(HE > práh); při absenci GNSS yaw preferovat letové rychlosti > 3–4 m/s pro stabilnější kurz.
- Failover logika: automatický přechod na gyro+GNSS yaw, zvýšení bezpečnostní výšky, omezení agresivity obratů.
Specifika pro různé typy platforem
- Multikoptéry: silná korelace s proudem; doporučuje se mast-mount magnetometru a přísná kabeláž.
- VTOL/konvertoplány: dvojrežimové rušení (hover vs. forward flight); potřebné dvě sady kalibračních profilů.
- Pevné křídlo: obvykle nižší rušení, ale dlouhé kabely baterií mohou tvořit smyčky; důležité je uložení v trupu mimo servomotory křidélek.
Limity a kdy „vypnout kompas“
Pokud rezidua a odchylky |B| překročí limit nebo je heading nekonzistentní s gyrem a GNSS, autopilot by měl dočasně ignorovat magnetometr. Po návratu do „čisté“ zóny lze opět aktivovat. V „náročných“ prostředích (lodní paluby, průmyslové areály) plánujte mise bez závislosti na kompasu (dual GNSS yaw, vizuální odometrie).
Checklist před letem: magnetická hygiena
- Aktuální koeficienty deklinace a časová synchronizace.
- Kontrola |B| v idle vs. 50 % a 100 % throttle (nesmí překročit ±10–15 %).
- Gating parametry EKF a práh pro „mag reject“ otestovány.
- Mapa hotspotů pro startovací místo; pokud je hotspot, změna LZ nebo vyšší vzlet.
- Logování rozšířených veličin (RPM, proud, teplota) povoleno.
Tabulka: prahové hodnoty a doporučení
| Metrika | Doporučený práh | Akce při překročení |
|---|---|---|
| Odchylka |B| od modelu | > ±15 % | Přehodnotit LZ, zvýšit výšku, snížit spolehnutí na magnetometr |
| Heading vs. GNSS course (stabilní let) | > 8–10° | Snížit váhu magnetometru v EKF, diagnostika rušení |
| Korelace HE s RPM | p < 0,01 | Přepracovat kabeláž, přesunout senzor |
| Rezidua po kalibraci | > 3 µT RMS | Rekalibrace, kontrola feromateriálů |
