PLoS ONE
Home Adaptive federated filter for multi-sensor nonlinear system with cross-correlated noises
Adaptive federated filter for multi-sensor nonlinear system with cross-correlated noises
Adaptive federated filter for multi-sensor nonlinear system with cross-correlated noises

Competing Interests: The authors have declared that no competing interests exist.

Article Type: research-article Article History
Abstract

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.

Wang,Wang,Yang,and Zhu: Adaptive federated filter for multi-sensor nonlinear system with cross-correlated noises

1. Introduction

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 [13, 7, 8, 1012], 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 [1316]. 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, [1720] 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 [2327] 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 [2830]. 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 [3436] 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.

2. Problem formulation

Considering a class of nonlinear discrete-time stochastic systems with multi-sensors

where k is the discrete sample time index; m = 1,2,…N is the sensor index; xk ϵ Rn and zm,kRpm are the system state and the mth measurement vector at k respectively, where the superscript n is the dimension of the state vector, Pm is the observation vector dimension of the m sensor; fk(∙) and hm,k(∙) are the nonlinear process function and the measurement function of the mth sensor at k respectively; the process noise {wk} and measurement noise {vm,k} are cross-correlated zero-mean Gaussian white noise sequences satisfying E[wkwjT]=Qkδkj, E[vm,kvm,lT]=Rm,kδkl and E[wkvm,lT]=Dm,kδkl, where E denotes the mathematical expectation and δkl is Kronecker delta function. E[wkvm,lT]=Dm,kδkl indicates the cross-correlation between wk and vm,l, only if the time indexes are the same. Note that the cross-correlation noises for the rest of the paper are the same as above. The initial state x0 described by the Gaussian distribution is uncorrelated with {wk} and {vm,k}, and its associated mean and covariance are defined as x^0|0 and P0|0.

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.

3. Design of AFF-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].

where m(x) is a known nonlinear function; N(x;x^,P) is a Gaussian density function with mean x^ and covariance P(P = ssT, and s can be obtained by Cholesky decomposition or singular value decomposition); and B is the number of all points; Λi and Wi are the point generator and weight at i, which can be directly obtained based on the corresponding numerical rule. For example, in the 3rd degree cubature rule, Wi and Λi are defined as follows [40].
where eiRn is a unit vector with the ith element being l, and n is the system state dimension. B is set to be 2n.

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.

3.1 General framework of AFF-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.

where βi = 1/N and βM = 0 are the information distribution coefficients of each local filter and the master filter in fusion-reset mode, respectively, and satisfy i=1Nβi+βM=1. The values of βi and βM are the same as those in [10]. x^i,k|k is the local state estimate, and its associated covariance is Pi,k|k. x^k|kgis the global state estimate and its associated covariance is Pk|kg. The information is distributed between the local filters and the master filter according to the above coefficients.

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, x^i,k|k and Pi,k|k are updated to x^i,k+1|k+1 and Pi,k+1|k+1.

Step 3: Information Fusion.

Since βM equals 0 and βM1Qk approaches infinity, there is no information assigned to the master filter. The global state and its associated covariance are generated as follows

Through the above recursive cycling steps, the approximated global optimal solution of system (1) is obtained.

3.2 Point-based local filter for AFF-CN

In system (1), since wk is correlated with vm,k, and is indirectly correlated with zm,k or Zm,k, E[wk|Zm,k]E[wk]=0. Accordingly, the local state prediction estimates x^m,k+1|k and its error covariance Pm,k+1|k can’t be updated as following.

Therefore, AFF1-CN and AFF2-CN adopt different methods to maintain the information update procedure in their local filters. The details are set out below.

3.2.1 Point-based local filter for AFF1-CN

According to the observation equation in Eq 1 zm,k = hm,k(xk)+vm,k, one can get zm,khm,k(xk)+vm,k = 0, and then Dm,kRm,k1[zm,khm,k(xk)vm,k]=0. Obviously, the substitution of this additional term into the process equation of Eq (1) will not change the original equation relationship in the process equation. By introducing an additional term Dm,kRm,k1[zm,khm,k(xk)vm,k], the state equation in system (1) can be rewritten as follows.

Define Fm,k(xk)=fk(xk)+Dm,kRm,k1(zm,khm,k(xk)) and wm,k=wkDm,kRm,k1vm,k, so Eq 7 is rewritten as follows
where wm,k satisfies E(wm,kwm,jT)=(QkDm,kRm,k1Dm,kT)δkj, E(wm,kvm,jT)=0, and E(wm,k)=0. Therefore, wm,k is zero-mean Gaussian white noise and uncorrelated with vm,k. The fusion system is reconstructed by Eq 8 and the measurement equation of Eq 1, and the problem is transformed into a standard Gaussian filtering problem. The local filters of AFF1-CN can be summarized as follows.

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

    (2) Evaluate the predicted state x^m,k+1|k and its associated covariance Pm,k+1|k.

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

where Sm,k|kSm,k|kT=Pm,k|k, and sm,k|k can be obtained in the same way as s in Eq 2.

    (3) Update

Update the mean and covariance of xk+1.

where the filtering gain Km,k+1=Pm,k+1|kxz(Pm,k+1|kzz)1, and the predicted measurement z^m,k+1|k, the innovation covariance Pm,k+1|kzz and the cross-covariance Pm,k+1|kxz are given by
where the propagated points in Eq 13 are defined as follows
where Sm,k+1|kSm,k+1|kT=Pm,k+1|k, and Sm,k+1|k can be obtained in the same way as sm,k|k.

3.2.2 Point-based local filter for AFF2-CN

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

where the mean w^m,k|k and associated error covariance Pm,k|kww can be estimated as follows
where, z^m,k|k1 and Pm,k|k1zz are as the same as those in Eqs 13 and 14. Based on the above assumption, the point-based local filters for AFF2-CN are formulated as follows

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

    (2) Evaluate the predicted state x^m,k+1|k and Pm,k+1|k.

where

where Pm,k|kxw=Pm,k|k1xz(Pm,k|k1zz)1Dm,kT. Wi and ξm,i,k|k are the same as those in Eq 9.

    (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.

4. Equivalence proof of AFF1-CN and AFF2-CN

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 4Eq 21, the only difference existing between AFF1-CN and AFF2-CN is the estimation computation of the predicted states x^m,k+1|kand its associated error covariance Pm,k+1|k, which are expressed as Eqs 9, 10, 19, 20 respectively. Therefore, the following verification of equivalence focuses on the argument that those Eqs 9 and 10 are equivalent to the Eqs and 20.

Proof. According to the definition of Fm,k(xk) in Eqs 8 and 9 is expanded as follows

where z^m,k|k=Rnhm,k(xk)N(xk;x^m,k|k,Pm,k|k)dxk.

Substitute Eq 18 into Eq 19, one can get

Thus, the verification of the equivalence between Eqs 9 and 19 is transformed into the verification of the equivalence between Eqs 22 and 23. It is obviously that Eqs 17 and 18 in [38] are similar to Eqs 22 and 23. The de-correlating filter is considered to be different from the CGAF in [38], which will be discussed further based on Eqs 22 and 23.

Introducing Lemma 1 in [35], z^m,k|k can be expressed as follows

where Λm,k=hm,k(xk)E[hm,k(xk)|Zm,k1].

Substituting Eq 24 into Eq 22, we have

where I is the identity matrix.

Insert E(Λm,kΛm,kT|Zm,k1)=Pm,k|k1zzRm,k into Eq 25, we can obtain

Thus, Eq 22 is proved to be equivalent to Eq 23, that is to say, Eq 9 is equivalent to Eq 19.

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

where μ=E[f˜k|k(xk)h˜m,k|kT(xk)|Zm,k], and κ=E[h˜m,k|k(xk)h˜m,k|kT(xk)|Zm,k], with f˜k|k(xk)=fk(xk)E[fk(xk)|Zm,k], and h˜m,k|k(xk)=hm,k(xk)E[hm,k(xk)|Zm,k]. Then k is linearized as follows
where Hm,k=hm,k(xk)xk|xk=x^m,k|k, x˜m,k|k=xkx^m,k|k. Insert Eq 28 into Eq 27, we have
According to Eq.(A.6) in [35], we can obtain(Pm,k|k1zz)1=Rm,k1Rm,k1Hm,kPm,k|kHm,kTRm,k1. So Eq 29 can be expressed as follows
where the second and the third items from the right of equal sign satisfy (Dm,kRm,k1μT)T=μRm,k1Dm,kT. Substituting Eqs 18 and 21 into Eq 20, one can obtain
where γ=E[x˜k|kf˜k|kT(xk)|Zm,k]. The second and third terms on the right hand side are interchangeable.

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

Substituting Eq 32 into Eq 30, one can get
The second item on the right of equal sign in Eq 31 is expanded as follows
where Gm,k+1T is the Kalman gain. According to the principle of the Kalman filter, we have Gm,k+1=Pm,k|kHm,kTRm,k1. Inserting it into Eq 34 yields
Consider the mutual transposition items in Eq 31, and substitute Eq 35 into Eq 31 to get
Thus, Eq 20 is proved to be equivalent to Eq 10. Eqs 2236 show that AFF1-CN is equivalent to AFF2-CN. The equivalence between the GASF and de-correlating filters has been proved, and it can be further inferred that AFF1-CN and AFF2-CN is also equivalent to HCFF-CN, since all three are approximated by the five-degree cubature rule.

5. Simulations and analysis

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

where xk=[ξkξ˙kςkς˙k]T, ξk and ςk denote the target positions in X and Y directions; ξ˙k and ς˙k indicate the velocities in the X and Y directions respectively. ξm,r and ςm,r stand for the mth radar sensor positions in X and Y directions. Ω is a known and constant turning rate. Δt is the time interval between two consecutive measurements. The definition of process noise wk and observation noise vm,k is the same as Eq 1, where Qk satisfies
The true initial states together with its associated covariance are defined as follows
where x^0|0N(x0,P0|0). Two radars are used as tracking sensors; Fig 1 indicates the fixed radars positions and the true trajectory throughout 10 sample times.

Target true trajectory (★-radars’ positions).
Fig 1

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

where (ξk+1,ζk+1) is the true position at time k+1, and (ξ^k+1n,ς^k+1n) is the estimated position at k+1 from the nth Monte Carlo run. The RMSE in velocity can be obtained in the way as the RMSE in position.

(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 Rm,k=diag[1600m2200mrad2]. The RMSE results in the position and velocity for Scenario 1 are indicated in Fig 2, where the SGF type, including traditional GF, de-correlating filter, CGAF, and GASF, only uses radar 1 for target tracking.

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

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 [3438] 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.

Table 1
RMSEs of position and velocity in scenario 1.
AlgorithmsGFFAFF1-CNAFF2-CNHCFF-CN
The Mean of Position RMSEs (m)29.203728.580428.652228.4419
The Mean of Velocity RMSEs (m/s)3.94614.02314.00524.0103

(2) Scenario 2

In Scenario 2, let vm,k = bmwk, Rm,k=bmQkbmT, and Dm,k=QkbmT0 [27]. The correlation coefficient bm = [0.06 0.06 0.006 0.006; 0.006 0.006 0.006 0.006]. Dm,k ≠ 0 implies that wk and vm,k are cross-correlated. RMSE results of position and speed within the range of 10s-100s are shown in Fig 3 and Table 2. In Fig 3A, traditional GF and SGFs-CN still only use Radar 1 for target tracking.

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

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

Table 2
RMSEs of position and velocity in scenario 2 (10-100s).
AlgorithmsGFFAFF1-CNAFF2-CNHCFF-CN
The Mean of Position RMSEs (m)0.28730.20270.19430.1984
The Mean of Velocity RMSEs (m/s)1.05700.73070.73490.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.
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.

Table 3
RMSEs of position and velocity in scenario 3 (20-100s).
AlgorithmsGFFAFF1-CNAFF2-CNHCFF-CN
The Mean of Position RMSEs (m)0.36050.32950.33520.3360
The Mean of Velocity RMSEs (m/s)0.89890.67870.70840.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.

6. Conclusion

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.

Acknowledgements

The authors gratefully acknowledge the helpful comments and suggestions of the reviewers, which have improved the presentation.

References

WJiang, YLi, CRizos. Optimal data fusion algorithm for navigation using triple integration of PPP-GNSS, INS, and terrestrial ranging system. IEEE Sensors Journal, 2015, 15(10): 56345644.

KLi, JZhao, XWang, et al Federated ultra-tightly coupled GPS/INS integrated navigation system based on vector tracking for severe jamming environment. IET Radar, Sonar & Navigation, 2016, 10(6): 10301037.

K.W.Zhang; G.Hao; S.L.Sun Weighted Measurement Fusion Particle Filter for Nonlinear Systems with Correlated Noises. Sensors 2018, 18, 3242 10.3390/s18103242

JGuo, XYuan, CHan. Bias change detection-based sensor selection approach for target tracking in large-scale distributed sensor networks. IET Radar, Sonar & Navigation, 2016, 11(1): 3039.

LZhang, SQian, SZhang, et al Federated nonlinear predictive filtering for the gyroless attitude determination system. Advances in Space Research, 2016, 58(9): 16711681.

GDai, LYu, HXu, et al Federated Filter Algorithm with Positioning Technique Based on 3D Sensor. Circuits, Systems, and Signal Processing, 2018, 37(6): 26132628.

X.Gong, J.Zhang An Innovative Transfer Alignment Method Based on Federated Filter for Airborne Distributed Pos, Measurement, 2016, 86, pp. 165181.

N ACarlson. Federated filter for fault-tolerant integrated navigation system. IEEE PLANS ’88. Position Location and Navigation Symposium, IEEE, 1988.

Y.Shi; X.Tang; X.Feng; D.Bian; X.Zhou Hybrid Adaptive Cubature Kalman Filter with Unknown Variance of Measurement Noise. Sensors 2018, 18, 4335 10.3390/s18124335

10 

N. A.Carlson Federated Square Root Filter for Decentralized Parallel Pro-Cessors, IEEE Transactions on Aerospace and Electronic Systems, 1990, 26, (3), 517525.

11 

HGeng, ZWang, YCheng. Distributed Federated Tobit Kalman Filter Fusion Over a Packet-Delaying Network: A Probabilistic Perspective. IEEE Transactions on Signal Processing, 2018, 66(17): 44774489.

12 

ZXing, YXia. Distributed Federated Kalman Filter Fusion Over Multi-Sensor Unreliable Networked Systems. IEEE Transactions on Circuits and Systems I: Regular Papers, 2017, 63(10):17141725.

13 

YZhu, WZheng, DZhou. Quasi-Synchronization of Discrete-Time Lur’e-Type Switched Systems With Parameter Mismatches and Relaxed PDT Constraints. IEEE Transactions on Cybernetics, 2020, 50(5):20262037. 10.1109/TCYB.2019.2930945

14 

YZhu, WZheng. Multiple Lyapunov Functions Analysis Approach for Discrete-Time Switched Piecewise-Affine Systems Under Dwell-Time Constraints, IEEE Transactions on Automatic Control, 2020, 65(5): 21772184.

15 

SWang, LWang, ZQiao, et al Optimal Robust Control of Path Following and Rudder Roll Reduction for a Container Ship in Heavy Waves. Applied Sciences, 2018, 8(9):1631.

16 

LWang, SWang. Concise Robust Control of Marine Engine Speed based on Backstepping and its Fuzzy Comprehension. Complexity. 2019:5823827.

17 

BGao, SGao, GHu, YZhong, CGu. Maximum likelihood principle and moving horizon estimation based adaptive unscented Kalman filter. Aerospace Science and Technology. 2018;73:18496.

18 

BGao, GHu, SGao, YZhong, CGu. Multi-sensor optimal data fusion for INS/GNSS/CNS integration based on unscented Kalman filter. International Journal of Control, Automation and Systems. 2018;16(1):12940.

19 

GHu, BGao, YZhong, CGu. Unscented kalman filter with process noise covariance estimation for vehicular INS/GPS integration system. Information Fusion. 2020;64:194204.

20 

GHu, LNi, BGao, XZhu, WWang, YZhong. Model predictive based unscented Kalman filter for hypersonic vehicle navigation with INS/GNSS integration. IEEE Access. 2019;8:481423.

21 

G.Wang; Z.Gao; Y.Zhang; B.Ma Adaptive Maximum Correntropy Gaussian Filter Based on Variational Bayes. Sensors 2018, 18, 1960 10.3390/s18061960

22 

XSong, XLi, WTang, et al RFID/in-vehicle sensors-integrated vehicle positioning strategy utilising LSSVM and federated UKF in a tunnel. The Journal of Navigation, 2016, 69(4): 845868.

23 

J.Feng, Z.Wang, M.Zeng Distributed Weighted Robust Kalman Filter Fusion for Uncertain Systems with Auto-correlated and Cross-Correlated Noises, Information Fusion, 2013,14(1), 7886.

24 

TTian, SSun, NLi., Multi-sensor information fusion estimators for stochastic uncertain systems with correlated noises. Information Fusion, 2016, 27: 126137.

25 

SSun, TTian, HLin. Optimal linear estimators for systems with finite-step correlated noises and packet dropout compensations. IEEE Transactions on Signal Processing, 2016, 64(21): 56725681.

26 

TTian, SSun, HLin. Distributed fusion filter for multi-sensor systems with finite-step correlated noises. Information Fusion, 2019, 46: 128140.

27 

Q.Ge, D.Xu, and C.Wen, Cubature Information Filters with Correlated Noises and Their Applications in Decentralized Fusion, Signal Processing, 2014, 94, 434444.

28 

YHuang, YZhang, JAChambers. A novel Kullback–Leibler divergence minimization-based adaptive student’s t-filter. IEEE Transactions on signal Processing. 2019;67(20):541732.

29 

YHuang, YZhang, YZhao, JAChambers. A Novel Robust Gaussian–Student’s t Mixture Distribution Based Kalman Filter. IEEE Transactions on signal Processing. 2019;67(13):360620.

30 

YZZWYulong Huang, LiNing, JonathonChambers. A novel robust Student’s t based Kalman filter. IEEE Transactions on Aerospace and Electronic Systems. 2017;53(3):154554.

31 

YHuang, YZhang, NLi, ZShi. Design of Gaussian approximate filter and smoother for nonlinear systems with correlated noises at one epoch apart. Circuits, Systems, and Signal Processing. 2016;35(11):39814008.

32 

YHuang, YZhang, PShi, JChambers. Variational Adaptive Kalman Filter with Gaussian-inverse-Wishart Mixture Distribution. IEEE Transactions on Automatic Control. 2020.

33 

YHuang, FZhu, GJia, YZhang. A Slide Window Variational Adaptive Kalman Filter. IEEE Transactions on Circuits and Systems II: Express Briefs. 2020.

34 

XWang, YLiang, QPan, et al A Gaussian approximation recursive filter for nonlinear systems with correlated noises. Automatica, 2012, 48(9):22902297.

35 

X.Wang, Y.Liang, Q.Pan, Z.Wang General Equivalence between Two Kinds of Noise-Correlation Filters, Automatica, 2014, 50, (12), 33163318.

36 

T.Ardeshiri; E.Ozkan; U.Orguner; F.Gustafsson Approximate Bayesian Smoothing with Unknown Process and Measurement Noise Covariances. IEEE Signal Process. Lett. 2015, 22, 24502454.

37 

Y.L.Huang; Y.G.Zhang; Z.M.Wu; N.Li; J.A.Chambers A novel adaptive Kalman fifilter with inaccurate process and measurement noise covariance matrices. IEEE Trans. Autom. Control 2018, 63, 594601.

38 

Y.Huang, Y.Zhang, X.Wang, and L.Zhao Gaussian Filter for Nonlinear Systems with Correlated Noises at the Same Epoch, Automatica, 2015, 60, 122126.

39 

L.Wang and S.Wang, High Degree Cubature Federated Filter for Multisensor Information Fusion with Correlated Noises, Mathematical Problems in Engineering, 2016.

40 

I.Arasaratnam and S.Haykin, Cubature Kalman Filters, Automatic Control, IEEE Transactions on, 2009, 54, (6), 12541269.

41 

B.Jia, M.Xin, and Y.Cheng, High-Degree Cubature Kalman Filter, Automatica, 2013, 49, (2), 510518.

42 

Y.Fan; Y.Zhang; G.Wang; X.Wang; N.Li Maximum Correntropy Based Unscented Particle Filter for Cooperative Navigation with Heavy-Tailed Measurement Noises. Sensors 2018, 18, 3183 10.3390/s18103183

43 

B.Zheng; P.Fu; B.Li; X.Yuan A Robust Adaptive Unscented Kalman Filter for Nonlinear Estimation with Uncertain Noise Covariance. Sensors 2018, 18, 808 10.3390/s18030808

44 

LYun, SShu, HGang. A Weighted Measurement Fusion Particle Filter for Nonlinear Multisensory Systems Based on Gauss–Hermite Approximation. Sensors, 2017, 17,10,2222.