Navigace v interiéru bez využití GNSS

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ý, avšak v halách, tunelových prostorech, pod střechou či v blízkosti zdrojů 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 poziční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: dobrý pro relativní výšku v uzavřeném prostoru, ale citlivý na proudění vzduchu a termiku. Vhodný jako doplňková reference v režimu 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 spektru. 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, avšak hůře škáluje při více kotvách.
TDoA (Time Difference of Arrival): kotvy jsou synchronizované, dron pouze naslouchá časům příjmu a počítá rozdíly (hyperboly). Výborně škáluje a poskytuje vyšší update rate, ale vyžaduje spolehlivou synchronizaci sítě kotví.

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

Geometrie a analogie „GDOP“ pro UWB

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

Minimalizujte kolinearitu – vyhněte se umístění kotvi na jedné stěně/čáře.
Pokryjte prostorový objem – alespoň jedna kotva by měla být výrazně výše či níže pro zlepšení výškové přesnosti.
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ě kotví 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 range. Při bezdrátové synchronizaci kontrolujte drift a periodicky provádějte recalibration beacons.

Model chyb: NLOS, multipath a antény

NLOS detekce: heuristiky podle tvaru impulsu, SNR a channel impulse response (CIR). Při podezření na NLOS zvyšte měřící 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í opravují chybu stavu. Výhodné pro malé odchylky a vysoké frekvence.
Faktografická optimalizace (factor graph, např. s iSAM2/GTSAM): okénková optimalizace nad trajektorií; výborné pro kombinaci s vizuálními/značkovacími uzly a pro offline/nearly real-time vylepšení.

Stav typicky obsahuje: polohu p, rychlost v, orientaci q, biasy IMU (b_g, b_a) a případně časový offset. UWB range měření má podobu z = ||p – p_kotva|| + n. Při TDoA vstupuje rozdíl vzdáleností k dvojici kotví.

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

Pro snížení driftu DR a zvýšení robustnosti 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 směrem 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é rozpětí od VIO/DR, občas re-referencované.
base_link: rámec dronu (původ IMU, fáze UWB antény).

Při fúzi je klíčová extrinsická kalibrace (posun/rotace mezi IMU, UWB anténou, kamerou). Chybné extrinziky se projevují 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.
Fail-safe 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 delší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 kotví bez ztráty stability.

Architektura systému: od kotví 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í: poziční/trajektorický regulátor (MPC/SE(3) geometrická kontrola).
Supervize: monitor KPI, FDI, logger (IMU raw, ranges, innovations).

Praktická instalace UWB: kroky a doporučení

Mapování prostoru: rozměry, materiály, pravděpodobné NLOS zóny.
Návrh geometrie: 4–6 kotví, různé výšky, kotva u vstupu i ve středu haly.
Vymezení souřadnic: zaměření kotví (laser/total station) nebo přesná pásemná triangulace; export do map frame.
Synchronizace a kanály: zvolit kanál (např. 5/9), datový profil, případné 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 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á odchylka vůči referenci (motion capture/laser)	< 10–20 cm v hale, < 30–50 cm v komplikovaném NLOS
NEES/Konzistence	Shoda mezi odhadovanou kovariancí a skutečnou chybou	Bez systematického pod/over confidence
Latence	Zpoždění odhadu vzhledem k reálnému pohybu	< 50 ms pro plynulé řízení
Dostupnost	% času se spolehlivou polohou	> 99 % v pracovním objemu
Robustnost při výpadku	Držení polohy při ztrátě 1–2 kotví nebo VIO	Stabilní, bez divergence > 5 s

Bezpečnost a provozní postupy v interiéru

Definujte bezpečné koridory a zóny zákazu letu (nad lidmi, u dveří).
Připravte nouzová přistání a fail-safe režimy na ztrátu polohy (alt-hold + sestup).
Omezte max. rychlost a zrychlení dle 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 (emise, duty-cycle) a minimalizujte interferenci s jinými technologiemi ve výrobě (průmyslová Wi-Fi, RTLS v 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ízkou latenci posílejte LOCAL_POSITION_NED.
Hybrid: TDoA solver mimo dron (edge PC) → posílání polohy přes Ethernet/Wi-Fi; dron využívá onboard IMU pro vyhlazení a vysokofrekvenční řízení.