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

Abstract

The data incest problem causes inter-estimate correlation during data fusion processes, which yields inconsistent data fusion results. Especially in the multi-sensor multi-vehicle (MSMV) system, the data incest problem is serious due to multiple relative position estimations, which not only lead to pessimistic estimation but also cause additional computational overhead. In order to address the data incest problem, we propose a new data fusion method termed the interval split covariance intersection filter (ISCIF). The general consistency of the ISCIF is proven, serving as supplementary proof for the split covariance intersection filter (SCIF). Moreover, a decentralized MSMV localization system including absolute and relative positioning stages is designed. In the absolute positioning stage, each vehicle uses the ISCIF algorithm to update its own position based on absolute measurements. In the relative position stage, the interval constraint propagation (ICP) method is implemented to preprocess multiple relative position estimates and initially prepare input data for ISCIF. Then, the proposed ISCIF algorithm is employed to realize relative positioning. In addition, comparative simulations demonstrate that the proposed method can achieve both accurate and consistent results compared with the state-of-the-art methods.