Towards Networked One Search Agent Systems: Multilateration of WiFi Fine Time Measurement Responders Using GNSS References

Technische Samenvatting: Naar Netwerkgestuurde One Search Agent Systemen

Probleemstelling
Nauwkeurige lokalisatie van stationaire draadloze emittenten is cruciaal voor robotische toepassingen zoals zoek- en reddingsoperaties (SAR) en infrastructuurmapping. Hoewel Global Navigation Satellite Systems (GNSS) de standaard zijn, verslechteren deze in complexe omgevingen. Bestaande oplossingen vertrouwen vaak op signaalsterkte-fingerprinting (dat voorafgaande kalibratie vereist) of specifieke ranging-technologieën zoals Ultra-Wideband (UWB), die doelgerichte infrastructuur vereisen. Het IEEE 802.11mc Fine Time Measurement (FTM) protocol biedt een middenweg; het levert afstandsschattingen op metermeter-niveau met behulp van standaard WiFi-hardware zonder dat kloksynchronisatie nodig is. Het benutten van FTM voor de outdoor-lokalisatie van grondgebonden access points (AP's) vanuit een Uncrewed Aerial Vehicle (UAV) brengt echter uitdagingen met zich mee: het systeem moet real-time multilateratie uitvoeren met een bewegende basislijn (de UAV), terwijl het om moet gaan met meetruis, non-line-of-sight (NLoS) condities en beperkte rekenkracht op het edge-apparaat.

Methodologie
De auteurs stellen een proof-of-concept systeem voor waarbij een UAV fungeert als een FTM-initiator en GNSS-ontvanger, waarbij grondgebonden WiFi AP's fungeren als FTM-responders. De kernarchitectuur keert eerdere modellen om: in plaats van dat het slachtoffer een smartphone draagt, voert de zoekagent (UAV) de berekening uit, terwijl het doelwit een eenvoudige, passieve AP draagt.

• Hardwareplatform: Het systeem maakt gebruik van een DJI Matrice 350 RTK UAV die een Google Pixel 7 Pro smartphone en een u-blox ZED-F9P multi-band GNSS-ontvanger vervoert. De smartphone draait een aangepaste Android-applicatie die interfaceert met de WiFi RTT API en de GNSS-ontvanger.
• Lokalisatiepipeline: Het systeem behandelt het vliegpad als een temporeel multilateratieprobleem. De pipeline omvat:
  1. Data Associatie: Het synchroniseren van FTM-rangingstempels met GNSS-posities met behulp van een monotone klok, met een associatievenster van 1,2 seconden.
  2. Outlier Gating: Een sliding-window Median Absolute Deviation (MAD) filter verwerpt grove uitschieters (outliers) terwijl geldige Line-of-Sight (LoS) metingen behouden blijven.
  3. Initialisatie: Een twee-fasen Gauss-Newton bootstrap berekent een initiële 3D-positiechatting zodra voldoende geometrische spreiding is bereikt.
  4. Sequentiële Filtering: Het systeem maakt gebruik van een Iterated Extended Kalman Filter (IEKF) met bias-tracking of een Unscented Kalman Filter (UKF). De toestandsvector bevat de AP-positie $(x, y, z)$ en een residuele range-bias.
  5. Ruismodellering: Er zijn zes verschillende configuraties voor meetruis geëvalueerd, variërend van een constant basislijnemodel tot adaptieve modellen die de variantie aanpassen op basis van afstand, Received Signal Strength Indicator (RSSI) en NLoS-detectie (gebruikmakend van range-window scheefheid en RSSI-consistentie).
• Restricties: Het systeem werkt autonoom zonder netwerkverbinding en logt gegevens naar JSONL-bestanden, hoewel het ROS 2 ondersteunt voor multi-agent fusie wanneer een verbinding beschikbaar is.

Belangrijkste Bijdragen

1. Real-time Schattingspipeline: Een volledige pipeline die draait op een standaard smartphone, waarbij ranging, positionering en schatting (IEKF/UKF) worden geïntegreerd met bias-tracking en outlier gating.
2. Analyse van Ruisconfiguraties: Een vergelijkende evaluatie van zes meetruismodellen, die aantoont hoe afstand- en RSSI-afhankelijke weging de diversiteit van metingen behoudt en correcties in de latere fase tijdens nauwe overvluchten mogelijk maakt.
3. Veldvalidatie: Proof-of-concept testen in ongestructureerd, bergachtig terrein met drie AP's onder variërende verhullingscondities: LoS, matige NLoS (vegetatie) en ernstige NLoS (vegetatie + puin).
4. Integratie van Netwerkarchitectuur: Voorlopige demonstratie van softwarematige interoperabiliteit, waarbij wordt getoond dat heterogene agenten (UAV en grond) FTM-observaties kunnen delen via ROS 2, wat dient als bouwsteen voor "Networked One Search Agent" (OSA) systemen.

Resultaten
Experimenten werden uitgevoerd bij de Universiteit van Málaga met drie AP's.

• LoS Prestaties (AP_1F): Voor een AP met 455 ranging-metingen:
  • De online real-time pipeline (BASELINE mode) behaalde een uiteindelijke horizontale fout van 4,4 m en een 3D-fout van 5,5 m.
  • Offline replay met het EMPIRICAL-R ruismodel (afstand en RSSI afhankelijk) behaalde een time-weighted mean (TWM) horizontale fout van 4,7 m.
  • Onder het beste ruismodel maakte een nauwe overvlucht het systeem in staat de schatting te verfijnen naar een uiteindelijke horizontale fout van 1,1 m.
  • Het ADAPTIVE-R model behaalde de kleinste interne onzekerheid ($\sigma_H = 1,0$ m) maar een uiteindelijke fout van 4,3 m.
• NLoS Prestaties:
  • Matige NLoS (AP_AB): Het systeem slaagde er niet in om real-time te convergeren door schaarse metingen (totaal 31), signaalverzwakking en bijna-collineaire geometrie (conditienummer $\kappa = 28,5$). Echter, een offline robuuste least-squares solver herstelde een grove oplossing met een horizontale fout van ongeveer 7 m.
  • Ernstige NLoS (AP_AA): De AP, geblokkeerd door vegetatie en betonpuin, produceerde nul FTM-responses.
• Filter Betrouwbaarheid: De auteurs merken op dat de interne covariantie van de filter ($\sigma_H$) de werkelijke absolute fout aanzienlijk onderschat (bijv. $\sigma_H \approx 1,1$ m versus een werkelijke fout van $\approx 4,4$ m). Dit wordt toegeschreven aan niet-gemodelleerde gecorreleerde fouten in de door GNSS gerefereerde initiator-posities, aangezien het systeem geen aparte GNSS-covariantieterm in de vergelijkingsmodellen heeft opgenomen.

Betekenis en Claims
Dit artikel positioneert dit werk als een architecturale vooruitgang voor Netwerkgestuurde OSA-systemen, in plaats van een claim van superieure nauwkeurigheid ten opzichte van eerdere datasets. Door de lokalisatiearchitectuur om te keren—het rekenkundige beroep leggend op de zoekagent en het vereisen van slechts een eenvoudige FTM-geschikte responder aan de zijde van het doelwit—elimineert het systeem de noodzaak voor software aan de zijde van het slachtoffer.

De auteurs benadrukken dat het systeem een bouwsteen is voor toekomstige multi-agent netwerken. Hoewel de single-agent pipeline meter-niveau LoS-prestaties demonstreert, erkent het artikel bescheiden dat NLoS-operatie een aanzienlijke uitdaging blijft vanwege geometrie en signaalblokkade. Het resultaat van 1,1 m wordt gekarakteriseerd als een "gunstige resultaat bij een nauwe passage", afhankelijk van de specifieke vlieggeometrie, en niet als een gegarandeerde systeemgrens. Toekomstig werk is gericht op netwerkbrede fusie, verbeterde vluchtbaanplanning (bijv. helicale of rasterpatronen) om de multilateratie-conditie te optimaliseren, en de ontwikkeling van gedempte robuuste solvers voor gedegenereerde geometrieën.