Abstract:Accurate vehicle pose is fundamental information required by automated driving systems. However, complicated driving environments and sensor failures have constrained onboard sensor-based single-vehicle localization precision. With the development of cooperative driving automation, the information from surrounding vehicles in the Vehicle-to-Everything (V2V) network offers remarkable potential to boost the ego vehicle’s localization performance. In this paper, we propose a cooperative vehicle localization framework based on multi-sensor fusion that uses shared information from multi-agents, leveraging point cloud feature matching and object detection. The ego vehicle’s detection system can determine the relative pose between the ego vehicle and the corresponding surrounding vehicles based on data from the LiDAR sensor. However, the accuracy of the pose information derived directly from deep-learning-based object detection is limited. Thus, a relative pose refining method is proposed to further improve the relative pose by applying a point cloud matching technique based on a normal distribution transformation approach. Meanwhile, to reduce the data transmission load, we extract only the edge and plane features from the surrounding vehicle’s LiDAR scan and exclude the remaining point cloud. Additionally, the shared information is fused into the ego vehicle’s INS-based localization system, which enables continuous and high-frequency localization output within a Kalman filter framework. To make the fusion algorithm more adaptive to different relative pose noise levels, a measurement quality evaluation rule is designed. Real-world vehicular experiments show that the proposed algorithm can improve localization accuracy by at least 35% compared to the traditional range-based cooperative localization method.

Multiple Models Information Fusion Algorithm for Cooperative Localization

A Robust Localization Approach Using Multi-Sensor Fusion

Bearing Angle Based Cooperative Source Localization

Active and Passive Combined Cooperative Localization Model

MultiRobot Precise Localization Based on Multisensor Fusion.

Cooperative localization using angle-of-arrival information

Simultaneous localization and map building with linear system model.

Cooperative location model under the Nearest Neighbor criterion

Cooperative Localization Algorithm Based on Hybrid Topology Architecture for Multiple Mobile Robot System

Enhanced Multi-sensor Data Fusion Methodology based on Multiple Model Estimation for Integrated Navigation System

Spatial Multi-Source Information Fusion Localization Algorithm in Non-Line-of-Sight Environments

An information fusion algorithm for integrated autonomous orbit determination of navigation satellites

A multi-sensor fusion positioning approach for indoor mobile robot using factor graph

Robust Cooperative Multi-Vehicle Tracking with Inaccurate Self-Localization Based on On-Board Sensors and Inter-Vehicle Communication

Multivehicle 3D Cooperative Positioning Algorithm Based on Information Geometric Probability Fusion of GNSS/Wireless Station Navigation

A Cooperative Relative Localization System for Distributed Multi-Agent Networks

Semi-Interpenetrating Cooperative Localization in Connected Vehicle Networks

Multi-Sensor Fusion for Vehicle-to-Vehicle Cooperative Localization with Object Detection and Point Cloud Matching

Geometric-Manifold-Assisted Distributed Navigation Probabilistic Information Fusion Cooperative Positioning Algorithm

Multi-robot cooperative sensing and localization

Resilient Decentralized Cooperative Localization for Multisource Multirobot System