Magnetometrická kalibrace: Kompenzace rušení pro přesné určení směru UAV

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 vzletu/návratu nebo k aktivaci 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 elipticitou a rotací měřicí elipsy.
• Elektromagnetické zdroje: Proudové vedení, 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é betony.
• Geomagnetické jevy: Lokální anomálie hornin, magnetické bouře, svahované gradienty deklinace.
• Dynamické vlivy: Zahřátí 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 attitude z gyra/akcelerometru). Základní metriky pro kvalitu jsou:

• Norma vektoru |B|: odchylka od očekávané intenzity (např. 45–55 µT) indikuje rušení.
• Dot produkt s referencí: úhly mezi měřeným a referenčním polem.
• Residuals 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

1. Mapa „on-frame“ (interní): magnetické pole vs. poloha senzoru v trupu, otáčky motorů, proudové zatížení, poloha baterie a kabelů.
2. 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.
3. 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í

1. Sběr dat: rotace ve všech osách („kachna“/„8“), ideálně 500–2000 vzorků v různých attitude a proudech. Sbírejte B, teplotu, RPM, proud, napětí.
2. Model: Elipsoidové fitování (M, b), kde M je 3×3 matice (soft-iron) a b je posun (hard-iron). Normalizujte na jednotkovou kouli.
3. Validace: Zkontrolujte rezidua, normu |B| a stabilitu parametrů při různých proudech (ESC off/on).
4. On-line adaptace: Udržujte pomalý adaptivní filtr pro korekci teplotního driftu a dlouhodobé změny 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ý survey

1. 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.
2. Identifikace hotspotů: místa s |B| > ±15 % od regionálního průměru nebo s prudkým gradientem (> 5 µT/m).
3. Výškový profil: krátké stoupání do 10–30 m AGL nad podezřelými body; rušení často rychle klesá s výškou.
4. Maska pro plánovač misí: vyznačte no-compass zóny, kde autopilot nesmí spoléhat na magnetometr (přepnout 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ítnutí magnetometru a fallback

• EKF s gatingem: používejte Mahalanobisův gating reziduí magnetometru. Při nadměrném množství reziduí → snížit váhu nebo dočasně vypnout magnetometr.
• GNSS yaw: při RTK dual-anténní GNSS lze získat absolutní yaw bez magnetometru (výborný fallback pro kovové prostředí).
• Optický flow / vizuální odometrie: doplňkový heading při nízkých rychlostech a v indooru.
• 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

1. Sběr: logujte čas, lat, lon, alt, Bx, By, Bz, |B|, roll, pitch, yaw, I (proud), RPM, teplota.
2. Čištění: odstraňte saturace, outliery (Hampelův filtr), synchronizujte časové značky.
3. Normalizace: transformujte měření do lokálního NED rámce; kompenzujte attitude.
4. Interpolace: Kriging nebo IDW pro 2D/3D mřížku (x, y, z → |B|, Δheading).
5. 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 na 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

1. Statické testy: UAV na nevodivém stojanu, srovnání s referenčním kompasem ve vzdálenosti > 3 m; test s ESC vypnuto/zapnuto.
2. Taxi test: pojíždění v známém azimutu (dráhový heading) – srovnání s magnetometrem.
3. Letové průlety: rovné úseky > 5 s při rychlosti > 5 m/s; srovnání s GNSS course a dual-anténním yaw (pokud je k dispozici).
4. Step test otáček: postupné zvyšování PWM; sledujte korelaci heading vs. RPM.

Praktické inženýrské zásady 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ů: odcházející a vracející proud vést společně (twisted), aby se rušivé pole částečně rušilo.
• Materiály: vyhněte se feromagnetickým držákům u senzoru; používejte kompozity, hliník (pozor na vodivost, ale je nemagnetický).
• Uchycení 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): de-bias + whitening měření pro hard/soft-iron.
• Adaptive weighting: vážení měření podle |B| odchylky 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 létání rychlostí > 3–4 m/s pro stabilnější course.
• 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řeba dvou sad kalibračních profilů.
• Pevné křídlo: obvykle nižší rušení, ale dlouhé kabely baterií mohou tvořit smyčky; důležité je umístění v trupu mimo servomotory klapek.

Limity a kdy „vypnout kompas“

Pokud rezidua a |B| odchylky 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 může být znovu povolen. V „těžký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í

Bezpečnostní aspekty a regulace

Magnetické selhání headingu mohou vést