Beyond Line-of-Sight: Cooperative Localization Using Vision and V2X Communication

Fuente: arXiv
Guardado en:
Detalles Bibliográficos
Autores principales: Wong, Annika, Tang, Zhiqi, Jiang, Frank J., Johansson, Karl H., Mårtensson, Jonas
Formato: Preprint
Publicado: 2025
Materias:
Acceso en línea:
Etiquetas: Agregar Etiqueta
Sin Etiquetas, Sea el primero en etiquetar este registro!
_version_ 1866918105613074432
author Wong, Annika
Tang, Zhiqi
Jiang, Frank J.
Johansson, Karl H.
Mårtensson, Jonas
author_facet Wong, Annika
Tang, Zhiqi
Jiang, Frank J.
Johansson, Karl H.
Mårtensson, Jonas
contents Accurate and robust localization is critical for the safe operation of Connected and Automated Vehicles (CAVs), especially in complex urban environments where Global Navigation Satellite System (GNSS) signals are unreliable. This paper presents a novel vision-based cooperative localization algorithm that leverages onboard cameras and Vehicle-to-Everything (V2X) communication to enable CAVs to estimate their poses, even in occlusion-heavy scenarios such as busy intersections. In particular, we propose a novel decentralized observer for a group of connected agents that includes landmark agents (static or moving) in the environment with known positions and vehicle agents that need to estimate their poses (both positions and orientations). Assuming that (i) there are at least three landmark agents in the environment, (ii) each vehicle agent can measure its own angular and translational velocities as well as relative bearings to at least three neighboring landmarks or vehicles, and (iii) neighboring vehicles can communicate their pose estimates, each vehicle can estimate its own pose using the proposed decentralized observer. We prove that the origin of the estimation error is locally exponentially stable under the proposed observer, provided that the minimal observability conditions are satisfied. Moreover, we evaluate the proposed approach through experiments with real 1/10th-scale connected vehicles and large-scale simulations, demonstrating its scalability and validating the theoretical guarantees in practical scenarios.
format Preprint
id arxiv_https___arxiv_org_abs_2507_20772
institution arXiv
publishDate 2025
record_format arxiv
spellingShingle Beyond Line-of-Sight: Cooperative Localization Using Vision and V2X Communication
Wong, Annika
Tang, Zhiqi
Jiang, Frank J.
Johansson, Karl H.
Mårtensson, Jonas
Systems and Control
Robotics
Accurate and robust localization is critical for the safe operation of Connected and Automated Vehicles (CAVs), especially in complex urban environments where Global Navigation Satellite System (GNSS) signals are unreliable. This paper presents a novel vision-based cooperative localization algorithm that leverages onboard cameras and Vehicle-to-Everything (V2X) communication to enable CAVs to estimate their poses, even in occlusion-heavy scenarios such as busy intersections. In particular, we propose a novel decentralized observer for a group of connected agents that includes landmark agents (static or moving) in the environment with known positions and vehicle agents that need to estimate their poses (both positions and orientations). Assuming that (i) there are at least three landmark agents in the environment, (ii) each vehicle agent can measure its own angular and translational velocities as well as relative bearings to at least three neighboring landmarks or vehicles, and (iii) neighboring vehicles can communicate their pose estimates, each vehicle can estimate its own pose using the proposed decentralized observer. We prove that the origin of the estimation error is locally exponentially stable under the proposed observer, provided that the minimal observability conditions are satisfied. Moreover, we evaluate the proposed approach through experiments with real 1/10th-scale connected vehicles and large-scale simulations, demonstrating its scalability and validating the theoretical guarantees in practical scenarios.
title Beyond Line-of-Sight: Cooperative Localization Using Vision and V2X Communication
topic Systems and Control
Robotics
url https://arxiv.org/abs/2507.20772