Bayesian Simultaneous Localization and Multi-Lane Tracking Using Onboard Sensors and a SD Map

Fuente: arXiv
Enregistré dans:
Détails bibliographiques
Auteurs principaux: Xia, Yuxuan, Stenborg, Erik, Fu, Junsheng, Hendeby, Gustaf
Format: Preprint
Publié: 2024
Sujets:
Accès en ligne:
Tags: Ajouter un tag
Pas de tags, Soyez le premier à ajouter un tag!
_version_ 1866910437070602240
author Xia, Yuxuan
Stenborg, Erik
Fu, Junsheng
Hendeby, Gustaf
author_facet Xia, Yuxuan
Stenborg, Erik
Fu, Junsheng
Hendeby, Gustaf
contents High-definition map with accurate lane-level information is crucial for autonomous driving, but the creation of these maps is a resource-intensive process. To this end, we present a cost-effective solution to create lane-level roadmaps using only the global navigation satellite system (GNSS) and a camera on customer vehicles. Our proposed solution utilizes a prior standard-definition (SD) map, GNSS measurements, visual odometry, and lane marking edge detection points, to simultaneously estimate the vehicle's 6D pose, its position within a SD map, and also the 3D geometry of traffic lines. This is achieved using a Bayesian simultaneous localization and multi-object tracking filter, where the estimation of traffic lines is formulated as a multiple extended object tracking problem, solved using a trajectory Poisson multi-Bernoulli mixture (TPMBM) filter. In TPMBM filtering, traffic lines are modeled using B-spline trajectories, and each trajectory is parameterized by a sequence of control points. The proposed solution has been evaluated using experimental data collected by a test vehicle driving on highway. Preliminary results show that the traffic line estimates, overlaid on the satellite image, generally align with the lane markings up to some lateral offsets.
format Preprint
id arxiv_https___arxiv_org_abs_2405_04290
institution arXiv
publishDate 2024
record_format arxiv
spellingShingle Bayesian Simultaneous Localization and Multi-Lane Tracking Using Onboard Sensors and a SD Map
Xia, Yuxuan
Stenborg, Erik
Fu, Junsheng
Hendeby, Gustaf
Robotics
Signal Processing
High-definition map with accurate lane-level information is crucial for autonomous driving, but the creation of these maps is a resource-intensive process. To this end, we present a cost-effective solution to create lane-level roadmaps using only the global navigation satellite system (GNSS) and a camera on customer vehicles. Our proposed solution utilizes a prior standard-definition (SD) map, GNSS measurements, visual odometry, and lane marking edge detection points, to simultaneously estimate the vehicle's 6D pose, its position within a SD map, and also the 3D geometry of traffic lines. This is achieved using a Bayesian simultaneous localization and multi-object tracking filter, where the estimation of traffic lines is formulated as a multiple extended object tracking problem, solved using a trajectory Poisson multi-Bernoulli mixture (TPMBM) filter. In TPMBM filtering, traffic lines are modeled using B-spline trajectories, and each trajectory is parameterized by a sequence of control points. The proposed solution has been evaluated using experimental data collected by a test vehicle driving on highway. Preliminary results show that the traffic line estimates, overlaid on the satellite image, generally align with the lane markings up to some lateral offsets.
title Bayesian Simultaneous Localization and Multi-Lane Tracking Using Onboard Sensors and a SD Map
topic Robotics
Signal Processing
url https://arxiv.org/abs/2405.04290