Abstract:Cooperative localization is still an open problem for autonomous vehicle driving tasks. Generally, there are two essential issues to be handled for multi-vehicle cooperative localization: one is how to use extra information shared by neighbour vehicles to augment ego-vehicle localization; the other is how to handle data sources of various error types used for state estimation, such as nonlinearity, dynamic noises, and correlation which may exist simultaneously. Previous works usually evaluate performance under one of the issues at one time, or they do not perform well under some extreme situations with both of the two types of problems. This paper presents an accurate and robust cooperative localization system with a decentralized framework, which not only takes advantages of inter vehicle relative pose estimation via shared information, but also ensures the performance under data sources of various error types simultaneously. We adopt a state-of-the-art point cloud registration method to obtain the cooperative relative pose estimation using shared information. In addition, we use the adaptive cubature split covariance intersection filter (ACSCIF) to estimate the vehicle state. This algorithm can approximate nonlinearity and deal with dynamic measurement noise by a third-order term using cubature transformation and innovation-based adaptive estimation (IAE) theory, also considering correlations among estimated sources inevitably exists in the decentralized mechanism. Finally, a comparative study based on the CARLA simulation platform demonstrates the potential and advantage of the proposed multi-vehicle cooperative localization system using ACSCIF in terms of accuracy, robustness and efficiency.

Cooperative Field Prediction and Smoothing Via Covariance Intersection

Cooperative and Active Sensing in Mobile Sensor Networks for Scalar Field Mapping

A nonlinear smoother for target tracking in asynchronous wireless sensor networks

Two-dimensional Spatial-Spectrum Estimation of Coherent Signals Without Spatial Smoothing and Eigendecomposition

A Spatiotemporal Prediction Approach for a 3D Thermal Field from Sensor Networks

Spatially-Aware Diffusion Models with Cross-Attention for Global Field Reconstruction with Sparse Observations

Adaptive Spatial Sampling Design for Environmental Field Prediction using Low-Cost Sensing Technologies

Particle-Velocity-Field Difference Smoothing for Coherent Source Localization in Spatially Nonuniform Noise

Smoothing algorithm for multi-sensor fusion with general correlated noises

Distributed Least Squares Algorithm for Continuous-time Stochastic Systems Under Cooperative Excitation Condition

Computation-Aware Kalman Filtering and Smoothing

Resource-Efficient Cooperative Online Scalar Field Mapping via Distributed Sparse Gaussian Process Regression

Batch CI-Based Kalman Smoother for PM2.5 Source Localization

Inverse-Covariance-Intersection-Based Distributed Estimation and Application in Wireless Sensor Network

Accurate Smoothing Methods for State Estimation of Continuous-Discrete Nonlinear Dynamic Systems

E-LMC: Extended Linear Model of Coregionalization for Spatial Field Prediction

Spatial-temporal constrained particle filter for cooperative target tracking

Smoothing Dynamic Systems with State-Dependent Covariance Matrices

Semiparametric Estimation of Cross-covariance Functions for Multivariate Random Fields

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

Unified Principal Component Analysis for Sparse and Dense Functional Data under Spatial Dependency