Navigace bez GNSS: Dead-reckoning a nasazení UWB kotev pro interiérové mise

Proč navigovat bez GNSS a co to znamená pro UAV

GNSS (GPS/Galileo/GLONASS/BeiDou) je mimo interiérů a městských kaňonů velmi spolehlivý, ale v halách, tunelech, pod střechou či v blízkosti rušení signálu je nepoužitelný. Pro autonomní UAV to znamená nutnost kombinovat dead-reckoning (DR) z inerciálních senzorů se relativním polohovým systémem, například UWB kotvami. Cílem je dosáhnout kontinuální a stabilní lokalizace s nízkou latencí, která je odolná vůči dočasným výpadkům jednotlivých senzorů.

Dead-reckoning: základní princip, silné a slabé stránky

Dead-reckoning integruje zrychlení a úhlovou rychlost z IMU (akcelerometr + gyroskop) v čase. Výpočet polohy probíhá od známého počátečního stavu podle:

Attitude (orientace): integrace gyroskopů → rotace těla vůči světu.
Rychlost: integrace lineárních zrychlení po kompenzaci gravitace.
Poloha: integrace rychlosti.

Výhody: extrémně nízká latence, funguje ve tmě i bez externích referencí, vysoká dynamická odezva. Nevýhody: drift (biasy a šum IMU se integrací kumulují), citlivost na kalibraci a vibrace.

Inerciální senzory a kalibrace: IMU, magnetometr, barometr

IMU: důležitá je stabilita biasu gyroskopů a akcelerometrů, nízký šum a nezávislost os. Před nasazením proveďte statické/teplotní kalibrace a určete skew/scale matice.
Magnetometr: v interiéru často nepoužitelný kvůli rušení (ocel, kabely). Hodí se pouze jako měkké omezení yaw pro pomalé driftování.
Barometr: vhodný pro relativní výšku v uzavřených prostorách, ale citlivý na proudění vzduchu a termiku. Doporučený jako doplňková reference v loiter/altitude hold.

UWB kotvy: princip, architektura a topologie

UWB (Ultra-Wideband) poskytuje přesné měření vzdáleností uvnitř budov díky krátkým impulsům a širokému pásmu. Dvě základní schémata:

TWR (Two-Way Ranging): dron si vyměňuje zprávy s jednou kotvou a přímo měří čas letu (ToF). Jednoduché, nevyžaduje přesnou synchronizaci hodin, ale hůře škáluje při více kotevních bodech.
TDoA (Time Difference of Arrival): kotvy jsou synchronizované, dron pouze naslouchá čas příjmu a počítá rozdíly (hyperboly). Výborně škáluje a poskytuje vyšší obnovovací frekvenci, ale vyžaduje spolehlivou synchronizaci sítě kotev.

Doporučená topologie pro místnosti a haly je minimálně 4–6 kotev s dobrým geometrickým rozmístěním (výška + rohy, nekoncentrovat v jedné rovině). Vysoké stropy řešte doplněním kotvy na trámy/sloupy pro zlepšení observability osy Z.

Geometrie a „GDOP“ analogie pro UWB

Stejně jako u GNSS existuje GDOP/PDOP, i u UWB platí, že geometrie kotev zásadně ovlivňuje kovarianci odhadu. Praktická pravidla:

Minimalizujte kolinearitu – vyhněte se umístění kotev na jedné stěně/čáře.
Pokryjte objem – alespoň jedna kotva by měla být výrazně výše/než níže pro lepší určení výšky.
Dbejte na line-of-sight a snižujte NLOS (sklo, kov, lidské tělo) – multipath zvyšuje bias v měřeních.

Synchronizace sítě kotev a časování

Pro TDoA je klíčová synchronizace: buď kabelová (PPS/clk) nebo bezdrátová (TDMA/Blink protokol). Divergence hodin způsobuje systematické chyby v měření vzdáleností. Při bezdrátové synchronizaci kontrolujte drift a pravidelně provádějte recalibration beacons.

Model chyb: NLOS, multipath a antény

NLOS detekce: heuristiky podle tvaru pulzu, SNR a channel impulse response (CIR). Při podezření na NLOS zvyšte měřicí kovarianci nebo měření odmítněte.
Multipath: v otevřených halách obvykle menší problém než v úzkých chodbách. Zvolte kanál (např. 5/9) a datové rychlosti podle místních podmínek.
Anténa: používejte izotropnější antény a dbejte na oddělení od motobloků/uhlíkových ramen. Kalibrujte antenna phase center vůči tělové souřadnici dronu.

Fúze senzorů: EKF/UKF/ESKF a faktografický přístup

Fúze IMU (vysoké Hz) + UWB (střední Hz) probíhá ve stavovém estimátoru. Dva osvědčené přístupy:

ESKF (Error-State Kalman Filter): IMU integruje nominální stav; UWB měření korigují chybu stavu. Výhodné pro malé odchylky a vysoké frekvence.
Faktografická optimalizace (factor graph, např. s iSAM2/GTSAM): posuvná optimalizace nad trajektorií; výborná pro kombinaci s vizuálními a značkovacími uzly a pro offline/nearly-real-time zpřesnění.

Stav typicky obsahuje: pozici p, rychlost v, orientaci q, biasy IMU (b_g, b_a) a případně časový offset. UWB vzdálenostní měření má podobu z = ||p – p_kotva|| + n. Při TDoA vstupují rozdíly vzdáleností ke dvojici kotev.

Vizuální asistence: VIO a fiduciály v interiéru

Pro snížení driftu DR a zvýšení odolnosti vůči krátkodobým výpadkům UWB se běžně využívá vizuálně-inerciální odometrie (VIO). Vhodné doplňky:

VIO (mono/stereo): poskytuje relativní pohyb s nízkým driftem, citlivý na texturu a osvětlení.
Fiduciály (AprilTag/ArUco): přesné body pro loop-closure a absolute pose; umístěné na stěnách/sloupech.
Optický flow dolů + lidar/ToF výška: stabilní loiter ve výškách 0,2–5 m nad povrchem.

Souřadnicové rámce a sladění referencí

Definujte jednoznačně:

map/world: pevný rámec interiéru (UWB kotvy, značky).
odom: lokální bezdriftový rozsah z VIO/DR, občas přenastavovaný.
base_link: rámec dronu (IMU původ, UWB fáze antény).

Při fúzi je klíčová extrinsická kalibrace (posun/rotace mezi IMU, UWB anténou, kamerou). Chybná extrinsika se projeví oscilacemi a systematickým offsetem.

Řízení letu bez GNSS: režimy a přechody

Position hold (interiér): vstup z fúzního estimátoru → horizont řídí optický flow/VIO/UWB, výšku baro+lidar.
Trajectory tracking: časovaný Mellinger/jerk-minimal nebo MPC; predikce berou v úvahu latenci UWB.
Failsafe přechod: ztráta UWB → dočasně VIO/OF stabilizace; ztráta VIO → manuální/alt-hold, přistání.

Integrita a detekce chyb (FDI/Fault flags)

Innovation gating: sledujte normalizovaná rezidua UWB/VIO; při dlouhém překročení prahu dočasně snižte váhu měření.
Chi-square testy a SPRT: rychlá identifikace NLOS outlierů.
Redundantní kotvy: v plánu letu počítejte s výpadkem 1–2 kotev bez ztráty stability.

Architektura systému: od kotev po autopilota

UWB vrstva: kotvy (PoE/nabíječky), synchronizace, backend (TDoA solver) nebo onboard TWR driver.
Estimace: onboard ESKF (200–1 000 Hz IMU, 10–100 Hz UWB/VIO), sdílení stavu přes MAVLink/ROS 2.
Řízení: polohový/trajektorický regulátor (MPC/SE(3) geometrické řízení).
Dozor: monitoring KPI, FDI, logger (IMU raw, vzdálenosti, inovace).

Praktická instalace UWB: kroky a doporučení

Mapování prostoru: rozměry, materiály, pravděpodobné NLOS zóny.
Návrh geometrie: 4–6 kotev, různé výšky, kotva u vstupu a uprostřed haly.
Vymezení souřadnic: zaměření kotev (laser/total station) nebo přesná pásmová triangulace; export do map frame.
Synchronizace a kanály: zvolit kanál (např. 5/9), datový profil, koordinace s Wi-Fi/BLE.
Ověření linky: měření CIR/SNR, test TDoA reziduí, detekce NLOS hotspotů.

Kalibrace: co musíte udělat před prvním letem

IMU: statická/teplotní, určete bias a scale, validujte Allanovou deviací.
Extrinsika: odhad posunu UWB antény vůči IMU (ručně/optimalizačně).
Časové zpoždění: odhad latence UWB/VIO; v ESKF modelujte time offset stavem nebo kompenzujte v předřazení.
Magnetické mapy (volitelné): pokud používáte yaw pomocí magnetometru, vytvořte lokální mapu anomálií.

Měření výkonu: metriky a testovací plán

Metrika	Definice	Cíl
ATE/RMSE (absolutní chyba trajektorie)	Průměrné odchýlení vůči referenci (motion capture/laser)	< 10–20 cm v hale, < 30–50 cm v náročném NLOS
NEES/Konzistence	Shoda mezi odhadovanou kovariancí a skutečnou chybou	Bez systematického pod/over confidence
Latence	Zpoždění odhadu vůči reálnému pohybu	< 50 ms pro plynulé řízení
Dostupnost	% času s spolehlivou polohou	> 99 % v pracovním objemu
Robustnost při výpadku	Udržení polohy při ztrátě 1–2 kotev nebo VIO	Stabilní, bez divergování > 5 s

Bezpečnost a provozní postupy v interiéru

Definujte bezpečné koridory a zóny bez letu (nad lidmi, u dveří).
Připravte nouzová přistání a failsafe na ztrátu polohy (alt-hold + klesání).
Omezte maximální rychlost a zrychlení podle prostoru a latence lokalizace.
Vždy mějte spottera při testech a vizuální potvrzení chování.

Interference a regulační aspekty UWB

UWB pracuje v licenčně volných pásmech s omezeným výkonem. Respektujte lokální normy (masky vyzařování, duty-cycle) a minimalizujte interferenci s jinými technologiemi ve výrobě (průmyslová Wi-Fi, RTLS na 2,4/5 GHz – zpravidla koexistují, ale pozor na harmonické a vedené emise).

Příklady integračních vzorů (ROS 2 / autopilot)

Onboard ESKF: IMU (1 kHz) → ESKF → /odom; UWB vzdálenosti (30–100 Hz) a VIO (20–60 Hz) jako korekce.
MAVLink integrace: publikujte VISION_POSITION_ESTIMATE nebo ODOMETRY do FCU; pro ultra-nízké latence posílejte LOCAL_POSITION_NED.
Hybrid: TDoA solver mimo dron (edge PC) → posílání polohy přes Ethernet/Wi-Fi; dron používá onboard IMU pro vyhlazení a vysokofrekvenční řízení.