Competing Interests: The authors have declared that no competing interests exist.
This paper presents an adaptive approach to the federated filter for multi-sensor nonlinear systems with cross-correlations between process noise and local measurement noise. The adaptive Gaussian filter is used as the local filter of the federated filter for the first time, which overcomes the performance degradation caused by the cross-correlated noises. Two kinds of adaptive federated filters are proposed, one uses a de-correlation framework as local filter, and the subfilter of the other one is defined as a Gaussian filter with correlated noises at the same-epoch, and much effort is made to verify the theoretical equivalence of the two algorithms in the nonlinear fusion system. Simulation results show that the proposed algorithms are superior to the traditional federated filter and Gaussian filter with same-paced correlated noises, and the equivalence between the proposed algorithms and high degree cubature federated filter is also demonstrated.
Federated filters (FF) have been successfully used in a wide range of areas, including integrated navigation [1, 2], multi-sensor target tracking [3, 4], gyro-less attitude determination [5], motion capture in virtual reality [6], airborne position & orientation [7] and so on, which have advantages of good real-time, simple structure and high fault-tolerant capability [8]. The original FF proposed by Calson was designed for linear decentralized navigation systems [9, 10]. With the increasing complexity of application systems and environments, many improved FF have been developed for different practical problems. An improved Tobit regression model is applied to the traditional FF framework to form a distributed federated Tobit Kalman filter for censoring and packet delay of a class of discrete time systems [11]. A distributed federated Kalman filter with finite length buffer is proposed to deal with measurement delay or loss for a class of multi-sensor unreliable networked systems with uncorrelated noises [12]. In [1–3, 7, 8, 10–12], the dynamic and measurement models of the system are linear, so the proposed FF adopts the linear Kalman filter (KF) as the local filter. However, the nonlinear problem is often unavoidable in practical systems, and the performance of linear KF is obviously unable to meet the requirements [13–16]. To solve such problems, the information fusion algorithm must be based on the nonlinear fusion mechanism. For example, in order to solve the filtering precision decline and instability problem caused by various factors in the practical application of the integrated navigation system based on the nonlinear model, [17–20] proposed several solutions based on the unscented Kalman filter. Therefore, it is necessary to adopt nonlinear filter as local filter to study federated filter. Different federated UKF are designed for pulsar/CNS satellite integrated autonomous navigation system and vehicle fusion positioning system [21, 22]. A federated nonlinear predictive filtering method is proposed for the gyroless attitude determination system with star sensors and GPS sensors, which combines the nonlinear predictive filtering with the traditional FF [5].
Measurement noise and process noise in existing nonlinear federated filters (NFF) are generally considered to be statistically independent [4, 8, 21]. However, according to the research experience of a single sensor system, the cross-correlation between process noise and measurement noise is an important factor that leads to the degradation of filtering performance, which also exists in multi-sensor system. In practical application, the problem of noise cross-correlation always exists. For example, in a target tracking system, there would be some cross-correlation between the process and measurement noises if both of them are dependent on the system state [23]. Also, discretization on real continuous fusion systems may cause the cross-correlation to the process and measurement noises [24]. Several fusion filtering algorithms have been brought up to alleviate the negative effects of noise correlation in multi-sensor systems. For a class of uncertain multi-sensor systems with autocorrelation and cross-correlation noises, a distributed weighted robust fusion filter is constructed by using the optimal robust Kalman local filter [23]. The problem of information fusion estimation for multi-sensor stochastic uncertain systems with correlated noises is presented in [24], in which the process and observation noises are one-step auto-correlated and two-step cross-correlated respectively, while the observation noises of different sensors are one-step cross-correlated. Based on the optimal local filter in [25], a distributed fusion filter for multi-sensor systems with finite-step correlated noises is proposed, in which process noise and observation noise at different sensors are finite-step auto-correlated and cross-correlated respectively [26]. Decentralized cubic Kalman fusion filters are proposed for nonlinear fusion systems with one-step cross-correlations between the process noise and measurement noise and synchronized cross-correlations among each measurement noise [27]. However, it can be seen from [23–27] that the aforementioned algorithms are designed for stochastic uncertain systems with cross-correlated noise or auto-correlated noise. The time-varying state transition matrix and measurement matrix in these system equations are linear with the system state, so these improved fusion algorithms still belong to the category of linear fusion algorithms in a sense. The fusion algorithm proposed in [27] is designed for nonlinear multi-sensor system, but it is mainly used to overcome the one-step correlation between the process and measurement noises, and the correlations between different sensor noises. To the best of the authors’ knowledge, few studies have been done on multi-sensor systems with the same-paced cross-correlation between process and measurement noise.
In a single sensor system, the problem of filtering under non-standard noise has always been the focus of researchers. An improved adaptive student’s t-filter for the filtering of the linear system in the context of independent non-Gaussian heavy-tailed noise was proposed in [28–30]. A pseudo-measurement noise was constructed to form a pseudo-observation equation for the filtering of one-step related noise in nonlinear systems, and on this basis, new Gaussian approximation filters and smoothers are derived [31]. A novel adaptive Kalman filter based on Variational Bayesian method and Gauss-Inverse-Wishart mixture distribution was proposed for the linear system filtering problem with unknown system state and observed noise covariance matrix [32]. Reference [33] further improved the above filter based on the approximation of slide Window State Vectors based on the work in reference [32]. Nonlinear filtering under cross-correlation noise has become an important branch of filtering under non-standard noise. There are two main solutions, one is de-correlating the noise sequences by reconstructing a new pseudo process noise sequence and a new process function [34–36] the other method is to use a Gaussian approximation recursive filter (GASF) for same-paced cross-correlated noise, which adopts the Gaussian approximation to the two-step state posterior predictive probability density function (PDF) and the one-step measurement posterior predictive PDF [34]. The equivalence of the above two methods in linear and nonlinear systems has been proved theoretically [35, 36], but there is a narrow performance gap between them [37]. It should be noted that the performance of these two filters is not satisfactory when applied to nonlinear systems. Accordingly, another general framework of the correlated Gaussian approximated filter (CGAF) for same-paced correlated noises is established by introducing the Gaussian approximation of the conditional PDF of the process noises [38].
Given the feasibility of the above solutions in single-sensor systems, it can be inferred that their applications in traditional NFF frameworks should have similar effectiveness. However, until now, only GASF has been successfully used as a local filter of high degree cubature federated filter for cross-correlated noises (HCFF-CN) [39]. Therefore, it’s worth discussing whether the de-correlating filter and CGAF are suitable to modify the NFF. Furthermore, if they are appropriate, what is the difference between their applications? Inspired by previous research and above problems, two improved adaptive federated filters for cross-correlated noises (AFF-CN) are proposed.
The rest of the article is organized as follows: Section 2 formulates the investigated problem. Section 3 is devoted to systematic procedures for two kinds of AFF-CN. Section 4 provides theoretical equivalence of the two algorithms in the nonlinear fusion system. In Section 5, simulation results and discussion are presented. Section 6 draws the conclusion.
Considering a class of nonlinear discrete-time stochastic systems with multi-sensors

Assumption 1: The fk(∙) and hm,k(∙) are known, and the state xk is bounded.
As mentioned above, the traditional NFF method is not suitable for the nonlinear fusion system described in Eq 1, so an evolutionary filter HCFF-CN is proposed to solve such problem. However, there are still some defects that limit its further application.
Assumption 2: The previous measurements satisfy Zm,k-1 = {zm,i,i = 1,⋯,k-1}. Both the two-step predictive conditional PDF of the state p(xk+1|Zm,k-1) and the one step predictive conditional PDF of the measurements p(zk|Zm,k-1) conform to the Gaussian distribution. HCFF-CN inherits a disadvantage from cubature Kalman filter (CKF), that is, it is easy to lose the positive definiteness of system state error covariance in its cycle steps and make the filter stop running continuously.
Considering the above limitations and assumptions, two kinds of AFF-CN are proposed to supplement and extend HCFF-CN.
In general, the nonlinear filter assumes that the state, process and measurement noise all conform to the Gaussian distribution, and the statistical characteristics of the corresponding Gaussian PDFs are obtained by using the multivariate Gauss integral. Because Gaussian integrals are often unanalytical, some point-based numerical rules are applied to approximate these integrals. So The Gaussian integrals with respect to the Gaussian density function are usually approximated as follows [40, 41].


According to Eqs 2 and 3, introducing different point-based numerical rules in the framework of the Gaussian filter leads to different nonlinear Gaussian approximation filters. For instance, the unscented transformation (UT) gives rise to the unscented Kalman filter (UKF), and the Gauss–Hermite quadrature rule brings about the Gauss–Hermite Kalman filter [42, 43]. Accordingly, a special kind of single Gaussian filter (SGF), called point-based nonlinear filter (PNF), is established. Each PNF has its own usage. For example, UKF is applicable to low dimensions systems (n≤3), while the 3rd degree CKF is suitable for higher dimension systems (n>3) [44].
In order to make the proposed filter have all the advantages of PNF, one derives the point-based AFF-CN, whose local filters are expressed as the universal framework of the PNF. Therefore, AFF-CN can select the most appropriate point-based numerical approximation rule according to the actual application. Later in this section, the general framework of AFF-CN is firstly described, and then, by virtue of the de-correlating filter and CGAF, two kinds of local filters are derived respectively. Furthermore, the algorithm with de-correlating filter as local filter is labeled AFF1-CN, and the other one using CGAF as subfilter is named AFF2-CN.
The general architecture of the AFF-CN is similar to that of the traditional FF except for their local filters. To counteract the negative impact on the global approximated optimality caused by the nonlinear local filter, the fusion-reset mode is still used. The procedure of the AFF-CN can be described as the following steps.
Step 1: Information Distribution.

Step 2: Information Update.
To account for the value of βi, the information update step, which consists of prediction and update steps, is performed in each local filter. Through this step,
Step 3: Information Fusion.
Since βM equals 0 and

In system (1), since wk is correlated with vm,k, and is indirectly correlated with zm,k or Zm,k,

According to the observation equation in Eq 1
zm,k = hm,k(xk)+vm,k, one can get zm,k—hm,k(xk)+vm,k = 0, and then


(1) The mean and covariance of the initial state x0 are known.
(2) Evaluate the predicted state


The transformed points in Eqs 9 and 10 are defined as follows.

(3) Update
Update the mean and covariance of xk+1.





The process noises wk in Eq 1 is the zero-mean Gaussian white noise with covariance Qk and uncorrelated with Zm,k−1, the conditional PDF p(wk|Zm,k) of wk is presumed to follow the Gaussian distribution, which is defined as follows


(1) The mean and covariance of the initial state x0 are known.
(2) Evaluate the predicted state


where

(3) Update
The updated step is identical with that in the local filters of AFF1-CN.
In summary, before local filtering, the AFF1-CN de-correlates the process and measurement noises. And in the AFF2-CN, the posterior PDF of wk is considered to follow the Gaussian distribution, and the maximum a posteriori estimate (MAP) is used to estimate wk. Therefore, two point-based AFF-CN are established, which can introduce any suitable point-based numerical approximation rules.
The local filters of AFF1-CN and HCFF-CN use the de-correlating filtering framework and the correlated recursive Gaussian approximated filtering framework, respectively [34, 39]. In [35, 36], the theoretical equivalence had already been proved between the de-correlating filtering framework and GASF for linear and nonlinear systems, which means that AFF1-CN is equivalent to HCFF-CN when it is approximated for the five-degree cubature rule. Can it be inferred that AFF1-CN and AFF2-CN also have the theoretical equivalence? This is a problem to be solved in this section. Obviously, from Eq 4–Eq 21, the only difference existing between AFF1-CN and AFF2-CN is the estimation computation of the predicted states
Proof. According to the definition of Fm,k(xk) in Eqs 8 and 9 is expanded as follows

Substitute Eq 18 into Eq 19, one can get

Introducing Lemma 1 in [35],

Substituting Eq 24 into Eq 22, we have

Insert

According to the definition of Fm,k(xk), Eq 10 is expanded as follows





By comparing Eqs 30 and 31, we can find that the second and third terms on the right side of the equal sign are different. Firstly, according to the definition of μ, the second item on the right of equal sign of Eq 30 is expanded as following





In this section, maneuvering target tracking simulations are performed to test the effectiveness of the proposed filters, compared with the traditional GFF and HCFF-CN. The Gaussian weighted integrals of all filters are approximated by the fifth-degree cubature rule in [41]. Furthermore, the proposed filters and SGFS-CN are compared to analyze the positive effect of fusion on AFFs-CN performance.
A classic maneuvering target tracking problem is considered, which performs maneuvering turns on the horizontal plane at a constant turning rate [40, 41]. The turning motion and measurement model can be generalized as follows





Target true trajectory (★-radars’ positions).
For fair comparisons, independent Monte Carlo tests run 50 (L) times. The total number of scans per run is 100. All the filters are initialized in the same way each run. To compare different nonlinear filters’ performance, the metric are defined to be the root mean square error (RMSE). For example, the RMSE in position at time k+1 is defined as

(1) Scenario 1
In Scenario 1, let Dm,k = 0, which implies that wk and vm,k are uncorrelated with each other. The covariance of vm,k satisfies


RMSEs of position and velocity in scenario 1: (a) single filter; (b) fusion filter.
As shown in Fig 2A, the position and velocity RMSE curves of each Gaussian filter involved almost coincide. That is to say, in this case, they have almost the same tracking accuracy. Therefore, the research results in [34–38] are considered to be repeated. In addition, by comparing RMSE curves in Fig 2A and 2B, it can be seen that AFF1-CN and AFF2-CN can improve the tracking accuracy of corresponding de-correlation filter and CGAF. It can be deduced that AFF1-CN and AFF2-CN can fuse the tracking data of Radar 1 and Radar 2, rather than just a radar sensor. Comparing the results in Fig 2B, it can be seen that the RMSE curves of AFF1-CN, AFF2-CN, GFF and HCFF-CN are very close, which is supported by the results in Table 1. Therefore, it can be concluded that in the case of no correlation between process noise and measurement noise, the performance of the two filters proposed is almost as good as the traditional GFF and HCFF-CN filters, and better than the SGFs-CN filters.

| Algorithms | GFF | AFF1-CN | AFF2-CN | HCFF-CN |
|---|---|---|---|---|
| The Mean of Position RMSEs (m) | 29.2037 | 28.5804 | 28.6522 | 28.4419 |
| The Mean of Velocity RMSEs (m/s) | 3.9461 | 4.0231 | 4.0052 | 4.0103 |
(2) Scenario 2
In Scenario 2, let vm,k = bmwk,


RMSEs of position and velocity in scenario 2: (a) single filter; (b) fusion filter.

| Algorithms | GFF | AFF1-CN | AFF2-CN | HCFF-CN |
|---|---|---|---|---|
| The Mean of Position RMSEs (m) | 0.2873 | 0.2027 | 0.1943 | 0.1984 |
| The Mean of Velocity RMSEs (m/s) | 1.0570 | 0.7307 | 0.7349 | 0.7385 |
It can be inferred from Fig 3A that when the process and measurement noises are cross- correlated, the de-correlating filter, CGAF, and GASF can improve the accuracy of the traditional GF. By comparing Fig 3A and 3B, it can be seen that the tracking accuracy of AFF1-CN and AFF2-CN remains superior to the corresponding SGF types for the same reason as in Scenario 1. As shown in Fig 3B, AFF1-CN and AFF2-CN can achieve the better position and velocity accuracy than traditional GFF. In addition, the position and velocity tracking accuracy of AFF1-CN, AFF2-CN, and HCFF-CN keep very close, which is also supported by the result in Table 2. The AFF2-CN has the best position tracking accuracy and AFF1-CN has the best velocity tracking accuracy. Therefore, the proposed AFF1-CN and AFF2-CN achieve better tracking performance than the traditional GFF and SGFs, and similar performance to HCFF-CN.
(3) Scenario 3
Considering in a practical multi-radar tracking system, the cross-correlations between each local measurement noise and process noise are different. The correlation coefficients bm of both radars are set as b1/0.006 = [10 10 1 1; 1 1 1 1] and b2/0.003 = [10 10 10 1; 1 1 10 1] respectively. Accordingly, the vm,k, Rm,k and Dm,k in each local filter are also different. In this Scenario, only the performance of GFF, AFFs-CN and HCFF-CN are compared. The position and velocity RMSE results are shown in Fig 4.


RMSEs of position and velocity in scenario 3.
Judging from Fig 4 and Table 3, the position and speed tracking performance of the four filters is very good, among which GFF tracking RMSE is still slightly higher than other filters. The RMSE results of AFFs-CN and HCFF-CN are hard to distinguish just as in Scenario 2. Only the data in Table 3 show some differences between the two. Therefore, the same conclusion can be drawn as Scenario 2.

| Algorithms | GFF | AFF1-CN | AFF2-CN | HCFF-CN |
|---|---|---|---|---|
| The Mean of Position RMSEs (m) | 0.3605 | 0.3295 | 0.3352 | 0.3360 |
| The Mean of Velocity RMSEs (m/s) | 0.8989 | 0.6787 | 0.7084 | 0.7085 |
Remark 1: Although the above results show that AFF1-CN, AFF2-CN and HCFF-CN are equivalent, the assumptions of the three filters are different. So we can choose the most appropriate filter according to the practical initial conditions.
To adapt the traditional FF to the nonlinear discrete dynamic stochastic system with cross-correlative noises, two AFFs-CN are proposed based on the de-correlating filter and CGAF. These two filters are suitable for both white noise independent system and noise cross-correlation system, and the theoretical equivalence of the two algorithms in the nonlinear fusion system has been verified. The simulation results show that AFFs-CN have almost the same performance as GFF and HCFF-CN, and AFFs-CN achieve better performance than SGF in the case of no correlation between measuring noise and dealing with noise, and AFFs-CN have superior accuracy and robustness than GFF and SGFs when the measurement noise and process noise are cross-correlated. The future work will focus on the nonlinear federated filter with auto-correlated noises.
The authors gratefully acknowledge the helpful comments and suggestions of the reviewers, which have improved the presentation.
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44