Cooperative Vehicle Localization in Multi-Sensor Multi-Vehicle Systems Based on an Interval Split Covariance Intersection Filter with Fault Detection and Exclusion

Abstract

In the cooperative multi-sensor multi-vehicle (MSMV) localization domain, the data incest problem yields inconsistent data fusion results, thereby reducing the accuracy of vehicle localization. In order to address this problem, we propose the interval split covariance intersection filter (ISCIF). At first, the proposed ISCIF method is applied to the absolute positioning step. Then, we combine the interval constraint propagation (ICP) method and the proposed ISCIF method to realize relative positioning. Additionally, in order to enhance the robustness of the MSMV localization system, a Kullback–Leibler divergence (KLD)-based fault detection and exclusion (FDE) method is implemented in our system. Three simulations were carried out: Simulation scenarios 1 and 2 aimed to assess the accuracy of the proposed ISCIF with various capabilities of absolute vehicle positioning, while simulation scenario 3 was designed to evaluate the localization performance when faults were present. The simulation results of scenarios 1 and 2 demonstrated that our proposed vehicle localization method reduced the root mean square error (RMSE) by 8.9% and 15.5%, respectively, compared to the conventional split covariance intersection filter (SCIF) method. The simulation results of scenario 3 indicated that the implemented FDE method could effectively reduce the RMSE of vehicles (by about 55%) when faults were present in the system.