Next Article in Journal
Laser-Induced Graphene Stretchable Strain Sensor with Vertical and Parallel Patterns
Next Article in Special Issue
Clamping Fatigue Properties of Shrink-Fit Holder
Previous Article in Journal
Q-Factor Enhancement of Coupling Bragg and Local Resonance Band Gaps in Single-Phase Phononic Crystals for TPOS MEMS Resonator
Previous Article in Special Issue
Influence of Pulse Energy and Defocus Amount on the Mechanism and Surface Characteristics of Femtosecond Laser Polishing of SiC Ceramics
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Sequential Covariance Intersection Fusion Robust Time-Varying Kalman Filters with Uncertainties of Noise Variances for Advanced Manufacturing

School of Mechanical and Electrical Engineering, Heilongjiang University, Harbin 150080, China
*
Author to whom correspondence should be addressed.
Micromachines 2022, 13(8), 1216; https://doi.org/10.3390/mi13081216
Submission received: 21 June 2022 / Revised: 26 July 2022 / Accepted: 27 July 2022 / Published: 29 July 2022
(This article belongs to the Special Issue Advanced Manufacturing Technology and Systems, 2nd Edition)

Abstract

:
This paper addresses the robust Kalman filtering problem for multisensor time-varying systems with uncertainties of noise variances. Using the minimax robust estimation principle, based on the worst-case conservative system with the conservative upper bounds of noise variances, the robust local time-varying Kalman filters are presented. Further, the batch covariance intersection (BCI) fusion and a fast sequential covariance intersection (SCI) fusion robust time-varying Kalman filters are presented. They have the robustness that the actual filtering error variances or their traces are guaranteed to have a minimal upper bound for all admissible uncertainties of noise variances. Their robustness is proved based on the proposed Lyapunov equations approach. The concepts of the robust and actual accuracies are presented, and the robust accuracy relations are proved. It is also proved that the robust accuracies of the BCI and SCI fusers are higher than that of each local Kalman filter, the robust accuracy of the BCI fuser is higher than that of the SCI fuser, and the actual accuracies of each robust Kalman filter are higher than its robust accuracy for all admissible uncertainties of noise variances. The corresponding steady-state robust local and fused Kalman filters are also presented for multisensor time-invariant systems, and the convergence in a realization between the local and fused time-varying and steady-state Kalman filters is proved by the dynamic error system analysis (DESA) method and dynamic variance error system analysis (DVESA) method. A simulation example is given to verify the robustness and the correctness of the robust accuracy relations.

1. Introduction

The multisensor information fusion Kalman filtering has wide applications in many high-technology fields, such as advanced manufacturing systems, mechanical industrial robots, unmanned aircraft vehicles, tracking, signal processing, remaining useful life prediction of rolling element bearings [1,2,3], improved tracking and docking of industrial mobile robots [4,5,6,7], and so on. Rolling bearings are the key components of rotating machinery, thus, the prediction of remaining useful life (RUL) is vital in condition-based maintenance (CBM). Reference 1 proposes a new method for RUL predictions of bearings based on time-varying Kalman filter, which can automatically match different degradation stages of bearings and effectively realize the prediction of RUL. Industrial mobile robots are widely used in advanced manufacturing technology systems; ref. [2] used the unscented Kalman filter to improved tracking and docking of industrial mobile robots vision-based kinematics calibration.
The basic assumption for classical Kalman filtering is that the model parameters and noise variances are exactly known, but in many practical applications, such assumption doesn’t always hold. In the presence of these uncertainties, the Kalman filters may not be robust against uncertainties, or may be divergent [8], or the performance of the filters is degraded. In order to solve the filtering problems for uncertain systems, in recent years several results have been derived on the design of various robust Kalman filters. The so-called robust Kalman filtering problem is to find a Kalman filter whose actual filtering error variances, or their traces, are guaranteed to have a minimal or less-conservative upper bound for all admissible uncertainties. There are basically two approaches to solve this problem for the systems with uncertainties of model parameters: one is the Riccati equation approach [8,9,10,11]; the other is the linear matrix inequality (LMI) approach [8,12,13].
The uncertain systems exist widely in control engineering and signal processing. So far, these robust Kalman approaches are only suitable to the systems with the uncertainty of model parameters, while the uncertainties of noise variances are seldom considered. Many results are limited to design the robust Kalman filters for single sensor systems, while the multisensor fusion robust Kalman filters are seldom proposed [14,15,16,17], and the robustness analysis problem was not solved.
The multisensor data fusion problem is to find a fused state estimator based on the local sensor measurement information or the local state estimators such that its accuracy is higher than that of each local state estimator [18,19,20]. There exist two kinds of fusion methods, which are called the centralized and distributed fusion methods depending on whether raw data are used directly for fusion or not [19]. For the centralized fusion method, all the measurement data from local sensors are carried to the fusion center which can give the global optimal fusion estimate, but its disadvantage is to require a large computation burden. The distributed fusion method can give the globally optimal or suboptimal state estimation by combing the local state estimators [20,21,22], whose advantages are that it can reduce the computation burden and can realize fault detection and isolation more conveniently. Under the unbiased linear minimum variance rule (ULMV), there are three distributed optimal fusion rules weighted by matrices, diagonal matrices, and scalars, respectively, which were presented in [20,23].
It is well known that to compute the optimal weights requires knowing the cross-covariance among the local Kalman filtering errors [20,21,22,23]; however, in many practical applications, the variances and cross-covariances of the local filtering errors are unknown or uncertain, or the computation of the cross-covariances is very complex and difficult [21,24]. In order to overcome the above limitation, the covariance intersection (CI) fusion method has been presented in [25,26,27,28,29] and has been widely applied in many fields; for example, the simultaneous localization and mapping (SLAM) [29], remote sensing [30], rocket tracking [31], spacecraft estimation [32], vehicle localization [33] and so on. The CI fuser is obtained by the convex combination of the local estimators, and it has the advantages that the fused estimation problems can be solved for multisensor systems with unknown variances and cross-covariances of local filtering errors, and the computation of the cross-covariances is completely avoided. However, its disadvantage is that the conservative upper bounds of the unknown local filtering error variances are assumed to be known, i.e., the consistent estimation problem of the unknown local filtering error variances was not solved.
Based on the batch processing method, the batch covariance intersection (BCI) fusion Kalman filter with exactly known model parameters and noise variances is presented [22]; this needs to solve the high-dimensional nonlinear optimization problem, so that a larger computation burden and higher complexity are required. In order to reduce the computation burden and complexity by the sequential procession method, a sequential covariance intersection (SCI) fusion Kalman filter is presented in [34] for multisensor systems with noise variances to be known exactly.
In this paper, we will focus on the covariance intersection (CI) fused robust Kalman filtering for multisensor systems with uncertainties of noise variances. A robust CI fusion Kalman filtering theory and methodology are presented. Compared with references [22,25,26,27,28,29,34], the main contributions are as follows:
  • In Section 2 and Section 3, a new methodology for designing the robust local and CI fused Kalman filters is presented for multisensor time-varying systems with uncertain noise variances, according to the minimax robust estimation rule [35,36]. Its basic principle is that based on the worst-case conservative system with the conservative upper bound of noise variances, applying the ULMV optimal estimation rule, the conservative local and CI fused Kalman filters with unavailable conservative measurements are obtained, and then replacing the conservative measurements with the actual measurements yields the robust local and CI fused Kalman filters. The classical optimal Kalman filtering methodology [22,34] is developed. The disadvantage of the original CI fusion methodology [25,26,27,28,29] is overcome where the conservative upper bounds of the local filtering error variances are assumed to be known. Hence the robust local Kalman filters are presented, which provide the conservative upper bounds of the local filtering error variances;
  • In Section 3, the robust time-varying BCI and SCI fused Kalman filters with uncertain noise variances are presented. The steady-state optimal local, BCI and SCI fused Kalman filters [22,34] with exactly known noise variances are developed;
  • In the process of proving Theorems 1 and 3, a Lyapunov equation method for the robustness analysis is presented by which the robustness of the local and CI fused Kalman filters is proved. Its basic principle is that the problem of proving the robustness is converted into that of deciding the positive-definiteness of the solution of a Lyapunov equation;
  • In Section 4, the concept of robust accuracy with respect to uncertainties of noise variances is presented, and the robust accuracy relations among the local, BCI and SCI fused Kalman filters with exactly known noised variances [22,34] are extended. The concept of robustness with respect to uncertain noise variances is presented, and the concept of consistency [25,26] is extended;
  • In Section 5, for the multisensor time-invariant system with uncertain noise variances, the robust steady-state local, BCI and SCI fusion Kalman filters are also presented by replacing time-varying gains, variances and cross-covariances with their limits, respectively;
  • Using lemma 1–3, in Theorem 7, the convergence in a realization of the local and fused time-varying and steady-state robust Kalman filters is proved by the dynamic error system analysis (DESA) method and the dynamic variance error system analysis (DVESA) method. To the best of our knowledge, it is presented for the first time;
  • In Section 7, simulation 1 gives the geometric interpretation of the robust accuracy relations based on the variance ellipses and a Monte Carlo simulation example shows the correctness of the proposed robust accuracy relations and gives the sensitivity analysis of the robust SCI fuser.
The remainder of this paper is organized as follows: In Section 2, we derive the local robust time-varying Kalman filter and prove its robustness. Section 3 gives the BCI and SCI fusion robust time-varying Kalman filters and the proof of their robustness. The accuracy analysis of the local and fused Kalman filters is presented in Section 4. Section 5 gives the robust local and fused steady-state Kalman filters and their convergence. The sensitivity problem is given in Section 6. Section 7 gives a Monte Carlo simulation example. The conclusions are given in Section 8. The frequently used notations in the paper are shown in Table 1.

2. Local Robust Time-Varying Kalman Filters

Consider the following multisensor uncertain time-varying system with uncertainties of noise variances
x ( t + 1 ) = Φ ( t ) x ( t ) + Γ ( t ) w ( t )
y i ( t ) = H i ( t ) x ( t ) + v i ( t ) ,   i = 1 , , L
where x ( t ) R n is the state, L is the number of sensors, y i ( t ) R m i is the measurement of the i th subsystem, w ( t ) R r is the input noise and v i ( t ) R m i is the measurement noise of the i th sensor. Φ ( t ) , Γ ( t ) and H i ( t ) are known time-varying matrices with appropriate dimensions.
Assumption 1.
w ( t ) and v i ( t ) are uncorrelated white noises with zeros mean and unknown uncertain true variances Q ¯ ( t ) and R ¯ i ( t ) , respectively.
E [ ( w ( t ) v i ( t ) ) ( w ( k ) v j ( k ) ) Τ ] = [ Q ¯ ( t ) 0 0 R ¯ i ( t ) δ i j ] δ t k  
Assumption 2.  Q ( t ) and R i ( t ) are known conservative upper bounds of Q ¯ ( t ) and R ¯ i ( t ) , respectively, i.e.,
Q ¯ ( t ) Q ( t ) ,   R ¯ i ( t ) R i ( t ) ,   t , i = 1 , , L  
Assumption 3.
The initial state x ( 0 ) is independent of w ( t ) and v i ( t ) , and has mean value μ and unknown uncertain true variance P ¯ ( 0 | 0 ) which satisfies
P ¯ ( 0 | 0 ) P ( 0 | 0 )  
where  P ( 0 | 0 )  is a known conservative upper bound of  P ¯ ( 0 | 0 ) .
Based on the i th sensor, for the worst-case conservative multisensor system (1) and (2) with the known conservative upper bounds Q ( t ) and R i ( t ) of noise variances, the conservative local optimal time-varying Kalman filters are given by [20]
x ^ i ( t | t ) = Ψ i ( t ) x ^ i ( t 1 | t 1 ) + K i ( t ) y i ( t ) ,   i = 1 , , L
Ψ i ( t ) = [ I n K i ( t ) H i ( t ) ] Φ ( t )
K i ( t ) = P i ( t | t 1 ) H i T ( t ) Q ε i 1 ( t )
Q ε i ( t ) = H i ( t ) P i ( t | t 1 ) H i T ( t ) + R i ( t )
P i ( t | t 1 ) = Φ ( t 1 ) P i ( t 1 | t 1 ) Φ T ( t 1 ) + Γ ( t 1 ) Q ( t 1 ) Γ T ( t 1 )
P i ( t | t ) = [ I n K i ( t ) H i ( t ) ] P i ( t | t 1 )
P i j ( t | t ) = Ψ i ( t ) P i j ( t 1 | t 1 ) Ψ j T ( t ) + [ Ι n Κ i ( t ) H i ( t ) ] × Γ ( t 1 ) Q ( t 1 ) Γ T ( t 1 ) [ I n K j ( t ) H j ( t ) ] T + K i ( t ) R i j ( t ) K j T ( t ) δ i j
P ¯ i ( t | t ) = E [ x ˜ i ( t | t ) x ˜ i Τ ( t | t ) ] ,   P ¯ i j ( t | t ) = E [ x ˜ i ( t | t ) x ˜ j Τ ( t | t ) ]
x ˜ i ( t | t ) = x ( t ) x ^ i ( t | t )
From (1) and (6), the actual filtering errors are
x ˜ i ( t | t ) = Ψ i ( t ) x ˜ ( t 1 | t 1 ) + ( I n K i ( t ) H i ( t ) ) Γ ( t ) w ( t 1 ) K i ( t ) v i ( t )
From (15), according to Assumptions 1–3, and noting that w ( t ) and v i ( t ) are uncorrelated with x ˜ i ( t | t ) , the actual filtering error variance and cross-covariances are given by the Lyapunov equations
P ¯ i j ( t | t ) = Ψ i ( t ) P ¯ i j ( t 1 | t 1 ) Ψ j T ( t ) + [ Ι n Κ i ( t ) H i ( t ) ] × Γ ( t 1 ) Q ¯ ( t 1 ) Γ T ( t 1 ) [ I n K j ( t ) H j ( t ) ] T + K i ( t ) R ¯ i j ( t ) K j T ( t ) δ i j
with the initial values P ¯ i j ( 0 | 0 ) = P ¯ ( 0 | 0 ) and P ¯ i i ( t | t ) = P ¯ i ( t | t ) .
Theorem 1.
For multisensor uncertain system (1) and (2) with Assumptions 1–3, the actual local Kalman filters (6) is robust in the sense that for all admissible variances Q ¯ ( t ) and R ¯ i ( t ) satisfying (4) and P ¯ ( 0 | 0 ) P ( 0 | 0 ) for arbitrary time t , we have
P ¯ i ( t | t ) P i ( t | t ) ,   i = 1 , , L  
and  P i ( t | t )  are the minimal upper bounds of  P ¯ i ( t | t ) . Hence, they are called the robust local Kalman filters.
Proof. 
Defining Δ P i ( t | t ) = P i ( t | t ) P ¯ i ( t | t ) , subtracting (16) from (12) yields the Lyapunov equations
Δ P i ( t | t ) = Ψ i ( t ) Δ P i ( t 1 | t 1 ) Ψ i T ( t ) + U i ( t )
U i ( t ) = [ Ι n Κ i ( t ) H i ( t ) ] Γ ( t 1 ) ( Q ( t 1 ) Q ¯ ( t 1 ) ) Γ T ( t 1 ) [ I n K i ( t ) H i ( t ) ] T + K i ( t ) ( R i ( t ) R ¯ i ( t ) ) K i T ( t )
Applying (4) yields that U i ( t ) 0 . From (5), we have Δ P i ( 0 | 0 ) = P ( 0 | 0 ) P ¯ ( 0 | 0 ) 0 . Hence from (18), we have Δ P i ( 1 | 1 ) 0 . Applying the mathematical induction method yields Δ P i ( t | t ) 0 , for all time t , i.e., the inequalities (17) hold. If P i ( t | t ) is another upper bound, then for all admissible Q ¯ ( t ) Q ( t ) and R ¯ i ( t ) R i ( t ) , we have P ¯ i ( t | t ) P i ( t | t ) . Taking Q ¯ ( t ) = Q ( t ) , R ¯ i ( t ) = R i ( t ) , from (12) and (16), we have P i ( t | t ) = P ¯ i ( t | t ) P i ( t | t ) . This means that P i ( t | t ) is the minimal upper bounds of P ¯ i ( t | t ) . The proof is completed. □
Remark 1.
The robustness (17) is different from the consistency or non-divergent estimation [23]. The robustness means that the inequality (17) holds for all admissible uncertain Q ¯ ( t ) and R ¯ i ( t ) satisfying (4), while the consistency means that for a fixed Q ¯ ( t ) and R ¯ i ( t ) , the inequality (17) holds.

3. The CI Fusion Robust Time-Varying Kalman Filter

3.1. The BCI Fusion Robust Time-Varying Kalman Filter

For the two-sensor uncertain systems with the Assumptions 1–3, applying the CI fused algorithm [20,21,22,23], the actual CI fusion time-varying Kalman filter with the conservative upper bounds Q ( t ) and R i ( t ) of noise variances is presented as following
x ^ C I ( t | t ) = P C I ( t | t ) [ ω ( t ) P 1 1 ( t | t ) x ^ 1 ( t | t ) + ( 1 ω ( t ) ) P 2 1 ( t | t ) x ^ 2 ( t | t ) ]
P C I ( t | t ) = [ ω ( t ) P 1 1 ( t | t ) + ( 1 ω ( t ) ) P 2 1 ( t | t ) ] 1 ,   ω ( t ) [ 0 , 1 ]
where x ^ i ( t | t ) are the robust local Kalman filters given in Theorem 1. The weight ω ( t ) minimizes the cost function J as
min J = min ω ( t ) [ 0 , 1 ] tr P C I ( t | t ) = min ω ( t ) [ 0 , 1 ] tr { [ ω ( t ) P 1 1 ( t | t ) + ( 1 ω ( t ) ) P 2 1 ( t | t ) ] 1 }
When the number of the sensors is larger than two, i.e., L 3 . The actual batch covariance intersection (BCI) fusion Kalman filter is presented by the convex combination [26,35] as
x ^ B C I ( t | t ) = P B C I ( t | t ) i = 1 L ω i ( t ) P i 1 ( t | t ) x ^ i ( t | t )
P B C I ( t | t ) = [ i = 1 L ω i ( t ) P i 1 ( t | t ) ] 1 ,   i = 1 L ω i ( t ) = 1 , 0 ω i ( t ) 1
where x ^ i ( t | t ) are the robust local Kalman filters, the weights ω i ( t ) are determined by minimizing the performance index J = tr P B C I ( t | t ) as
min J = min ω i ( t ) tr P B C I ( t | t ) = min ω i ( t ) [ 0 , 1 ] ω 1 ( t ) + + ω L ( t ) = 1 tr { [ i = 1 L ω i ( t ) P i 1 ( t | t ) ] 1 }
which can be obtained by “fimincon” function in Matlab. This needs to solve a L -dimensional nonlinear convex optimization problem, so that the larger computation burden and higher complexity are required.
Theorem 2.
The actual BCI fusion filtering error variance is given by
P ¯ B C I ( t | t ) = P B C I ( t | t ) [ i = 1 L j = 1 L ω i ( t ) P i 1 ( t | t ) P ¯ i j ( t | t ) P j 1 ( t | t ) ω j ( t ) ] P B C I ( t | t )  
where  P ¯ i j ( t | t )  are computed by (16).
Proof. 
From (24), we have
x ( t ) = P B C I ( t | t ) [ i = 1 L ω i ( t ) P i 1 ( t | t ) ] x ( t )
Subtracting (27) from (23), we easily obtain the actual BCI fused filtering error
x ˜ B C I ( t | t ) = P B C I ( t | t ) i = 1 L ω i ( t ) P i 1 ( t | t ) x ˜ i ( t | t )
which yields the formula (26). The proof is completed. □
Theorem 3.
For multisensor uncertain system (1) and (2) with Assumptions 1–3, the actual BCI fusion time-varying Kalman filter (23)–(25) is robust in the sense that for all admissible uncertainties of noise variances Q ¯ ( t ) and R ¯ i ( t ) satisfying (4), we have
P ¯ B C I ( t | t ) P B C I ( t | t )  
and  tr P B C I ( t | t )  is the minimal upper bound of  tr P ¯ B C I ( t | t ) . We call (23)as the robust BCI fusion Kalman filter.
Proof. 
In order to prove (29), we only need to prove
P B C I ( t | t ) P ¯ B C I ( t | t ) 0
Pre-multiplying and post-multiplying (30) by P B C I 1 , respectively, we have
P B C I 1 ( t | t ) P B C I 1 ( t | t ) P ¯ B C I ( t | t ) P B C I 1 ( t | t ) 0
Substituting (24) and (26) into (31), we only need to prove
i = 1 L ω i ( t ) P i 1 ( t | t ) i = 1 L j = 1 L ω i ( t ) P i 1 ( t | t ) P ¯ i j ( t | t ) P j 1 ( t | t ) ω j ( t ) 0
From (17) for all admissible Q ¯ ( t ) and R ¯ i ( t ) satisfying (4), we have
P i ( t | t ) P ¯ i ( t | t ) 0
Pre-multiplying and post-multiplying (33) by P i 1 , respectively, we have
P i 1 ( t | t ) P i 1 ( t | t ) P ¯ i ( t | t ) P i 1 ( t | t ) 0
From (32) and (34), we only need to prove
i = 1 L ω i ( t ) P i 1 ( t | t ) P ¯ i ( t | t ) P i 1 ( t | t ) i = 1 L j = 1 L ω i ( t ) P i 1 ( t | t ) P ¯ i j ( t | t ) P j 1 ( t | t ) ω j ( t ) 0
Applying the constraint i = 1 L ω i ( t ) = 1 yields that
i = 1 L ω i ( t ) P i 1 ( t | t ) P ¯ i ( t | t ) P i 1 ( t | t ) = i = 1 L j = 1 L ω i ( t ) ω j ( t ) P i 1 ( t | t ) P ¯ i ( t | t ) P i 1 ( t | t )
Hence, we only need to prove
Δ = i = 1 L j = 1 L ω i ( t ) ω j ( t ) ( P i 1 ( t | t ) P ¯ i ( t | t ) P i 1 ( t | t ) P i 1 ( t | t ) P ¯ i j ( t | t ) P j 1 ( t | t ) ) 0
Exchanging the subscript symbol i with j in (37) yields
Δ = j = 1 L i = 1 L ω j ( t ) ω i ( t ) ( P j 1 ( t | t ) P ¯ j ( t | t ) P j 1 ( t | t ) P j 1 ( t | t ) P ¯ j i ( t | t ) P i 1 ( t | t ) ) 0
Adding (37) to (38) yields
2 Δ = i = 1 L j = 1 L ω i ( t ) ω j ( t ) [ P i 1 ( t | t ) P ¯ i ( t | t ) P i 1 ( t | t ) + P j 1 ( t | t ) P ¯ j ( t | t ) P j 1 ( t | t ) P i 1 ( t | t ) P ¯ i j ( t | t ) P j 1 ( t | t ) P j 1 ( t | t ) P ¯ j i ( t | t ) P i 1 ( t | t ) ] = i = 1 L j = 1 L ω i ( t ) ω j ( t ) E [ ( P i 1 ( t | t ) x ˜ i ( t | t ) P j 1 ( t | t ) x ˜ j ( t | t ) ) × ( P i 1 ( t | t ) x ˜ i ( t | t ) P j 1 ( t | t ) x ˜ j ( t | t ) ) T ] 0
which yields Δ 0 , i.e., (29) holds. Taking the trace operation for (29) yields tr P ¯ B C I ( t | t ) tr P B C I ( t | t ) . Applying (25) yields that tr P B C I ( t | t ) is minimal for all admissible P B C I ( t | t ) given in (24). The proof is completed. □
Remark 2.
The proof of Theorem 3 is completely different from the proof in reference [20], where the noise variances are assumed to be exactly known, and the consistency is proved by the mathematical induction. The proof is also different from that in reference [36], where the consistency of the BCI fuser was only proved with the assumption that the local estimates are consistent, while the robustness problem was not proved.

3.2. The SCI Fusion Robust Time-Varying Kalman Filter

In order to reduce the complexity and computational burden, the sequential covariance intersection (SCI) robust time-varying Kalman fuser is presented based on the L 1 two-sensor CI fused robust Kalman filters, and it can be realized by a recursive two-sensor CI fusers [34]. Its structure is shown in Figure 1, and the comparison of the computational loads of the BCI filter and the SCI filter are shown in Table 2.
Based on the two-sensor CI fused algorithm, the actual SCI fusion time-varying Kalman filter with the conservative error variances Q ( t ) and R i ( t ) is presented as follows
x ^ C I i ( t | t ) = P C I i ( t | t ) [ ω i ( t ) P C I ( i 1 ) 1 ( t | t ) x ^ C I ( i 1 ) ( t | t ) + ( 1 ω i ( t ) ) P i + 1 1 ( t | t ) x ^ i + 1 ( t | t ) ]
P C I i ( t | t ) = [ ω i ( t ) P C I ( i 1 ) 1 ( t | t ) + ( 1 ω i ( t ) ) P i + 1 1 ( t | t ) ] 1 ,   i = 1 , , L 1
x ^ S C I ( t | t ) = x ^ C I ( L 1 ) ( t | t ) ,   P S C I ( t | t ) = P C I ( L 1 ) ( t | t )
x ^ C I ( 0 ) ( t | t ) = x ^ 1 ( t | t ) ,   P S C I 1 ( 0 | 0 ) = P 1 1 ( 0 | 0 )
where x ^ i ( t | t ) are the robust local Kalman filters, and the parameters ω i ( t ) is determined by minimizing the performance index J as
J = min ω i ( t ) tr P C I i ( t | t ) = min ω i ( t ) [ 0 , 1 ] tr { [ ω i ( t ) P C I ( i 1 ) 1 ( t | t ) + ( 1 ω i ( t ) ) P i + 1 1 ( t | t ) ] 1 } ,   i = 1 , , L 1
The optimization problem (44) is equivalent to the L 1 one-dimensional optimization problems (22).
Remark 3.
When the noise variances are exactly known, the optimal steady-state SCI fuser was presented in [34]. However, for multisensor systems with uncertain noise variances, the local and SCI fusion robust time-varying Kalman filters were not presented in [34].
Theorem 4.
For the multisensor uncertain system (1) and (2) with Assumptions 1–3, the actual SCI fused filter x ^ S C I ( t | t ) and its actual error variance P ¯ S C I can be rewritten as batch representation
x ^ S C I ( t | t ) = P S C I ( t | t ) i = 1 L θ i ( L ) ( t ) P i 1 ( t | t ) x ^ i ( t | t )  
P S C I ( t | t ) = [ i = 1 L θ i ( L ) ( t ) P i 1 ( t | t ) ] 1 ,   i = 1 L θ i ( L ) ( t ) = 1 ,   θ i ( L ) ( t ) 0  
P ¯ S C I ( t | t ) = P S C I ( t | t ) [ i = 1 L j = 1 L θ i ( L ) ( t ) P i 1 ( t | t ) P ¯ i j ( t | t ) P j 1 ( t | t ) θ j ( L ) ( t ) ] P S C I ( t | t )  
where the weighting coefficients  θ i ( r ) ( t )  can be computed recursively by
θ i ( r ) ( t ) = ω r 1 ( t ) θ i ( r 1 ) ( t ) ,   i = 1 , , r 1
θ r ( r ) ( t ) = 1 ω r 1 ( t ) ,   r = 2 , , L
θ 1 ( 2 ) ( t ) = ω 1 ( t ) ,   θ 2 ( 2 ) ( t ) = 1 ω 1 ( t )
where the coefficients  ω i ( t )  are obtained by (44).
Proof. 
By the mathematical induction (45), (46), (48)–(50) can be proved in [32].
From (46) we have
x ( t ) = P S C I ( t | t ) [ i = 1 L θ i ( L ) ( t ) P i 1 ( t | t ) ] x ( t )
Subtracting (45) from (51), we get
x ˜ S C I ( t | t ) = P S C I ( t | t ) i = 1 L θ i ( L ) ( t ) P i 1 ( t | t ) x ˜ i ( t | t )
Substituting (52) into P ¯ S C I ( t | t ) = E [ x ˜ S C I ( t | t ) x ˜ S C I T ( t | t ) ] yields the formula (47). The proof is completed. □
Theorem 5.
For multisensor uncertain system (1) and (2) with Assumptions 1–3, the actual SCI fusion time-varying Kalman filter (40)–(44) is robust in the sense that for all admissible uncertainties of noise variances Q ¯ ( t ) and R ¯ i ( t ) satisfying (4), we have
P ¯ S C I ( t | t ) P S C I ( t | t )  
we call (45) as the robust SCI fusion Kalman filter.
Proof. 
Applying Theorem 4, the SCI Kalman filter can be expressed as the equivalent BCI Kalman filter form. According to Theorem 3, the BCI time-varying fuser is robust, so that the SCI time-varying fuser is also robust. The proof is completed. □
Remark 4.
The proof of Theorem 5 is different from that in [34] by the consistency of the two-sensor CI fuser. We can also prove Theorem 5 based on robustness of the two-sensor CI fuser.

4. Accuracy Analysis

From (53), we can see that P S C I ( t | t ) is the upper bound of the unknown actual fused variances P ¯ S C I ( t | t ) for all possible P ¯ i ( t | t ) and all admissible unknown P ¯ i j ( t | t ) satisfying (16), so that P S C I ( t | t ) can be viewed as the global accuracy of the SCI fuser. From (46), we see that P S C I ( t | t ) is independent of actual variances P ¯ i ( t | t ) and cross-covariances P ¯ i j ( t | t ) . So that the global accuracy of the SCI fuser has the robustness with respect to uncertain P ¯ i ( t | t ) and P ¯ i j ( t | t ) . From (16), we see that the uncertainties of P ¯ i ( t | t ) and P ¯ i j ( t | t ) are yielded by the uncertainties of Q ¯ ( t ) and R ¯ i ( t ) satisfying (4).
Definition 1.
The robustness with respect to uncertainties of noise variances of a Kalman filter is defined as its actual filtering error variances or their traces yielded by all admissible uncertainties of noise variances, which are guaranteed to have a minimal or less-conservative upper bound and this upper bound is independent of uncertainties of noise variances. The Kalman filter with robustness is called to be robust.
Definition 2.
The robust accuracy of a robust Kalman filter is defined as the trace of a minimal or less-conservative upper bound of its actual filtering error variances, while its actual accuracy is defined as the trace of its actual filtering error variance.
Theorem 6.
For multisensor uncertain system (1) and (2) with Assumptions 1–3, the actual and robust accuracies of the local, BCI and SCI fused time-varying Kalman filters have the relations
tr P ¯ i ( t | t ) tr P i ( t | t ) ,   i = 1 , , L  
tr P ¯ B C I ( t | t ) tr P B C I ( t | t ) ,   tr P ¯ S C I ( t | t ) tr P S C I ( t | t )  
tr P B C I ( t | t ) tr P i ( t | t ) ,   i = 1 , , L  
tr P B C I ( t | t ) tr P S C I ( t | t )  
tr P S C I ( t | t ) tr P i ( t | t ) ,   i = 1 , , L  
Proof. 
Taking the trace operations for (17), (29) and (53) yields (54) and (55). In (25), taking ω i ( t ) = 1 and ω j ( t ) = 0 ( j i ) yields tr P B C I ( t | t ) = tr P i ( t | t ) , Hence, minimizing tr P B C I ( t | t ) with constraints 0 ω i ( t ) 1 , ω 1 ( t ) + + ω L ( t ) = 1 , we have tr P B C I ( t | t ) tr P i ( t | t ) , i = 1 , , L , i.e., (56) holds. From (45) and (46), the SCI fuser is equivalent to a BCI fuser with ω i ( t ) = θ i ( L ) ( t ) , applying (25) yields (57).
The robust accuracy relation (58) can be proved by mathematical induction. For i = 2 , from (40)–(44) we have
x ^ C I 1 ( t | t ) = P C I 1 ( t | t ) [ ω 1 ( t ) P 1 1 ( t | t ) x ^ 1 ( t | t ) + ( 1 ω 1 ( t ) ) P 2 1 ( t | t ) x ^ 2 ( t | t ) ]
P C I 1 ( t | t ) = [ ω 1 ( t ) P 1 1 ( t | t ) + ( 1 ω 1 ( t ) ) P 2 1 ( t | t ) ] 1 ,   ω ( t ) [ 0 , 1 ]
where x ^ i ( t | t ) are the actual local Kalman filters, the weight ω minimizes the cost function J as
min J 1 = min ω ( t ) [ 0 , 1 ] tr P C I 1 ( t | t ) = min ω [ 0 , 1 ] tr { [ ω 1 ( t ) P 1 1 ( t | t ) + ( 1 ω 1 ( t ) ) P 2 1 ( t | t ) ] 1 }
Taking ω 1 ( t ) = 0 , we have J 1 = tr P 2 ( t | t ) , and taking ω 1 ( t ) = 1 , we have J 1 = tr P 1 ( t | t ) , hence for ω ( t ) [ 0 , 1 ] yields
tr P C I 1 ( t | t ) tr P i ( t | t ) ,   i = 1 , 2
Similarly, for i = 3 , from (40)–(44) we have
tr P C I 2 ( t | t ) tr P C I 1 ( t | t ) ,   tr P C I 2 ( t | t ) tr P 3 ( t | t )
From (62) and (63), one can obtain
tr P C I 2 ( t | t ) tr P i ( t | t ) ,   i = 1 , 2 , 3
By the mathematical induction method, assume that for i = L 2 , the following inequality holds
tr P C I ( L 2 ) ( t | t ) tr P i ( t | t ) ,   i = 1 , , L 1
For i = L 1 , from (44), we have
tr P C I ( L 1 ) ( t | t ) tr P L ( t | t ) ,   tr P C I ( L 1 ) ( t | t ) tr P C I ( L 2 ) ( t | t )
From (65) and (66) yields
tr P C I ( L 1 ) ( t | t ) tr P i ( t | t ) ,   i = 1 , , L
Noting that P S C I ( t | t ) = P C I ( L 1 ) ( t | t ) , which yields the inequality (58). The proof is completed. □
Remark 5.
The accuracy relations (54) and (55) mean that for all admissible uncertainties of variances satisfying (4) and (5), the actual accuracies tr P ¯ θ ( t | t ) , θ = 1 , , L , B C I , S C I of the local or fused time-varying Kalman filter are globally controlled by tr P θ ( t | t ) , therefore the robust accuracy tr P θ ( t | t ) is also called the global accuracy of a robust Kalman filter. The robustness of the local and fused filters means that the robust accuracy tr P θ ( t | t ) is independent of arbitrarily variances satisfying (4) and (5).
Remark 6.
From the definition 2, the smaller tr P θ ( t | t ) (or tr P ¯ θ ( t | t ) ) means the higher robust (or actual) accuracy. From (54)–(58), we conclude that the robust accuracy of the robust SCI fuser is higher than that of each local robust Kalman filter, and the robust accuracy of the BCI fuser is higher than that of the SCI fuser. The actual accuracies of a robust Kalman filter are higher than its robust accuracy for all admissible uncertainties.
Remark 7.
Theorem 1 shows that P i ( t | t ) is the minimal upper bound of P ¯ i ( t | t ) in the matrix inequality sense. Theorem 3 shows that tr P B C I ( t | t ) is the minimal upper bound of tr P ¯ B C I ( t | t ) in the trace inequality sense. From (55), (57) and (58) yields that tr P ¯ S C I ( t | t ) tr P S C I ( t | t ) tr P i ( t | t ) , i = 1 , , L so that tr P S C I ( t | t ) is a less-conservative upper bound of tr P ¯ S C I ( t | t ) .

5. Robust Local and Fused Steady-State Kalman Filters

Now we investigate the asymptotic properties of the local and fused robust time-varying Kalman filters, we shall present the corresponding steady-state robust Kalman filters. We shall also rigorously prove the convergence in a realization between the robust time-varying and steady-state Kalman filters, by the DESA method and DVESA method [37,38].
Lemma 1
[39]. Consider the following Lyapunov equation with F being a symmetric matrix
P = Ψ P Ψ T + F  
where P , Ψ and F are the n × n matrices, Ψ is a stable matrix (i.e., all its eigenvalues are inside the unit circle). If F 0 , then P is symmetric and unique, and P 0 .
Lemma 2
[38]. Consider the time-varying Lyapunov equation
P ( t ) = F 1 ( t ) P ( t 1 ) F 2 T ( t ) + U ( t )  
where t 0 , the output P ( t )  and the input  U ( t )  are the  n × n  matrices, and the  n × n  matrices  F 1 ( t )  and  F 2 ( t )  are uniformly asymptotically stable, i.e., there exist constants  0 < ρ j < 1  and  c j > 0  such that
F j ( t , i ) c j ρ j t i , t i 0 ,   j = 1 , 2
If  U ( t ) is bounded, then P ( t ) is bounded. If U ( t ) 0 , then P ( t ) 0 , as t . Notice that U ( t ) is called to be bounded, if U ( t ) c (constant), for arbitrary t 0 .
Lemma 3
[37]. Consider a dynamic error system
δ ( t ) = F ( t ) δ ( t 1 ) + u ( t )  
where δ ( t ) R n , u ( t ) R n , and F ( t ) is uniformly asymptotically stable. If u ( t ) is bounded, then δ ( t ) is bounded. If u ( t ) 0 , then δ ( t ) 0 , as t .
Theorem 7.
For multisensor uncertain time-invariant system (1) and (2) with Assumptions 1–2, where Φ ( t ) = Φ , Γ ( t ) = Γ , H i ( t ) = H i , Q ( t ) = Q , R i ( t ) = R i , Q ¯ ( t ) = Q ¯ and R ¯ i ( t ) = R ¯ i are all the constant matrices. If each subsystem with conservative noise variances Q and R i is completely observable and completely controllable, then the actual local steady-state Kalman filters are given as
x ^ i s ( t | t ) = Ψ i x ^ i s ( t 1 | t 1 ) + K i y i ( t ) ,   i = 1 , , L  
Ψ i = [ I n K i H i ] Φ ,   K i = Σ i H i T ( H i Σ i H i T + R i ) 1  
P i = [ I n K i H i ] Σ i  
where  y i ( t )  are the actual measurements, and the initial value  x ^ i s ( 0 | 0 )  can arbitrarily be selected.  Σ i  satisfies the steady-state Riccati equations
Σ i = Φ [ Σ i Σ i H i T ( H i Σ i H i T + R i ) 1 H i Σ i ] Φ T + Γ Q Γ T
and the conservative cross-covariances P i j  and the actual cross-covariances P ¯ i j satisfy the steady-state Lyapunov equations
P i j = Ψ i P i j Ψ j T + [ Ι n Κ i H i ] Γ Q Γ T [ I n K j H j ] T + K i R i K j T δ i j , i , j = 1 , , L
P ¯ i j = Ψ i P ¯ i j Ψ j T + [ Ι n Κ i H i ] Γ Q ¯ Γ T [ I n K j H j ] T + K i R ¯ i K j T δ i j , i , j = 1 , , L
with the definition  P i = P i i , P ¯ i = P ¯ i i , and we have
P i j ( t | t ) P i j ,   as   t ,   i , j = 1 , , L
P ¯ i j ( t | t ) P ¯ i j ,   as   t ,   i , j = 1 , , L
The actual local steady-state Kalman filters (72) are robust in the sense that for all admissible uncertainties of  Q ¯  and  R ¯ i  satisfying  Q ¯ Q ,   R ¯ i R i , then
P ¯ i P i ,   i = 1 , , L
and   P i   is the minimal upper bound of   P ¯ i . They are called the robust local steady-state Kalman filters.
Proof. 
According to the complete observability and complete controllability of each subsystem, we have [40]
P i ( t | t 1 ) Σ i ,   as t ,   i = 1 , , L
Then from (7), (8) and (11), we have
Ψ i ( t ) Ψ i ,   K i ( t ) K i , P i ( t | t ) P i ,   as   t , i = 1 , , L
where Ψ i are stable matrices [40], and Ψ i ( t ) are uniformly asymptotically stable [40]. When t , taking the limit operations for (6)–(11), (12) and (16), we obtain (72)–(77). From K i ( t ) K i , the gains K i ( t ) are bounded, which yields the boundedness of the input of the Lyapunov Equation (12). Hence, applying Lemma 2 to (12) yields that P i j ( t | t ) are bounded. Setting Ψ i ( t ) = Ψ i + Δ Ψ i ( t ) with Δ Ψ i ( t ) 0 , and subtracting (76) from (12) with H i ( t ) = H i ,   Γ ( t ) = Γ ,   Q ( t ) = Q and R i ( t ) = R i , and defining Δ i j ( t ) = P i j ( t | t ) P i j , yields the Lyapunov equations
Δ i j ( t ) = Ψ i Δ i ( t 1 ) Ψ j T + U i j ( t )
U i j ( t ) = [ Ι n Κ i ( t ) H i ] Γ Q Γ T [ I n K j ( t ) H j ] T + K i ( t ) R i K j T ( t ) δ i j [ Ι n Κ i H i ] Γ Q Γ T [ I n K j H j ] K i R i K j T δ i j + Ψ i P i j ( t 1 | t 1 ) Δ Ψ j T ( t ) + Δ Ψ i ( t ) P i j ( t 1 | t 1 ) Ψ j + Δ Ψ i ( t ) Δ Ψ j T ( t )
Applying K i ( t ) K i , the boundedness of P i j ( t | t ) , and Δ Ψ i ( t ) 0 yields that U i j ( t ) 0 . Applying Lemma 2 to (83) yields Δ i j ( t ) 0 , as t , i.e., (78) holds. Similarly, we can prove (79). Taking the limit operation for (17), as t , and applying (78) and (79) yields (80). Taking Q ¯ = Q ,   R ¯ i = R i , subtracting (77) from (76), and applying Lemma 1 yields P ¯ i = P i , if P i is arbitrary other upper bound of P ¯ i for all admissible Q ¯ and R ¯ i satisfying Q ¯ Q ,   R ¯ i R i , then we have P i = P ¯ i P i , which yields that P i is the minimal. The proof is completed. □
Theorem 8.
For multisensor uncertain time-invariant system (1) and (2) with Assumptions 1–2, if each subsystem with conservative noise variances Q and R i is completely observable and completely controllable, then the actual steady-state BCI fusion Kalman filter is given as
x ^ B C I s ( t | t ) = P B C I i = 1 L ω i P i 1 x ^ i s ( t | t )  
P B C I = [ i = 1 L ω i P i 1 ] 1
where  x ^ i s ( t | t )  are given in Theorem 7, and the optimal weighting coefficients  ω i  are obtained by minimizing the performance index  J = tr P B C I  as
min J = min ω i tr P B C I = min ω i [ 0 , 1 ] ω 1 + + ω L = 1 tr { [ i = 1 L ω i P i 1 ] 1 }
It has the robustness in the sense that for all admissible uncertainties of  Q ¯  and  R ¯ i  satisfying  Q ¯ Q ,   R ¯ i R i , we have
P ¯ B C I P B C I
where the actual fused steady-state filtering error covariance is given as
P ¯ B C I = P B C I [ i = 1 L j = 1 L ω i P i 1 P ¯ i j P j 1 ω j ] P B C I
and   tr P B C I   is the minimal upper bound of   tr P ¯ B C I . It is called the robust steady-state BCI fusion Kalman filter.
Proof. 
As t , taking the limit operations for (23)–(26) yields (85)–(87). Taking the limit operations for (24) and (26) and applying (78) and (79) yields that P S C I ( t | t ) P S C I ,   P ¯ S C I ( t | t ) P ¯ S C I , so that taking the limit operations for (26) and (29) yields (88) and (89). The proof is completed. □
Theorem 9.
For multisensor uncertain time-invariant system (1) and (2) with Assumptions 1–2, if each subsystem with conservative noise variances Q and R i is completely observable and completely controllable, the actual steady-state SCI fusion Kalman filter is given as
x ^ S C I s ( t | t ) = P S C I i = 1 L θ i ( L ) P i 1 x ^ i s ( t | t )  
P S C I = [ i = 1 L θ i ( L ) P i 1 ] 1 ,   i = 1 L θ i ( L ) = 1 ,   θ i ( L ) 0  
P ¯ S C I = P S C I [ i = 1 L j = 1 L θ i ( L ) P i 1 P ¯ i j P j 1 θ j ( L ) ] P S C I  
where the weighting coefficients  θ i ( r )  can be computed recursively by
θ i ( r ) = ω r 1 θ i ( r 1 ) ,   i = 1 , , r 1
θ r ( r ) = 1 ω r 1 ,   r = 2 , , L
θ 1 ( 2 ) = ω 1 ,   θ 2 ( 2 ) = 1 ω 1
and it is robust in the sense that for all admissible uncertainties Q ¯ and R ¯ i satisfying  Q ¯ Q ,   R ¯ i R i , we have
P ¯ S C I P S C I
It is called the robust steady-state SCI fusion Kalman filter.
Proof. 
As t , taking the limit operations for (45)–(47), and (53) yields (90)–(92), and (96). From (48)–(50), we have (93)–(95). The proof is completed. □
Theorem 10.
Under the conditions of Theorem 7, if the measurement data of y i ( t ) are bounded, then the robust local time-varying and steady-state Kalman filters x ^ i ( t | t ) and x ^ i s ( t | t ) given by (6) and (72) have each other the convergence in a realization, such that
[ x ^ i ( t | t ) x ^ i s ( t | t ) ] 0 ,   as ,   i . a . r  
Proof. 
Setting Ψ i ( t ) = Ψ i + Δ Ψ i ( t ) , K i ( t ) = K i + Δ K i ( t ) in (6), applying (82) yields Δ Ψ i ( t ) 0 , Δ K i ( t ) 0 , as t . Subtracting (72) from (6), and defining δ i ( t ) = x ^ i ( t | t ) x ^ i s ( t | t ) , we have
δ i ( t ) = Ψ i δ i ( t 1 ) + u i ( t )
with u i ( t ) = Δ Ψ i ( t ) x ^ i ( t 1 | t 1 ) + Δ K i ( t ) y i ( t ) . Noting that Ψ i ( t ) is uniformly asymptotically stable, and Δ K i ( t ) y i ( t ) is bounded, applying Lemma 3 to (6) yields the boundedness of x ^ i ( t | t ) . Hence, we have u i ( t ) 0 . Applying Lemma 3 to (98), noting that Ψ i is a stable matrix, so it is also uniformly asymptotically stable, hence δ i ( t ) 0 , i.e., the convergence (97) holds. The proof is completed. □
Theorem 11.
Under the conditions of Theorem 10, the robust time-varying and steady-state SCI fusers x ^ S C I ( t | t ) and x ^ S C I s ( t | t ) have each other the convergence in a realization, such that
[ x ^ S C I ( t | t ) x ^ S C I s ( t | t ) ] 0 ,   as   t ,   i . a . r  
Proof. 
From (87), the minimal value point ( ω 1 , , ω L ) R L of J = tr P B C I is obtained by solving nonlinear equations
J ω 1 = 0 , , J ω L = 0
According to the existence theorem [36] of implicit function, in a sufficiently small neighborhood of the point ( P i k s , i = 1 , , L , , s = 1 , , n ) R L n 2 with the definition P i = ( P i k s ) , k , s = 1 , , n , ω i can be represented by a L n 2 -dimension continuous function of all elements of P i ( i = 1 , , L ) as
ω i = f i ( P 1 , , P L ) ,   i = 1 , , L
Applying (78) with i = j yields P i ( t | t ) P i , as t . Hence for sufficiently larger t , we have
ω i ( t ) = f i ( P 1 ( t | t ) , , P L ( t | t ) ) ,   i = 1 , , L
where ω i ( t ) are defined in (25). According to the continuity of f i , if follows
ω i ( t ) ω i ,   as   t ,   i = 1 , , L
and applying (48)–(50) and (93)–(95) yields
θ i ( L ) ( t ) θ i L ,   as   t ,   i = 1 , , L
Defining
Ω i = P S C I θ i ( L ) P i 1 ,   Ω i ( t ) = P S C I ( t | t ) θ i ( L ) ( t ) P i 1 ( t | t ) = Ω i + Δ Ω i ( t )
Applying (78) with i = j , (46), (91) and (104) yields Ω i ( t ) Ω i , as t , which yields Δ Ω i ( t ) 0 .
Subtracting (85) from (45) and applying (105) yields
x ^ S C I ( t | t ) x ^ S C I s ( t | t ) = i = 1 L Ω i ( x ^ i ( t | t ) x ^ i s ( t | t ) ) + i = 1 L Δ Ω i ( t ) x ^ i ( t | t )  
Applying (82) yields the boundedness of K i ( t ) , and applying the boundedness of y i ( t ) yields that K i ( t ) y i ( t ) is bounded. Noting that Ψ i ( t ) is uniformly asymptotically stable [40]. Applying Lemma 3 to (6) yields that x ^ i ( t | t ) is bounded. Hence applying (97), (106) and Δ Ω i ( t ) 0 yields (99). The proof is completed. □
Theorem 12.
Under the conditions of Theorem 10, the robust accuracy comparison of the local and the fused robust steady-state Kalman filters is given by
tr P ¯ i tr P i ,   i = 1 , , L ,   tr P ¯ B C I tr P B C I ,   tr P ¯ S C I tr P S C I  
tr P B C I tr P i ,   i = 1 , , L  
tr P B C I tr P S C I  
tr P S C I tr P i ,   i = 1 , , L  
Proof. 
Applying (78), (79), (103) and (104) yields that P ¯ i ( t | t ) P i , P ¯ B C I ( t | t ) P B C I ,   P ¯ S C I ( t | t ) P S C I . As t , taking the limit operations for (54)–(58) yields Theorem 12. The proof is completed. □

6. Sensitivity Problem

For the SCI fusion robust Kalman filter, the fused schemes are different with respect to different orders of sensors. For example, in the case where there are three fused structures as shown in Figure 2, the problem is that whether the SCI fused robust accuracy is sensitive with respect to the fused orders of sensors. The following two sensor simulation examples will show that the robust accuracy of the SCI fuser is not very sensitive with respect to the orders of the sensors.

7. Simulation Examples

Example 1.
Consider a 3-sensor tracking system with uncertain noise variances
x ( t + 1 ) = Φ x ( t ) + Γ w ( t )  
y i ( t ) = H i x ( t ) + v i ( t ) ,   i = 1 , 2 , 3  
Φ = [ 1 T 0 0 1 ] ,   Γ = [ 0.5 Τ 0 2 T 0 ] ,   H 1 = [ 1 0 ] ,   H 2 = I 2 ,   H 3 = [ 1 0 ]  
where T 0 = 0.25 is the sampled period, x ( t ) = [ x 1 ( t ) , x 2 ( t ) ] T is the state, x 1 ( t ) and x 2 ( t ) are the position and velocity of target at time t T 0 . y i ( t ) is the measurement, w ( t ) and v i ( t ) are independent Gaussion white noises with zero mean and unknown variances Q ¯ and R ¯ i , respectively, Q and R i are conservative upper bounds of Q ¯ and R ¯ i satisfying Q ¯ Q ,   R ¯ i R i . In the simulation, we take  Q = 1 ,  R 1 = 0.8 ,  R 2 = d i a g ( 8 , 0.36 ) , R 3 = 0.5 , Q ¯ = 0.8 , R ¯ 1 = 0.65 , R ¯ 2 = d i a g ( 6 , 0.25 ) , R ¯ 3 = 0.45 .
The traces of the conservative and actual local robust filtering error variances are compared in Figure 3. For Figure 3, we see that the traces of the local and fused robust time-varying Kalman filters quickly converge to these of the corresponding steady-state Kalman filters, which verify the robust accuracy relations (54)–(58), and their steady-state robust and actual accuracy relations (107)–(110).
The robust and actual accuracy comparisons are shown in Table 3 and Table 4. From Table 3 and Table 4, we see that the SCI fused robust accuracy tr P S C I 123 , tr P S C I 132 and tr P S C I 321 are close or equal to the BCI fused robust accuracy tr P B C I , and the accuracy of the SCI fuser is not very sensitive with respect to the orders of sensor. We also see that the actual accuracy of the SCI fuser, and tr P ¯ S C I 123 , tr P ¯ S C I 132 and tr P ¯ S C I 321 are close to or equal to the actual accuracy of the BCI fuser tr P ¯ B C I ; they are all higher than the robust accuracy of each local filter, which verify the accuracy relations (54)–(58) and their steady-state robust and actual accuracy relations (107)–(110).
In order to give a geometric interpretation of the accuracy relations, The covariance ellipses of the robust time-varying Kalman filters at time t = 10 and robust steady-state Kalman filters are shown in Figure 4, Figure 5, Figure 6, Figure 7, Figure 8 and Figure 9.
From Figure 4, Figure 5, Figure 6, Figure 7, Figure 8 and Figure 9, we see that the ellipses of the actual variances P ¯ i ( i = 1 , 2 , 3 ) are all enclosed in that of the conservative variances P i , respectively, which verify the robustness (17). The ellipses of actual BCI and SCI fused variances P ¯ B C I and P ¯ S C I i j k   ( i j k = 123 , 132 , 231 ) are respectively enclosed in those of P B C I and P S C I i j k , which verifies the robustness (29) and (53). Moreover, we see that the ellipse of P ¯ B C I is close to or equal to that of P ¯ S C I i j k , the ellipse of P B C I is close to or equal to that of P S C I i j k , which means that the robust accuracies of the SCI fusers with different orders of sensors are close to those of the BCI fusers, and the robust and actual accuracies of the SCI fusers are not very sensitive to the orders of sensors.
In order to verify the above theoretical accuracy relations, taking N = 200 runs, the mean square error (MSE) value at time t of the local and fused robust Kalman filters are shown in Figure 10. From Figure 10, we see that when t is sufficiently large, we have the accuracy relations
MSE θ ( t ) tr P θ ,   θ = 1 , 2 , 3 , B C I , S C I
and the curves of MSE θ ( t ) are close to the straight lines corresponding to tr P ¯ θ , which verify the robust accuracy relations (107) and the robust accuracy relations in Table 3.
Example 2.
In order to show the sensitivity of the actual and robust accuracies for the SCI fuser with respect to the orders of sensors, consider a 4-sensor tracking system with uncertainties of noise variances
x ( t + 1 ) = Φ x ( t ) + Γ w ( t )  
y i ( t ) = H i x ( t ) + v i ( t ) ,   i = 1 , 2 , 3 , 4  
Φ = [ 1 T 0 0 1 ] ,   Γ = [ 0.5 Τ 0 2 T 0 ] ,   H 1 = [ 1 0 ] ,   H 2 = I 2 ,   H 3 = [ 1 0 ] ,   H 4 = I 2  
In the simulation,
T 0 = 0.25 ,   Q = 1 ,   R 1 = 0.8 ,   R 2 = d i a g ( 8 , 0.36 ) ,   R 3 = 0.5 ,   R 4 = d i a g ( 0.25 , 10 ) ,   Q ¯ = 0.8 ,   R ¯ 1 = 0.65 ,   R ¯ 2 = d i a g ( 6 , 0.25 ) ,   R ¯ 3 = 0.45 ,   R ¯ 4 = d i a g ( 0.2 , 9 ) .
Similar to Figure 3, for the sensor number L = 4 , there are 12 fused orders as follows:
SCI1234, SCI1243, SCI1324, SCI1342, SCI1423, SCI1432,
SCI2314, SCI2341, SCI2413, SCI2431, SCI3412, SCI3421
Table 5 shows the sensitivity of the actual and robust accuracies for the SCI fuser with respect to the orders of sensors
From Table 5, we see that all values of tr P S C I i j k r or tr P ¯ S C I i j k r are close to these of tr P B C I or tr P ¯ B C I , respectively. This means that the robust or actual accuracies of the SCI fusers are not very sensitive to the orders of sensors.

8. Conclusions

Sequential covariance intersection fusion robust time-varying Kalman filters are presented for the multi-sensor systems with uncertainties of noise variances, the main contributions of this paper are as follows:
A minimax robust estimation approach of designing the robust local, BCI and SCI fused Kalman filters has been presented for the multisensor system with uncertain noise variances. For the multisensor time-invariant systems with uncertain noise variances, the convergence problem of the robust local and fused time-varying Kalman filters has been solved. The robust local, BCI and SCI fused steady-state Kalman filters have been presented by replacing the time-varying gains, variances and cross-covariances with their limits, respectively. The convergence in a realization of the local and fused time-varying and steady-state Kalman filters was proved by the dynamic error system analysis (DESA) method [39] and the dynamic variance error system analysis (DVESA) method [40].
The proposed results can be applied to some simulation application research, including target tracking systems, uninterruptible power supply systems, mass spring random vibration systems, and so on. The proposed results are limited to multisensor systems with uncertainties of noise variances. The extensions of the proposed results to multisensor systems with uncertainties of both model parameters and noise variances are under investigation.

Author Contributions

Conceptualization, W.Q.; software, S.W.; formal analysis, W.Q.; investigation, W.Q.and S.W.; resources, W.Q.; data curation, W.Q.and S.W.; writing—original draft preparation, W.Q.; writing—review and editing, W.Q. and S.W.; supervision, S.W.; project administration, S.W.; funding acquisition, W.Q. and S.W. All authors have read and agreed to the published version of the manuscript.

Funding

This work is supported by the Natural Science Foundation of China under grant (No. 61703147) and the Natural Science Foundation of Heilongjiang Province under Grant (No. LH2021E100).

Acknowledgments

The authors thank the reviewers and editors for their helpful and constructive comments which are very valuable for improving quality of this paper.

Conflicts of Interest

The authors declare no conflict of interest.

References

  1. Cui, L.L.; Wang, X.; Wang, H.Q.; Ma, J.F. Research on Remaining Useful Life Prediction of Rolling Element Bearings Based on Time-VaryingKalman Filter. IEEE Trans. Instrum. Meas. 2020, 69, 2858–2867. [Google Scholar] [CrossRef]
  2. Stefano, M.; Nicola, P. Improved Tracking and Docking of Industrial Mobile Robots Through UKF Vision-Based Kinematics Calibration. IEEE Access 2021, 9, 127664–127671. [Google Scholar]
  3. Stepanov, O.A. Kalman filtering: Past and present. An outlook from Russia. (On the occasion of the 80th birthday of Rudolf Emil Kalman). Gyroscopy Navig. 2011, 2, 99–110. [Google Scholar] [CrossRef]
  4. Petersen, I.R.; Savkin, A.V. Robust Kalman Filtering for Signals and Systems with Large Uncertainties; Birkhauser: Boston, MA, USA, 1999. [Google Scholar]
  5. Carlson, N.A. Federated filter for fault-tolerant integrated navigation systems. In Proceedings of the IEEE PLANS’88, Position Location and Navigation Symposium, Record, ‘Navigation into the 21st Century’, Orlando, FL, USA, 29 November–2 December 1988; pp. 110–119. [Google Scholar]
  6. Tupysev, V.A.; Litvinenko, Y.A. The effect of the local filter adjustment on the accuracy of federated filters. IFAC-PapersOnLine 2015, 48, 339–344. [Google Scholar] [CrossRef]
  7. Maier, A.; Kiesel, S.; Trommer, G.F. Performance Analysis of Federated Filter for SAR/TRN/GPS/INS Integration. Gyroscopy Navig. 2011, 2, 203–300. [Google Scholar] [CrossRef]
  8. Lewis, F.L.; Xie, L.H.; Popa, D. Optimal and Robust Estimation, 2nd ed.; CRC Press: Boca Raton, FL, USA, 2008. [Google Scholar]
  9. Rocha, K.D.; Terra, M.H. Robust Kalman filterfor systems subject to parametric uncertainties. Syst. Control. Lett. 2021, 157, 1–10. [Google Scholar] [CrossRef]
  10. Xie, L.H.; Soh, Y.C.; Souza, C.E. Robust Kalman filtering for uncertain discret-time systems. IEEE Trans. Autom. Control 1994, 39, 1310–1314. [Google Scholar]
  11. Theodor, Y.; Sharked, U. Robust discrete-time minimum-variance filtering. IEEE Trans. Signal Processing 1996, 44, 181–189. [Google Scholar] [CrossRef]
  12. Ebihara, Y.; Hagivara, T. A dilated LMI approach to robust performance analysis of linear time-invariant uncertain systems. Automatica 2005, 41, 1933–1941. [Google Scholar] [CrossRef]
  13. Xie, L.H.; Lu, L.L.; Zhang, D.; Zhang, H.S. Improved robust H2 and H filtering for uncertain discrete-time system. Automatica 2004, 40, 873–880. [Google Scholar] [CrossRef] [Green Version]
  14. Feng, J.X.; Wang, Z.D.; Zeng, M. Distrbuted weighted fusion robust Kalman filter fusion for uncertain systems with autocorrelated and cross-correlated noises. Inf. Fusion 2013, 14, 78–86. [Google Scholar] [CrossRef]
  15. Chen, B.; Yu, L.; Zhang, W.A.; Liu, A.D. Distributed robust Kalman filtering for uncertain stochastic systems with random delays and missing measurements. In Proceedings of the 2011 Asian Control Conference (ASCC), Kaohsiung, Taiwan, 15–18 May 2011; pp. 1288–1293. [Google Scholar]
  16. Zhang, M.; Cui, P. Multi-sensor optimal robust information fusion for uncertain systems with colored noises. In Proceedings of the 2009 4th IEEE Conference on Industrial Electronics and Applications, Xian, China, 25–27 May 2009; pp. 1220–1224. [Google Scholar]
  17. Qu, X.M.; Zhou, J. The optiaml robust finite-horizon Kalman filtering for multiple sensors with different stochastic failure rates. Appl. Math. Lett. 2013, 26, 80–86. [Google Scholar] [CrossRef]
  18. Liggins, M.E.; Hall, D.L.; Llinas, J. Handbook of Multisensor Data Fusion. In Theory and Practice, 2nd ed.; CRC Press: Boca Raton, FL, USA, 2009. [Google Scholar]
  19. Wang, S.G.; Bi, Y.L.; Qi, W.J.; Li, B.H.; Cai, K. Non-fragile load frequency control of multi-area power system with energy storage system and wind power subject to circular pole constraints. Sustain. Energy Technol. Assess. 2021, 45, 1–9. [Google Scholar] [CrossRef]
  20. Huang, G.Q. Visual-inertial navigation: A concise review. In Proceedings of the 2019 International Conference on Robotics and Automation (ICRA), Xian, China, 25–27 May 2019. [Google Scholar]
  21. Nam, D.V.; Kim, G.W. Robust stereo visual-inertial navigation system based on multi-stage outlier removal in dynamic environments. Sensors 2020, 20, 2922. [Google Scholar] [CrossRef] [PubMed]
  22. Deng, Z.L.; Zhang, P.; Qi, W.J.; Gao, Y.; Liu, J.F. The accuracy comparison of multisensor covariance intersection fuser and three weighting fusers. Inf. Fusion 2013, 14, 177–185. [Google Scholar] [CrossRef]
  23. Sun, S.L.; Deng, Z.L. Multi-sensor optimal information Kalman filter. Automatica 2004, 40, 1017–1023. [Google Scholar] [CrossRef]
  24. Sun, X.J.; Deng, Z.L. Information fusion Wiener filter for the multisensor multichannel ARMA signals with time-delayed measurements. Signal Processing 2009, 3, 403–415. [Google Scholar] [CrossRef]
  25. Julier, S.J.; Uhlman, J.K. Non-divergent estimation algorithm in the presence of unknown correlations. Am. Control. Conf. 1997, 4, 2369–2373. [Google Scholar]
  26. Julier, S.J.; Uhlman, J.K. General decentralized data fusion with Covariance Intersection. In Handbook of Multisensor Data Fusion, Theroy and Practice, 2nd ed.; Liggins, M.E., Hall, D.L., Llinas, J., Eds.; CRC Press: Boca Raton, FL, USA, 2009; pp. 319–342. [Google Scholar]
  27. Uhlman, J.K. Covariance consistency methods for fault-tolerant distributed data fusion. Inf. Fusion 2003, 4, 201–205. [Google Scholar] [CrossRef]
  28. Uhlman, J.K. General data fusion for estimates with unknown cross-covariances. In Proceedings of the SPIE Aerosense Confeorence, Orlando, FL, USA, 8–12 April 1996; pp. 165–173. [Google Scholar]
  29. Julier, S.J.; Uhlman, J.K. Using covariance intersection for SLAM. Robot. Auton. Syst. 2007, 55, 3–20. [Google Scholar] [CrossRef]
  30. De, J.C.B.; Ferreira, C.; Waldman, J. Covariance intersection-based sensor fusion for sounding roket tracking and impact area prediction. Control. Eng. Pract. 2007, 15, 389–409. [Google Scholar]
  31. Arambel, P.O.; Rago, C.; Mehra, R.K. Covariance intersection algorithm for distributed spacecraft state estimation. Processings Am. Control. Conf. 2001, 6, 4398–4403. [Google Scholar]
  32. Guo, Q.; Chen, S.Y.; Leung, H.R.; Liu, S.T. Covariance intersection based image fusion technology with application to pansharpening in remote sensing. Inf. Sci. 2010, 180, 3434–3443. [Google Scholar] [CrossRef]
  33. Lazarus, S.B.; Ashokaraj, I.; Tshurdos, S.; Zbikwski, R.; Silson, P.M.G.; Aouf, N.; White, B.A. Vehicle localization using sensors data fusion via integration of covariance intersection and interval analysis. IEEE Sens. J. 2009, 7, 1302–1314. [Google Scholar] [CrossRef]
  34. Deng, Z.L.; Zhang, P.; Qi, W.J.; Liu, J.F.; Gao, Y. Sequential covariance intersection fusion Kalman filter. Inf. Sci. 2012, 189, 293–309. [Google Scholar] [CrossRef]
  35. Qu, X.M.; Zhou, J.; Song, E.B.; Zhu, Y.M. Minimax robust optimal estimation fusion in distributed multisensor systems with uncertainties. IEEE Signal Prrocessing Lett. 2008, 17, 811–814. [Google Scholar]
  36. Eldar, Y.C.; Beck, A.; Teboulle, M. A minimax chebyshev estimator for bounded error estimation. IEEE Trans. Signal Processing 2008, 56, 1388–1397. [Google Scholar] [CrossRef] [Green Version]
  37. Deng, Z.L.; Gao, Y.; Li, C.B.; Hao, G. Self-tuning decoupled information fusion Wiener state component filters and their convergence. Automatica 2008, 44, 685–695. [Google Scholar] [CrossRef]
  38. Ran, C.J.; Tao, G.L.; Liu, J.F.; Deng, Z.L. Self-tuning decoupled fusion Kalman predictor and its convergence analysis. IEEE Sens. J. 2009, 9, 2024–2032. [Google Scholar] [CrossRef]
  39. Kailath, T.; Sayed, A.H.; Hassibi, B. Linear Estimation; Prentice Hall: New York, NY, USA, 2000. [Google Scholar]
  40. Kamen, E.W.; Su, J.K. Introduction to Optimal Estimation; Springer: London, UK, 1999. [Google Scholar]
Figure 1. The structure of the SCI fusion robust Kalman filter.
Figure 1. The structure of the SCI fusion robust Kalman filter.
Micromachines 13 01216 g001
Figure 2. The fused orders of the SCI fusers in the L = 3 case. (a) The order 1: SCI123; (b) The order 2: SCI132; (c) The order 3: SCI231.
Figure 2. The fused orders of the SCI fusers in the L = 3 case. (a) The order 1: SCI123; (b) The order 2: SCI132; (c) The order 3: SCI231.
Micromachines 13 01216 g002
Figure 3. The robust accuracy relations of the local and fused robust Kalman filters.
Figure 3. The robust accuracy relations of the local and fused robust Kalman filters.
Micromachines 13 01216 g003
Figure 4. The ellipses of the actual and conservative time-varying filtering error variances of the order S C I 123 at t = 10 .
Figure 4. The ellipses of the actual and conservative time-varying filtering error variances of the order S C I 123 at t = 10 .
Micromachines 13 01216 g004
Figure 5. The ellipses of the actual and conservative steady-state filtering error variances of the order S C I 123 .
Figure 5. The ellipses of the actual and conservative steady-state filtering error variances of the order S C I 123 .
Micromachines 13 01216 g005
Figure 6. The ellipses of the actual and conservative time-varying filtering error variances of the order S C I 132 at t = 10 .
Figure 6. The ellipses of the actual and conservative time-varying filtering error variances of the order S C I 132 at t = 10 .
Micromachines 13 01216 g006
Figure 7. The ellipses of the actual and conservative steady-state filtering error variances of the order S C I 132 .
Figure 7. The ellipses of the actual and conservative steady-state filtering error variances of the order S C I 132 .
Micromachines 13 01216 g007
Figure 8. The ellipses of the actual and conservative time-varying filtering error variances of the order S C I 231 at t = 10 .
Figure 8. The ellipses of the actual and conservative time-varying filtering error variances of the order S C I 231 at t = 10 .
Micromachines 13 01216 g008
Figure 9. The ellipses of the actual and conservative steady-state filtering error variances of the order S C I 231 .
Figure 9. The ellipses of the actual and conservative steady-state filtering error variances of the order S C I 231 .
Micromachines 13 01216 g009
Figure 10. The comparison of MSE i ( t ) and tr P i , i = 1 , 2 , 3 , S C I 123 , S C I 132 , S C I 231 , B C I .
Figure 10. The comparison of MSE i ( t ) and tr P i , i = 1 , 2 , 3 , S C I 123 , S C I 132 , S C I 231 , B C I .
Micromachines 13 01216 g010
Table 1. The frequently used notations.
Table 1. The frequently used notations.
NameSummary
t the discrete time
Φ ( t ) the state transition matrix
Γ ( t ) the input transition matrix
H i ( t ) the measurement transition matrix.
A the norm of matrix A.
k the discrete time
E the mathematical expectation operator
A T transpose of matrix A
δ i j the Kronecker δ   function ,   δ i i = 1 , δ i j = 0 ( i j )
tr A the trace of a matrix A
s“steady-state”
“i.a.r”the convergence in a realization
Table 2. The comparison of the computational loads.
Table 2. The comparison of the computational loads.
robust BCI filter P B C I ( t | t ) ( ( N + 1 ) n ) 3
robust SCI filter P S C I ( t | t ) n 3 N
Table 3. The accuracy comparison of local and fused robust time-varying Kalman filters at t = 10 .
Table 3. The accuracy comparison of local and fused robust time-varying Kalman filters at t = 10 .
tr P 1 tr P 2 tr P 3 tr P B C I tr P S C I 123 tr P S C I 132 tr P S C I 231
0.62890.69720.47840.38390.43180.38880.3888
tr P ¯ 1 tr P ¯ 2 tr P ¯ 3 tr P ¯ B C I tr P ¯ S C I 123 tr P ¯ S C I 132 tr P ¯ S C I 231
0.51470.57190.41320.18130.18180.19050.1905
Table 4. The robust accuracy comparison of local and fused steady-state Kalman filters.
Table 4. The robust accuracy comparison of local and fused steady-state Kalman filters.
tr P 1 tr P 2 tr P 3 tr P B C I tr P S C I 123 tr P S C I 132 tr P S C I 231
0.55380.52450.43900.36020.39710.36480.3648
tr P ¯ 1 tr P ¯ 2 tr P ¯ 3 tr P B C I tr P ¯ S C I 123 tr P ¯ S C I 132 tr P ¯ S C I 231
0.44650.38150.37230.17170.17590.17950.1795
Table 5. The sensitivity of the actual and robust accuracies for the SCI fuser with respect to the orders of sensors.
Table 5. The sensitivity of the actual and robust accuracies for the SCI fuser with respect to the orders of sensors.
tr P 1 tr P ¯ 1 tr P 2 tr P ¯ 2 tr P 3 tr P ¯ 3 tr P 4 tr P ¯ 4 tr P B C I tr P ¯ B C I
0.55380.44650.52450.38150.43900.37230.47860.40260.33120.1231
tr P S C I 1234 tr P ¯ S C I 1234 tr P S C I 1243 tr P ¯ S C I 1243 tr P S C I 1324 tr P ¯ S C I 1324 tr P S C I 1342 tr P ¯ S C I 1342 tr P S C I 1423 tr P ¯ S C I 1423
0.36220.12070.36750.14070.35470.13250.33120.16110.36390.1482
tr P S C I 1432 tr P ¯ S C I 1432 tr P S C I 2314 tr P ¯ S C I 2314 tr P S C I 2341 tr P ¯ S C I 2341 tr P S C I 2413 tr P ¯ S C I 2413 tr P S C I 2431 tr P ¯ S C I 2431
0.36390.14820.35470.13950.35470.13250.36390.14820.33120.1611
tr P S C I 3412 tr P ¯ S C I 3412 tr P S C I 3421 tr P ¯ S C I 3421
0.33120.16110.33120.1611
Publisher’s Note: MDPI stays neutral with regard to jurisdictional claims in published maps and institutional affiliations.

Share and Cite

MDPI and ACS Style

Qi, W.; Wang, S. Sequential Covariance Intersection Fusion Robust Time-Varying Kalman Filters with Uncertainties of Noise Variances for Advanced Manufacturing. Micromachines 2022, 13, 1216. https://doi.org/10.3390/mi13081216

AMA Style

Qi W, Wang S. Sequential Covariance Intersection Fusion Robust Time-Varying Kalman Filters with Uncertainties of Noise Variances for Advanced Manufacturing. Micromachines. 2022; 13(8):1216. https://doi.org/10.3390/mi13081216

Chicago/Turabian Style

Qi, Wenjuan, and Shigang Wang. 2022. "Sequential Covariance Intersection Fusion Robust Time-Varying Kalman Filters with Uncertainties of Noise Variances for Advanced Manufacturing" Micromachines 13, no. 8: 1216. https://doi.org/10.3390/mi13081216

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop