Enhanced Distributed Cooperative Localization Using Split Covariance Intersection with Bearing Augmentation

Chenxin Tu, Xiaowei Cui, Gang Liu, and Mingquan Lu

Peer Reviewed

Abstract: Distributed cooperative localization (DCL) improves positioning availability for multi-vehicle systems in GNSS-denied or GNSS-degraded environments. Covariance intersection (CI) is commonly used in DCL because it remains consistent under unknown inter-vehicle cross-correlations, but its conservative covariance inflation can be severe in three-dimensional (3-D) scenarios. This paper extends a prior range-based weighted CI (WCI) framework in three aspects. First, split covariance intersection (SCI) is adapted to high-dimensional 3-D DCL by separating locally independent uncertainty from collaboration-induced dependent uncertainty and applying CI scaling only to the dependent part. This decomposition reduces unnecessary inflation and explains why determinant-based SCI (SCI-det) avoids the measurement-rejection behavior observed in determinant-based CI for partially observed high-dimensional states. Second, range measurements are augmented with azimuth and elevation observations from onboard antenna arrays; the resulting body-frame direction constraints strengthen the coupling between relative measurements, attitude, and IMU biases. Third, weighted SCI (WSCI) is evaluated by combining SCI's structural advantage with the physically interpretable weighting matrix from WCI as a task-oriented alternative to determinant-based SCI. Simulation results show that SCI-det provides tighter cooperative fusion than conventional CI criteria, bearing-augmented updates improve overall state estimation, especially for attitude and IMU-bias states, and WSCI achieves performance comparable to SCI-det while improving flexibility and interpretability. Together, the enhanced fusion strategy and measurement augmentation provide a promising solution for accurate and consistent DCL in complex scenarios.
Published in: Proceedings of the 39th International Technical Meeting of the Satellite Division of the Institute of Navigation (ION GNSS+ 2026)
September 14 - 18, 2026
Hyatt Regency Grand Cypress
Orlando, Florida
Pages: 1388 - 1400
Cite this article: Tu, Chenxin, Cui, Xiaowei, Liu, Gang, Lu, Mingquan, "Enhanced Distributed Cooperative Localization Using Split Covariance Intersection with Bearing Augmentation," Proceedings of the 39th International Technical Meeting of the Satellite Division of the Institute of Navigation (ION GNSS+ 2026), Orlando, Florida, September 2026, pp. 1388-1400. https://doi.org/10.33012/2026.20888
Full Paper:

Sign in to download with your ION membership, download credits or subscription, or buy this article.

Sign In Buy this article: $12 for ION members, $35 for non-members
References:
Show 14 references
  1. Analog Devices (2020). Precision MEMS IMU Module ADIS16465 Data Sheet. Analog Devices, Inc. Rev. C.
  2. Carrillo-Arce, L. C., Nerurkar, E. D., Gordillo, J. L., and Roumeliotis, S. I. (2013). Decentralized multi-robot cooperative localization using covariance intersection. In Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), pages 1412-1417. https://doi.org/10.1109/iros.2013.6696534
  3. Chang, T.-K., Chen, K., and Mehta, A. (2022). Resilient and consistent multirobot cooperative localization with covariance intersection. IEEE Trans. Robot., 38(1):197-208. https://doi.org/10.1109/tro.2021.3104965
  4. Julier, S. and Uhlmann, J. K. (2009). General decentralized data fusion with covariance intersection. In Handbook of Multisensor Data Fusion: Theory and Practice. CRC Press, Boca Raton, FL, USA, 2 edition.
  5. Julier, S. J. and Uhlmann, J. K. (1997). A non-divergent estimation algorithm in the presence of unknown correlations. In Proc. Amer. Control Conf. (ACC), volume 4, pages 2369-2373.
  6. Li, H. and Nashashibi, F. (2013). Cooperative multi-vehicle localization using split covariance intersection filter. IEEE Intell. Transp. Syst. Mag., 5(2):33-44.
  7. Li, H., Nashashibi, F., and Yang, M. (2013). Split covariance intersection filter: theory and its application to vehicle localization. IEEE Trans. Intell. Transp. Syst., 14(4):1860-1871.
  8. Li, Y., Zhao, H., Liu, Y., Wang, T., Yu, J., and Shen, Y. (2024). High-accuracy 2-D AoA estimation using lightweight UWB arrays. In Proc. IEEE/RSJ Int. Conf. Intell. Robots Syst. (IROS), pages 3312-3317.
  9. Malajner, M., Planinši?, P., and Gleich, D. (2015). UWB ranging accuracy. In Proc. Int. Conf. Syst., Signals Image Process. (IWSSIP), pages 61-64.
  10. Niu, X., Wu, Y., and Kuang, J. (2021). Wheel-INS: A wheel-mounted MEMS IMU-based dead reckoning system. IEEE Trans. Veh. Technol., 70(10):9814-9825.
  11. Roumeliotis, S. I. and Bekey, G. A. (2002). Distributed multirobot localization. IEEE Trans. Robot. Autom., 18(5):781-795.
  12. Solà, J. (2017). Quaternion kinematics for the error-state Kalman filter. arXiv:1711.02508.
  13. Titterton, D. and Weston, J. L. (2004). Strapdown Inertial Navigation Technology. Institution of Electrical Engineers, Herts, U.K., 2 edition.
  14. Tu, C., Cui, X., Liu, G., and Lu, M. (2025). Weighted covariance intersection for range-based distributed cooperative localization of multi-vehicle systems.