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.

Cooperative multi-vehicle localization using split covariance intersection filter

Adaptive Cubature Split Covariance Intersection Filter for Multi-Vehicle Cooperative Localization

Multi-Vehicle Cooperative Local Mapping Using Split Covariance Intersection Filter.

Multi-Vehicle Cooperative SLAM Using Iterated Split Covariance Intersection Filter

LiDAR SLAM Based Multivehicle Cooperative Localization Using Iterated Split CIF

Split Covariance Intersection Filter: Theory and Its Application to Vehicle Localization

Cooperative vehicle-infrastructure localization based on the symmetric measurement equation filter

Multiple vehicle cooperative localization with spatial registration based on a probability hypothesis density filter.

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

Interval Split Covariance Intersection Filter: Theory and Its Application to Cooperative Localization in a Multi-Sensor Multi-Vehicle System

Vehicle-Infrastructure Localization Based on the SME Filter

A Collaborative Localization Scheme for Multi-Robot Formation

Multiple Vehicle Cooperative Localization under Random Finite Set Framework

Cooperative Multi-Modal Localization in Connected and Autonomous Vehicles

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

Cooperative Perception with Localization Uncertainty: A Cubature Split Covariance Intersection Framework

Graph Based Vehicle Infrastructure Cooperative Localization

Inertial Navigation System Based Vehicle Temporal Relative Localization with Split Covariance Intersection Filter

A Robust Cooperative Localization Algorithm Based on Covariance Intersection Method for Multi-Robot Systems

Cooperative Vision-based Localization Networks with Communication Constraints

Distributed Invariant Kalman Filter for Object-level Multi-robot Pose SLAM