Abstract

A direct approach of designing weighted fusion robust steady-state Kalman filters with uncertain noise variances is presented. Based on the steady-state Kalman filtering theory, using the minimax robust estimation principle and the unbiased linear minimum variance (ULMV) optimal estimation rule, the six robust weighted fusion steady-state Kalman filters are designed based on the worst-case conservative system with the conservative upper bounds of noise variances. The actual filtering error variances of each fuser are guaranteed to have a minimal upper bound for all admissible uncertainties of noise variances. A Lyapunov equation method for robustness analysis is proposed. Their robust accuracy relations are proved. A simulation example verifies their robustness and accuracy relations.

1. Introduction

The multisensor information fusion (multisource information fusion or multisensor data fusion) has been applied widely in many fields including guidance, defense, robotics, target tracking, signal processing, GPS positioning, unmanned aerial vehicle (UAV), communication, command, control, computer, and intelligent systems (C4I) and has attracted significant interest in recent years. Over the past two decades, many fused Kalman filtering algorithms have been developed to handle the state and signal estimation problems for the multisensor systems. The aim is how to combine the local estimators or local measurements obtained from each sensor to obtain a fused estimator, whose accuracy is higher than that of each local estimator [1]. The basic fused filtering algorithms include the centralized and distributed algorithms depending on whether the measurements’ information is directly communicated to the fusion center or not [2]. For the centralized fusion algorithm, all the measurement data from local sensor are carried to the fusion center which can give the globally optimal fused state estimation, but its disadvantage is requiring a larger computation and communication burden. The distributed fusion algorithms can give the globally optimal or suboptimal state estimation by combing or weighting the local state estimators, whose advantages are that they can reduce the communication burden, and is more robust and reliable, and also has stronger fault tolerance. Under the ULMV rule, there are three optimal distributed fusion algorithms weighted by matrices, diagonal matrices, and scalars, respectively [35]. The optimal weighted measurement fusion algorithms can give the global optimal state estimation by weighting the local measurements to obtain a fusion measurement equation, accompanied with the state equation; based on a single Kalman filter, two optimal weighted measurements fusion algorithms were presented in [68].

The classical Kalman filtering is only suitable to handle the state estimation problems for the systems that the model parameters and noises variances are precisely known. However, in many application problems, the uncertainties of model parameters and noise variances are widely found. In the presence of uncertainties, the filter performance is degraded and may yield the filter divergence. In order to solve the filtering problems for uncertain systems, in recent years, several results have been derived on the design of robust Kalman filters. The so-called robust Kalman filtering is to design a filter to guarantee a minimal upper bound of the actual filtering error variances for all admissible uncertainties. There are two basic approaches to solve this problem, which are the Riccati equation approach [915] and the linear matrix inequality (LMI) approach [1620]. These two methods have been applied to design the robust Kalman filter for uncertain systems with the uncertainties of model parameters [920], where the noise variances are assumed to be exactly known. However, the design of the robust Kalman filters with uncertain noise variances is seldom reported [2124].

Several robust Kalman filters only consider the stochastic systems with single sensor, while the design of the multisensor information fusion robust Kalman filters is seldom considered and the robustness of the fused Kalman filters was not proved [2527].

The robust Kalman filters design includes the finite-horizon (time-varying) robust Kalman filters design and the infinite-horizon (steady-state) robust Kalman filters design. The steady-state robust Kalman filters can be designed by taking the limits for the time-varying robust Kalman filters [9, 10, 14], and this is called the indirect design method. However, it is seldom reported that applying the steady-state Kalman filtering theory can directly design the steady-state robust Kalman filters, and this is called the direct design method.

For the systems with uncertain model parameters and/or noise variances, the covariance intersection (CI) fusion robust filtering method was presented in [2831]. Its basic principle is that the robust CI fusion filter can be obtained by the convex combination of the robust local filters. Its advantage is that the cross-covariance of the local filtering errors is avoided, and it is suitable to handle the systems with unknown cross-covariance. Its disadvantage is that the local robust filters are assumed to be known, and the upper bound of the actual fused estimates has larger conservativeness because the information of cross-covariance is ignored. The geometric principle of the CI fusion is that the variance ellipse of the upper bound of actual fusion estimation error variance tightly encloses the intersection region of all variances ellipses of the upper bounds of actual local estimation error variances [32]. Recently, the ellipsoidal intersection (EI) fusion method with the cross-covariance information was presented in [33], which improves the robust accuracy of the CI fusion estimate. The comparison of the CI fusion method with several weighted fusion methods was given in [5]. The CI fusion method has been applied to many fields including remote sensing [34], simultaneous localization and mapping (SLAM) [35], rocket tracking and prediction [36], and vehicle localization [37].

Recently, the robust weighted fusion Kalman filters for multisensor time-varying systems with uncertain noise variances were presented by our team in [24], where the Lyapunov equation method of designing robust Kalman filters, the five robust weighted fusion time-varying Kalman filters based on the minimax robust estimation principle, and the concept of robust accuracy have been presented. By taking the limits for the time-varying robust weighted fusion Kalman filters, the corresponding robust steady-state Kalman filters have been also presented. However, based on the steady-state Kalman filtering theory, the problem to design directly the robust steady-state Kalman filters is not solved, and, based on the cross-covariance information, the problem to reduce the conservativeness of the upper bound of the CI fusion estimate is not solved. In addition, only one robust weighted measurement fuser was presented in [24].

In this paper, based on the steady-state Kalman filtering theory [38, 39], for the multisensor time-invariant system with noise variances uncertainties, using the minimax robust estimation principle, for the worst-case conservative system with the conservative upper bound of noise variances, three weighted state fusion robust steady-state Kalman filters will be presented. In order to improve the robust accuracy of the CI fuser and to reduce its conservativeness, a modified robust CI fuser with the cross-covariance information will be presented. In addition, two weighted measurement fusion robust steady-state Kalman filters will be presented. The proposed robust weighted fusion steady-state Kalman filtering approach is different from that in [24]. Our approach avoids finding the time-varying robust weighted fusers and their limits.

Finally, the robustness of the local and weighting fused robust Kalman filters is proved based on the Lyapunov equation method, which is completely different from the Riccati equation method and LMI method [920]. Their robust accuracy relations are strictly proved. In order to verify the correctness of theoretical accuracy relations, a Monte-Carlo simulation example for a three-sensor tracking system with uncertain noise variances is given.

The remainder of the paper is organized as follows. The problem formulation is given in Section 2. The local robust steady-state Kalman filters and their robustness analysis are presented in Section 3. Six weighted fusion robust steady-state Kalman filters and their robustness analysis are proposed in Section 4. The comparison of the robust accuracies of the local and fused robust Kalman filters is given in Section 5. Section 6 gives a simulation example. The conclusions are presented in Section 7.

2. Problem Formulation

Consider the multisensor time-invariant system with uncertain noise variances where is the discrete time, is the state to be estimated, is the number of sensors, and are the measurement and measurement noise of the subsystem, and is the input noise. , , and are known constant matrices with appropriate dimensions.

Assumption 1. and are uncorrelated white noises with zero mean and unknown uncertain actual variances and , and and are known conservative upper bounds of and , respectively; that is, in the sense that means that is a positive semidefinite matrix.

Assumption 2. is a completely controllable pair and is a completely observable pair.
The problem is to design the local or fused robust steady-state Kalman filter such that the variances of actual filtering errors are guaranteed to have a minimal upper bound for all admissible uncertain noise variances and satisfying (3); that is, the actual filtering error variance satisfies where is the mathematical expectation operator and the superscript is the transpose.

Definition 3. The measurements generated from the systems (1) and (2) with unknown actual noise variances and , , are called the actual measurements , which are obtained via the sensors, and are available (known).

Definition 4. The measurements generated from the systems (1) and (2) with the conservative upper bounds and of noise variances are called the conservative measurement which are unavailable (unknown).

Definition 5. The Kalman filters with conservative measurements are called the conservative Kalman filter which is unrealizable. The Kalman filters with the actual measurements are called the actual Kalman filters.

3. Local Robust Steady-State Kalman Filters

According to the minimax robust optimal estimation principle [40], consider the worst-case conservative systems (1) and (2) with Assumptions 12 and with the conservative upper bounds and of noise variances; the conservative local steady-state Kalman filters are given as [38, 39] where is an identity matrix, is a stable matrix, and is the steady-state filtering gain matrix. Here, the measurements are unavailable as in Definition 4.

The conservative one-step prediction error variances satisfy the Riccati equations

The conservative local steady-state filtering error variances satisfy the Lyapunov equations and the conservative local steady-state filtering error cross-covariances also satisfy the Lyapunov equations [4]

Notice that the conservative local Kalman filters (5) are unrealizable, because the conservative measurements given in Definition 4 are unavailable. Only the actual measurements measured via sensors are available, which are generated from systems (1) and (2) with the actual noise variances and . Therefore, replacing the conservative measurements with the actual measurements in (5), we obtain the actual local Kalman filters .

Define the actual local steady-state filtering error variance as Substituting (1) and (5) into , we obtain that Substituting the actual measurements (2) into (11) yields Substituting (12) into (10) yields the actual steady-state filtering error variances as Applying (12), the actual steady-state filtering error cross-covariances are obtained as

Lemma 6 (see [38]). Consider the Lyapunov equation with being a symmetric matrix,
If is a stable matrix (all its eigenvalues are inside the unit circle) and , then is unique and symmetric and .

Theorem 7. Formultisensor uncertainsystems (1) and (2) with Assumptions 12, the actual local Kalman filters (5) with conservative upper bounds and of noise variances are robust in the sense that, for all admissible actual variances and satisfying (3), one has and they are called the local robust steady-state Kalman filters, and is the minimal upper bound of .

Proof. Defining , subtracting (13) from (8) yields the Lyapunov equation where
Applying (3) and (18) yields , and noting that is a stable matrix and applying Lemma 6, we have ; that is holds. Taking , then the constraints (3) are satisfied, and . Applying Lemma 6 to (17) yields ; that is, . For arbitrary other upper bound , we have , which yields that is the minimal upper bound of . The proof is completed.

4. Weighted Fusion Robust Steady-State Kalman Filters

4.1. Four Robust Weighted State Fusion Steady-State Kalman Filters

For the worst-case conservative multisensor systems (1) and (2) with Assumptions 12, and with conservative upper bounds and , under the ULMV fusion rule, the four conservative steady-state optimal weighted fusion Kalman filters are given by [35] with the constraint of unbiasedness where and CI denote the fusers weighted by matrices, scalars, diagonal matrices, and the CI fuser, respectively.

The optimal weighted matrices are computed as [35] with the definition .

The conservative fused filtering error variance is given as The optimal scalars weights are computed as where and the matrix is defined as where denotes the trace of . The conservative fused error variance is given as The optimal diagonal matrix weights are computed as where is the diagonal element of .

The conservative fused error variance is given as The CI fusion weights are computed as [5, 31, 32]

The optimal weighting coefficients are obtained by minimizing the performance index

This needs to solve L-dimension nonlinear convex optimization problem, which can be solved by “fmincon” function in MATLAB toolbox.

Define From (20), we have Subtracting (19) from (34) yields the conservative fused filtering errors as Applying (34) and (35) yields the conservative fused filtering error variances having a unified form with defined in (22). Replacing the conservative local Kalman filters in (19) by the actual local Kalman filters , we obtain the actual weighted fusion Kalman filters.

Define the actual weighted fusion filtering error variance as where and is the actual fused filters (19) with being the actual local Kalman filters. From (35) and (37), we obtain the actual fused filtering error variances as with the definition

In particular, from (30), (36), and (38), taking , the CI fuser has the conservative and actual steady-state fused error variances as Notice that is defined with the conservative cross-covariance .

Lemma 8 (see [24]). Let be the positive semidefinite matrix; that is, ; then the following matrix is also positive semidefinite; that is,

Lemma 9 (see [24]). Let be the positive semidefinite matrix; that is, ; the following block-diagonal matrix is also positive semidefinite; that is, with .

Theorem 10. For multisensor uncertain systems (1) and (2) with Assumptions 12 and with conservative upper bounds and of noise variances, the actual four steady-state weighted Kalman fusers are robust in the sense that, for all admissible actual variances and satisfying (3), one has and they are called the robust weighted fusion steady-state Kalman filters, and is the minimal upper bound of .

Proof. Defining , subtracting (36) from (38) yields In order to prove the robustness , we only need to prove that the inequality holds.
Applying (8) and (9) yields the following Lyapunov equation where we define Similarly, applying (13) and (14), can be expressed as with the definitions Since is a stable matrix, then the eigenvalues of the matrix are all within the unit circle and are determined from its characteristic equation . The eigenvalues of the matrix are determined from the characteristic equation which yields that is also a stable matrix, because the eigenvalues of are also the eigenvalues of .
Denoting , subtracting (48) from (46) yields the Lyapunov equation
Noting that , applying Lemmas 8 and 9 yields ; therefore . Noting that is a stable matrix and applying Lemma 6 to (51), we have ; that is,
From (45) and (52), we have , so (44) holds. If is other upper bound of , taking , we have , so applying Lemma 6 to (51) yields ; that is, . Hence, applying (45) yields , so , which yields that is the minimal upper bound of . The proof is completed.

Remark 11. From (19) and (30), the CI fusion Kalman filter can be rewritten as which can be reviewed as a special fuser weighted by matrices with weights .
From (31) and (53), the CI fuser has the convex combination form as and it is proved [5] that is a conservative upper bound of , From (31) or (55), the upper bound is defined without the cross-covariance information and is only determined by the conservative local variances , so that has certain conservativeness; that is, is not a minimal upper bound of for all admissible uncertainties of noise variances. From Theorem 10, we have the robustness and defined by (40) with the conservative cross-covariance , is the minimal upper bound of . Hence, we have that is, the upper bound has less conservativeness than .

4.2. Two Robust Weighted Measurement Fusion Steady-State Kalman Filters

For the worst-case conservative systems (1) and (2) with Assumptions 12, and with the conservative upper bounds and of noise variances, if have the common right factor , that is, where is matrix, and the matrix or is assumed to be invertible, with the definition we have the conservative centralized fusion measurement equation Where, according to Assumption 1, the fused noise has the conservative variance matrix If (59) holds, then (61) becomes If is invertible, applying the weighted least squares (WLS) method [34], has the WLS estimate Substituting (64) into (65) yields the first conservative weighted measurement fusion equation Where, from (67), the fused noise has the variance matrix If is invertible, from (61), has the WLS estimate Substituting (61) into (69) yields the second conservative measurement fusion equation where from (71) the fused noise has the variance matrix Hence, the centralized fusion system and two measurement fusion systems have a unified form as

Theorem 12. For the worst-case multisensor uncertain system with Assumptions 12, and with the conservative upper bounds and of noise variances, the robust centralized fusion Kalman filter and two robust weighted measurement fusion Kalman filters have a unified form as and the conservative and actual fused error variances are, respectively, given as From (62), (67), and (71), applying Assumption 1 yields We have three equivalent robust Kalman filters with the robustness and we have the accuracy relations

Proof. The robust Kalman filters (74) have the equivalent information filter form [38] From (81), we see that, in order to prove (77) and (79), we only need to prove Applying (59), (60), (63), (65), (68), (69), and (72), we easily verify that (82) hold. In order to prove (78), from (79), we only need to prove ; that is, the centralized fusion Kalman filter is robust. In fact, applying (3) and Lemma 9 yields , so applying the derivation similar to Theorem 7 yields . The proof is completed.

5. Robust Accuracy Analysis

Theorem 13. For multisensor uncertain systems (1) and (2) with Assumptions 12, the local and fused Kalman filters have the following accuracy relations:

Proof. The relations (83)–(85) were proved in Theorems 712. The relation (86) was proved in [5]. The relation (87) was proved in Remark 11. Taking the trace operations for (83)–(87) yields (88)–(92). The relation (93) was proved in [5]. The proof is completed.

Remark 14. The trace of the error variance matrix is used to represent the filtering accuracy which is equal to the sum of the filtering error variances for the components of state. The smaller trace means the higher accuracy and the larger trace means the lower accuracy. The accuracy relations (88) and (89) mean that, for any admissible and satisfying (3), the actual accuracy or of the local or fused filters , is globally controlled by or , and or is independent of all admissible and satisfying (3). Therefore, or is called robust accuracy of and is also called global accuracy [24], and or is called its actual accuracy. Notice that, for different and , the corresponding actual accuracies are also different; that is, or is related to admissible and . From (88) and (89), we see that the robust accuracy is the admissible lowest actual accuracy; that is, it is the lowest bound of the actual accuracies. The smaller or means the higher robust accuracy, and the larger or means the lower robust accuracy.

Remark 15. From Theorem 10, we see that with the cross-covariance information is a minimal upper bound of , and, from (57) and (58), we have the robust accuracy relation This means that the robust accuracy of the CI fuser is rather than , so that the modified robust accuracy is higher than the original robust accuracy in [24], and it also develops and extends the ellipsoidal intersection (EI) fuser with the cross-covariance information [33].

6. Simulation Example

Consider a three-sensor tracking system with uncertain noise variances where is the sampled period, is the state, and are the position and velocity of target at time , and are independent Gaussian white noises with zero mean and unknown actual variances and , respectively. Taking the conservative noise variances and satisfies and . In the simulation, we take , , , ,, , , and .

Applying the local and fused robust steady-state Kalman filters, the actual and conservative filtering error variances are obtained in Table 1.

Table 1 verifies the accuracy relations (83)–(87), and it is easy to be verified that is satisfied. The traces of the error variances of the local and fused Kalman filters are compared in Table 2, which verify the accuracy relations (88)–(93).

In order to give a geometric interpretation of the matrix accuracy relations, the covariance ellipse is defined as the locus of points , where is the variance matrix and is a constant. Generally, we select . It has been proved [32] that is equivalent to the covariance ellipse form by contains that form by .

From Figures 1 and 2, we see that the ellipse of is enclosed in these of , , and which verifies the matrix accuracy relations (85)–(87). From Figure 3, we see that the ellipses of or are enclosed in these of the conservative upper bound or , respectively, which verify the robustness (83)–(87).

In order to verify the above theoretical accuracy relations, taking Monte-Carlo simulation runs, the mean square error (MSE) value at time of local or fused Kalman filters is defined as where or denotes the realization of or and denotes the realization of the centralized fuser. are the recursive steps, the final step is , and the MSE curves of the local and weighted fusion robust Kalman filters are shown in Figure 4, where the straight lines denote the traces of the theoretical error variances, respectively, the curves denote the values of the or , and , .

According to the consistency of the sampled variance, we have

From Figure 4, we see that when is sufficiently large, the values of are close to the corresponding theoretical values , which verifies the consistency (97). We also see that , which verifies the accuracy relations (88) and (89).

7. Conclusions

For the multisensor time-invariant uncertain systems with uncertainties of noise variances, according to the minimax robust estimation principle, based on the worst-case conservative system with conservative upper bound of noise variances, using the ULMV optimal estimation rule and the steady-state Kalman filtering theory, the six robust weighted fusion steady-state Kalman filters have been presented. Their robustness was proved by using the Lyapunov equation method and their robust accuracy relations were proved. Compared with the method and results in [24], the main new contributions are as follows.(1)Reference [24] presented an indirect design method for obtaining the robust weighted fusion steady-state Kalman filters which are obtained by taking the limit operations for the proposed time-varying robust Kalman fusers. This paper presented a simple direct design method based on the steady-state Kalman filtering theory, which can directly obtain the same steady-state results in [24], and avoided finding the time-varying robust Kalman fusers.(2)A modified CI fusion method has been presented. A minimal upper bound of actual CI fusion error variances was presented based on the cross-covariance information. It reduces the conservativeness of the original upper bound without the cross-covariance information, and it improves and increases the robust accuracy of the CI fuser as shown in Remark 15. The ellipsoidal intersection (EI) fuser [33] with the cross-covariance information was developed and extended.(3)Two robust weighted measurement fusion algorithms and the robust centralized fusion algorithm have been presented in a unified framework, their equivalence was proved, and they have the highest robust accuracy than the above other fusers. Only one weighted measurement fusion algorithm was presented in [24].

This paper is limited to the multisensor systems with uncertain noise variances; the extension of the proposed results to the multisensor systems with both the uncertain model parameters and noise variances is in the investigation.

Conflict of Interests

The authors declare that there is no conflict of interests regarding the publication of this paper.

Acknowledgments

This work is supported by the Natural Science Foundation of China under Grant NSFC-60874063 and Innovation and Scientific Research Foundation of Graduate Student of Heilongjiang Province under Grant YJSCX2012-263HLJ. The authors thank the reviewers and editors for their helpful and constructive comments, which are very valuable for improving quality of the paper.