Cooperative Localization of Connected Vehicles: Integrating GNSS With DSRC Using a Robust Cubature Kalman Filter

Abstract

Cooperative localization of the connected vehicles is significant for many advanced intelligent transportation system (ITS) applications. Vehicle-to-vehicle communication using dedicated short-range communication (DSRC) has great potential to enhance global navigation satellite systems (GNSSs) for the capability of cooperative localization. In the integration of DSRC and GNSS, the tolerance against the unknown and time-varying observation conditions is a key factor to fulfill the requirements of several specific ITS applications. Under a GNSS/DSRC integrated architecture for cooperative localization, a novel robust cubature Kalman filter (CKF) is proposed in this paper to improve the performance of the data fusion under uncertain sensor observation environments. In the proposed solution, the structure of the standard CKF is enhanced using the Huber M-estimation technique, in which the original measurement update in the CKF is modified considering the probable anomalies in state estimation. Furthermore, based on the investigation of the adjustment effect from the constraint factor, an adaptive strategy for this parameter is introduced to optimize the performance comprehensively. The proposed method is validated using a specific simulation system. Results of experiment and simulations demonstrate the capability of improving the robustness and adaptive performance over the original filters under the unknown operation conditions.