Covariance intersection

Covariance intersection (CI) is an algorithm for combining two or more estimates of state variables in a Kalman filter when the correlation between them is unknown.^[1][2][3][4]

Formulation

Items of information a and b are known and are to be fused into information item c. We know a and b have mean/covariance ${\displaystyle {\hat {a}}}$, ${\displaystyle A}$ and ${\displaystyle {\hat {b}}}$, ${\displaystyle B}$, but the cross correlation is not known. The covariance intersection update gives mean and covariance for c as

${\displaystyle C^{-1}=\omega A^{-1}+(1-\omega )B^{-1}\,,}$

${\displaystyle {\hat {c}}=C(\omega A^{-1}{\hat {a}}+(1-\omega )B^{-1}{\hat {b}})\,.}$

where ω is computed to minimize a selected norm, e.g., the trace, or the logarithm of the determinant. While it is necessary to solve an optimization problem for higher dimensions, closed-form solutions exist for lower dimensions.^[5]

Application

CI can be used in place of the conventional Kalman update equations to ensure that the resulting estimate is conservative, regardless of the correlation between the two estimates, with covariance strictly non-increasing according to the chosen measure. The use of a fixed measure is necessary for rigor to ensure that a sequence of updates does not cause the filtered covariance to increase.^[1][6]

Advantages

According to a recent survey paper ^[7] and,^[8] the covariance intersection has the following advantages:

1. The identification and computation of the cross covariances are completely avoided.
2. It yields a consistent fused estimate, and thus a non-divergent filter is obtained.
3. The accuracy of the fused estimate outperforms each local one.
4. It gives a common upper bound of actual estimation error variances, which has robustness with respect to unknown correlations.

These advantages have been demonstrated in the case of simultaneous localization and mapping (SLAM) involving over a million map features/beacons.^[9]

Motivation

It is widely believed that unknown correlations exist in a diverse range of multi-sensor fusion problems. Neglecting the effects of unknown correlations can result in severe performance degradation, and even divergence. As such, it has attracted and sustained the attention of researchers for decades. However, owing to its intricate, unknown nature, it is not easy to come up with a satisfying scheme to address fusion problems with unknown correlations. If we ignore the correlations, which is the so-called "naive fusion",^[10] it may lead to filter divergence. To compensate this kind of divergence, a common sub-optimal approach is to artificially increase the system noise. However, this heuristic requires considerable expertise and compromises the integrity of the Kalman filter framework.^[11]

References

1. Uhlmann, Jeffrey (1995). Dynamic Map Building and Localization: New Theoretical Foundations (Ph.D. thesis). University of Oxford. S2CID 47808603.
2. Marques, Sonia (12 November 2007). Covariance intersection algorithm for formation flying spacecraft navigation from RF measurements (PDF). 4 ISLAB workshop.
3. Julier, Simon J.; Uhlmann, Jeffrey K. (2007). "Using covariance intersection for SLAM". Robotics and Autonomous Systems. 55 (7): 3–20. CiteSeerX 10.1.1.106.8515. doi:10.1016/j.robot.2006.06.011.
4. Chen, Lingji; Arambel, Pablo O.; Mehra, Raman K. (2002). Fusion under unknown correlation - Covariance intersection as a special case (PDF). International Conference on Information Fusion 2002.
5. Reinhardt, Marc; Noack, Benjamin; Hanebeck, Uwe D. (2012). Closed-form Optimization of Covariance Intersection for Low-dimensional Matrices (PDF). International Conference on Information Fusion 2012.
6. Uhlmann, Jeffrey (2003). "Covariance Consistency Methods for Fault-Tolerant Distributed Data Fusion" (PDF). 4. Elsevier: 201–215. {{cite journal}}: Cite journal requires |journal= (help)
7. Wangyan Li, Zidong Wang, Guoliang Wei, Lifeng Ma, Jun Hu, and Derui Ding. "A Survey on Multi-Sensor Fusion and Consensus Filtering for Sensor Networks." Discrete Dynamics in Nature and Society, vol. 2015, Article ID 683701, 12 pages, 2015.
8. Deng, Zili; Zhang, Peng; Qi, Wenjuan; Liu, Jinfang; Gao, Yuan (2012-04-15). "Sequential covariance intersection fusion Kalman filter". Information Sciences. 189: 293–309. doi:10.1016/j.ins.2011.11.038.
9. Julier, S.; Uhlmann, J. (2001). Building a Million-Beacon Map. Proceedings of ISAM Conference on Intelligent Systems for Manufacturing. doi:10.1117/12.444158.
10. Chang, K.C.; Chong, Chee-Yee; Mori, S. (2010-10-01). "Analytical and Computational Evaluation of Scalable Distributed Fusion Algorithms". IEEE Transactions on Aerospace and Electronic Systems. 46 (4): 2022–2034. Bibcode:2010ITAES..46.2022C. doi:10.1109/TAES.2010.5595611. ISSN 0018-9251. S2CID 46201683.
11. Niehsen, W. (2002-07-01). "Information fusion based on fast covariance intersection filtering". Proceedings of the Fifth International Conference on Information Fusion. FUSION 2002. (IEEE Cat.No.02EX5997). Vol. 2. pp. 901–904 vol.2. doi:10.1109/ICIF.2002.1020907. ISBN 978-0-9721844-1-0. S2CID 122743543.