kth.sePublications
Change search
CiteExportLink to record
Permanent link

Direct link
Cite
Citation style
  • apa
  • ieee
  • modern-language-association-8th-edition
  • vancouver
  • Other style
More styles
Language
  • de-DE
  • en-GB
  • en-US
  • fi-FI
  • nn-NO
  • nn-NB
  • sv-SE
  • Other locale
More languages
Output format
  • html
  • text
  • asciidoc
  • rtf
Localization For AutonomousDriving using Statistical Filtering: A GPS aided navigation approach with EKF and UKF
KTH, School of Electrical Engineering and Computer Science (EECS).
2022 (English)Independent thesis Advanced level (degree of Master (Two Years)), 20 credits / 30 HE creditsStudent thesisAlternative title
Lokalisering för autonom körning med statistiskfiltrering : En GPS-stödd navigeringsmetod med EKF och UKF (Swedish)
Abstract [en]

A critical requirement for safe autonomous driving is to have an accurate state estimate of thevehicle. One of the most ubiquitous yet reliable ways for this task is through the integrationof the onboard Inertial Navigation System (INS) and the Global Navigation Satellite System(GNSS). This integration can further be assisted through fusion of information from otheronboard sensors. On top of that, a ground vehicle enforces its own set of rules, through non-holonomic constraints, which along with other vehicle dynamics can aid the state estimation.In this project, a sequential probabilistic inference approach has been followed, that fusesthe high frequency, short term accurate INS estimates, with low frequency, drift free GPSobservations. The fusion of GPS and IMU has been sought through a modular asynchronousloosely coupled framework, capable of augmenting additional observation sources to facilitatethe state estimation and tracking process. Besides GPS and IMU, the applied strategy makesuse of wheel speed sensor measurements, nonholonomic constraints and online estimationof IMU sensor biases as well wheel speed scalling factor. Theses augmentations have beenshown to increase the robustness of the localization module, under periods of GPS outage.The Extended Kalman Filter (EKF) has seen extensive usage for such sensor fusion tasks,however, the performance can be limited due to the propagation of the covariance throughlinearization of the underlying non-linear model. The Unscented Kalman Filter (UKF) avoidsthe issue of linearization based on jacobians. Instead, it uses a carefully chosen set ofsample points in order to accurately map the probability distribution. Correspondingly, thesurrounding literature also indicates towards the UKF out performing EKF in such tasks.Therefore, the present thesis also seeks to evaluate these claims.The EKF and SRUKF (Square Root UKF) instances of the developed algorithm have beentested on real sensor logs, recorded from a Scania test vehicle. Under no GPS outage situation,the implemented localization algorithm performs within a position RMSE of 60cm.The robustness of the localization algorithm, to GPS outages, is evaluated by simulating0-90% lengths of GPS unavailability, during the estimation process. Additionally, to unfoldthe impact of parameters, the individual modules within the suggested framework wereisolated and analysed with respect to their contribution towards the algorithm’s localizationperformance.Out of all, the online estimation of IMU sensor biases proved to be critical for increasingthe robustness of the suggested localization algorithm to GPS shortage, especially for the EKF.In terms of the distinction, both the EKF and the SRUKF performed to similar capabilities,however, the UKF showed better results for higher levels of GPS cuts.

Abstract [sv]

Ett kritiskt krav för säker autonom körning är att ha en korrekt tillståndsuppskattning avfordonet. Ett av de mest förekommande men ändå tillförlitliga sätten för denna uppgift ärgenom integrationen av det inbyggda tröghetsnavigationssystemet (INS) och med Satellitnavi-gation (GNSS). Denna integration kan ytterligare underlättas genom sammanslagning avinformation från andra sensorer ombord. Utöver det upprätthåller ett markfordon sin egenuppsättning regler, genom icke-holonomiska begränsningar, som tillsammans med annanfordonsdynamik kan hjälpa till vid tillståndsuppskattningen.I detta projekt har en sekventiell probabilistisk slutledning följts, som sammansmälterde högfrekventa, kortsiktiga exakta INS-uppskattningarna, med lågfrekventa, driftfria GPS-observationer. Sammanslagningen av GPS och IMU har sökts genom ett modulärt asynkrontlöst kopplat ramverk, som kan utökas med ytterligare observationskällor för att underlättatillståndsuppskattningen och spårningsprocessen. Förutom GPS och IMU använder dentillämpade strategin mätningar av hjulhastighetssensorer, icke-holonomiska begränsningaroch onlineuppskattning av IMU-sensorbias samt hjulhastighetsskalningsfaktor. Dessa tillägghar visat sig öka robustheten hos lokaliseringsmodulen under perioder utan GPS-signal.Extended Kalman Filter (EKF) har sett omfattande användning för sådana sensorfusionsup-pgifter, men prestandan kan begränsas på grund av spridningen av kovariansen genomlinearisering av den underliggande icke-linjära modellen. Unscented Kalman Filter (UKF)undviker frågan om linearisering baserad på jacobianer. Istället använder den en noggrantutvald uppsättning provpunkter för att korrekt kartlägga sannolikhetsfördelningen. På motsva-rande sätt indikerar den omgivande litteraturen också mot UKF att utföra EKF i sådanauppgifter. Därför försöker denna avhandling också utvärdera dessa påståenden.EKF- och SRUKF-instanserna (Square Root UKF) av den utvecklade algoritmen hartestats på sensorloggar, inspelade från ett Scania-testfordon. Utan GPS-avbrott presterar denimplementerade lokaliseringsalgoritmen inom en position RMSE på 60 cm.Robustheten hos lokaliseringsalgoritmen, vid GPS-avbrott, utvärderas genom att simulera0-90% längder av GPS-otillgänglighet under uppskattningsprocessen. Utöver det har deenskilda modulerna inom det föreslagna ramverket isolerats och analyserats med avseendepå deras bidrag till algoritmens lokaliseringsprestanda.Av allt visade sig onlineuppskattningen av IMU-sensorbiaser vara avgörande för att ökarobustheten hos den föreslagna lokaliseringsalgoritmen mot GPS-brist, särskilt för EKF. Närdet gäller distinktionen presterade både EKF och SRUKF med liknande förmåga, men UKFvisade bättre resultat vid längre perioder utan GPS-signal.

Place, publisher, year, edition, pages
2022. , p. 83
Series
TRITA-EECS-EX ; 2022:685
Keywords [en]
Land Vehicle Localization, Sensor Fusion, GNSS-INS Fusion, UKF, EKF
National Category
Computer graphics and computer vision
Identifiers
URN: urn:nbn:se:kth:diva-321963OAI: oai:DiVA.org:kth-321963DiVA, id: diva2:1713737
External cooperation
Scania CV AB
Subject / course
Systems Engineering
Educational program
Master of Science - Systems, Control and Robotics
Supervisors
Examiners
Available from: 2022-12-05 Created: 2022-11-27 Last updated: 2025-02-07Bibliographically approved

Open Access in DiVA

fulltext(2030 kB)451 downloads
File information
File name FULLTEXT02.pdfFile size 2030 kBChecksum SHA-512
305a32e80f76e5ef1548941cd3c3ae07f18d536259a0978b7311241e8e055e0b949b51cbf9b71f42d2c1652c017f3a2995374583ce2728296ecbd5c60bfc8863
Type fulltextMimetype application/pdf

By organisation
School of Electrical Engineering and Computer Science (EECS)
Computer graphics and computer vision

Search outside of DiVA

GoogleGoogle Scholar
Total: 451 downloads
The number of downloads is the sum of all downloads of full texts. It may include eg previous versions that are now no longer available

urn-nbn

Altmetric score

urn-nbn
Total: 469 hits
CiteExportLink to record
Permanent link

Direct link
Cite
Citation style
  • apa
  • ieee
  • modern-language-association-8th-edition
  • vancouver
  • Other style
More styles
Language
  • de-DE
  • en-GB
  • en-US
  • fi-FI
  • nn-NO
  • nn-NB
  • sv-SE
  • Other locale
More languages
Output format
  • html
  • text
  • asciidoc
  • rtf