Covariance intersection in nonlinear estimation based on pseudo Gaussian densities

Many modern fusion architectures are designed to process and fuse data in networked systems. Alongside the advantages, such as scalability and robustness, distributed fusion techniques particularly have to tackle the problem of dependencies between locally processed data. In linear estimation problems, uncertain quantities with unknown cross-correlations can be fused by means of the covariance intersection algorithm, which avoids overconfident fusion results. However, for nonlinear system dynamics and sensor models perturbed by arbitrary noise, it is not only a problem to characterize and parameterize dependencies between estimates, but also to find a proper notion of consistency. This paper addresses these issues by transforming the state estimates to a different state space, where the corresponding densities are Gaussian and only linear dependencies between estimates, i.e., correlations, can arise. These pseudo Gaussian densities then allow the notion of covariance consistency to be used in distributed nonlinear state estimation.