Real-time loosely coupled GNSS and IMU integration via Factor Graph Optimization

Dit artikel presenteert een real-time, losgekoppeld GNSS-IMU-integratiesysteem op basis van Factor Graph Optimization dat, hoewel het ten koste gaat van de positieprecisie, de beschikbaarheid van de dienst in uitdagende stedelijke omgevingen significant verbetert ten opzichte van batch-methoden.

Radu-Andrei Cioaca, Cristian Rusu, Paul Irofti, Gianluca Caparra, Andrei-Alexandru Marinache, Florin Stoican

Gepubliceerd 2026-03-05
📖 4 min leestijd☕ Koffiepauze-leesvoer

Each language version is independently generated for its own context, not a direct translation.

Stel je voor dat je door een drukke stad loopt met een smartphone in je hand. Je wilt precies weten waar je bent. Normaal gesproken kijkt je telefoon naar de satellieten boven je hoofd (het GNSS-systeem, zoals GPS). Maar in een stad met hoge gebogen ("urban canyons") is dat lastig. De signalen botsen tegen muren, verdwijnen achter hoeken of worden verstoord. Het is alsof je probeert een gesprek te voeren in een lawaaierige fabriek; soms hoor je de satelliet niet meer, en soms hoor je een echo die je laat denken dat je ergens anders bent.

Om dit op te lossen, gebruiken we een tweede hulpmiddel: een IMU (een soort zeer gevoelig kompas en versnellingsmeter in je telefoon). Deze weet precies hoe je beweegt, zelfs als je even niet naar de hemel kunt kijken. Maar de IMU heeft een nadeel: na verloop van tijd wordt hij een beetje "dronken" en begint hij fouten op te stapelen.

Het probleem:
Hoe combineer je deze twee?

  1. Satellieten: Soms stil, soms verward door echo's, maar op lange termijn accuraat.
  2. IMU: Altijd aan het werk, maar wordt steeds onnauwkeuriger naarmate de tijd vordert.

De auteurs van dit paper hebben een slimme manier bedacht om deze twee te laten samenwerken in echte tijd (terwijl je beweegt), zonder te wachten tot je klaar bent met rijden. Ze noemen dit RTFGO.

De Analogie: De Slimme Reisgids

Stel je voor dat je een reisgids hebt die je positie probeert te bepalen.

1. De oude methode (Batch-verwerking / SFGO):
Stel je voor dat je een hele dag wandelt en pas 's avonds, als je thuis bent, al je notities en GPS-gegevens doorgeeft aan een super-rekenmachine. Die kijkt dan naar alles wat je die dag hebt gedaan, past de fouten van 09:00 uur aan op basis van wat je om 17:00 uur hebt gezien, en geeft je een perfect traject.

  • Voordeel: Zeer nauwkeurig.
  • Nadeel: Je weet niet waar je bent terwijl je loopt. Het werkt niet in real-time.

2. De nieuwe methode (RTFGO - Real-Time Factor Graph Optimization):
De auteurs hebben een methode bedacht die werkt als een slimme, levende reisgids die je terwijl je loopt bijhoudt.

  • De "Factor Graph": Denk hieraan als een groot, flexibel web van aannames. Elke meting (satelliet of IMU) is een knooppunt in dit web. De gids probeert het hele web zo strak mogelijk te trekken zodat alle stukjes logisch bij elkaar passen.
  • Real-time trucjes: Omdat de gids niet kan wachten tot je klaar bent, gebruikt hij twee slimme tactieken:
    • De "Vooruitkijkende blik" (Smoothing Latency): De gids wacht even een paar seconden voordat hij zijn definitieve antwoord geeft. Hij kijkt naar de komende metingen om te zien of zijn eerdere gedachten kloppen. Voorbeeld: Hij denkt dat je linksaf bent, maar een meting over 2 seconden zegt "nee, je ging rechtdoor". Dan past hij het verleden direct aan. Dit maakt het nauwkeuriger, maar je moet even wachten.
    • Het "Vergeten" van oude data (Marginalization): Als je te lang loopt, wordt het web te groot om snel te berekenen. De gids vergeet dan de details van 10 minuten geleden, maar houdt wel de conclusie van die tijd vast. Hij houdt de rekentijd laag, maar verliest een beetje van de scherpte.

Wat hebben ze ontdekt?

De auteurs hebben dit getest in de straten van Hongkong (een van de moeilijkste plekken voor GPS).

  • De ruil (Trade-off): Je kunt niet alles tegelijk hebben.

    • Wil je maximale nauwkeurigheid? Dan moet je wachten (zoals de oude methode) of langere tijd meten. Je bent dan minder snel beschikbaar als je snelheid nodig hebt.
    • Wil je directe beschikbaarheid (altijd een locatie, zelfs als de satelliet even wegvalt)? Dan moet je vertrouwen op de IMU. Dit is sneller en werkt altijd, maar je positie kan na een tijdje iets "afraken" (zoals een dronken kompas).
  • Het resultaat: Hun nieuwe systeem (RTFGO) is een perfecte balans.

    • Het werkt in real-time (je krijgt direct een antwoord).
    • Het blijft werken als de satelliet even verdwijnt (door de IMU te gebruiken).
    • Het is iets minder nauwkeurig dan de "wacht-tot-je-klaar-bent" methode, maar voor een zelfrijdende auto of een drone is het sneller en betrouwbaarder om nu te weten waar je bent, dan om perfect te weten waar je was.

Samenvattend in één zin:

Deze paper presenteert een slimme manier om je telefoon en je versnellingsmeter samen te laten werken als een team dat terwijl je beweegt continu zijn eigen fouten corrigeert, zodat je ook in de drukste stad altijd weet waar je bent, zonder te hoeven wachten tot je thuis bent.