# Multiple Adaptive Fading Schmidt-Kalman Filter for Unknown Bias

Authors: Tai-Shan Lou; Zhi-Hua Wang; Meng-Li Xiao; Hui-Min Fu
Journal: Mathematical Problems in Engineering
 (2014)

---

## Abstract

Unknown biases in dynamic and measurement models of the dynamic systems can bring greatly negative effects to the state estimates when using a conventional Kalman filter algorithm. Schmidt introduces the “consider” analysis to account for errors in both the dynamic and measurement models due to the unknown biases. Although the Schmidt-Kalman filter “considers” the biases, the uncertain initial values and incorrect covariance matrices of the unknown biases still are not considered. To solve this problem, a multiple adaptive fading Schmidt-Kalman filter (MAFSKF) is designed by using the proposed multiple adaptive fading Kalman filter to mitigate the negative effects of the unknown biases in dynamic or measurement model. The performance of the MAFSKF algorithm is verified by simulation.


---

## Body

## 1. Introduction

An underlying assumption of the Kalman filter is that the dynamic and measurement equations can be accurately modeled without any colored noise or unknown biases. However, in practice, these dynamic and measurement models include some additional biases, which always bring greatly negative effects to the state estimate.There are many methodologies to deal with these unknown biases. Ignoring them and augmenting them to estimate are two common approaches. Based on the sensitivity to the unknown bias, some techniques have been proposed, such asΗ
∞ filtering [1, 2], set-valued estimation [3], and Schmidt-Kalman filter (SKF) [4]. Schmidt proposed a “consider” analysis, which is the cornerstone of the SKF, to account for errors in both the dynamic and measurement models due to the unknown biases when the biases are considered as constants and remain unchanged [4]. Based on a minimum variance approach, the key idea of the SKF is the “consider” analysis that the preestimated bias covariance is formulated to update the state and covariance estimates, but these biases themselves are not estimated directly. The “consider” approach is especially useful when the unknown biases are low observable or when the extra computational power to estimate them is not worth [5].After Schmidt, the “consider” approach for parameters has received much attention in recent years. The SKF is also called the consider Kalman filter (CKF) after its developer. Jazwinski provides the detailed derivation of the CKF in his book [6]. Subsequently, Tapley et al. amply descript the CKF and derivate a different formulation [7]. Zanetti and Souza introduce the UDU formulation into the SKF and provide a numerically stability, recursive implementation of the UDU SKF [8]. Bierman analyzes the effects on filtering accuracy of the unestimated biases and incorrecta priori covariance statistics and proposes a sensitivity matrix to evaluate them [9]. Woodbury et al. give novelty insight into considering biases in the measurement model and verify the negative effect of the errors in the initial parameter and covariance estimates [5, 10]. Chee and Forbes propose a norm-constrained consider Kalman filtering by taking into account the constraint on the state estimate and apply it to a nonlinear attitude estimation problem [11].However, how to mitigate these negative effects from the initial state and covariance values of the unknown biases in the SKF has not attracted much attention. In fact, when the inaccurate initial and covariance values, that is to say the biases are not accurately modeled, are used to update the state and covariance estimates, the accuracy of the state and covariance estimates may greatly degrade. Fortunately, the adaptive technique is proposed to improve the convergence of the filtering. As a member of the adaptive Kalman filtering algorithms, the adaptive fading Kalman filtering algorithm is proposed to use a single adaptive fading factor (FF) as a multiplier to the dynamic or measurement noise covariance when the information about the dynamic or measurement model is incomplete [12–15]. Then, to consider the complex systems with multivariable, a single fading factor is not sufficiently used, and so the multiple fading factor, which is the footstone of multiple adaptive fading Kalman filtering (MAFKF), is proposed to reflect corrective effects of the multivariable in filtering [16–19]. But in the MAFKF the multiple fading factors are only used as a multiplier for the lastposteriori covariance of the states, and the method for the wholepriori covariance of the states is not considered until now.To consider the incomplete information from both the covariance of the states and noises, the MAFKF is proposed to use the multiple fading factor as a multiplier on the outside of the wholepriori error covariance equation. The proposed MAFKF not only considers the uncertainty of the models but also adjusts the covariance of inaccurate modeled noises. In addition, the multiple fading factors are derived by one-step approximate algorithm to decrease the computational complexity in the MAFKF algorithm. Then, the multiple adaptive fading Schmidt-Kalman filter (MAFSKF) is designed by using the above MAFKF to mitigate the negative effects of the uncertain parameters in dynamic or measurement model.This paper is organized as follows. First, the problem statement with the unknown biases is given. Second, the MAFKF algorithm is proposed to compensate the effect of inaccuracy information covariance. Third, the MAFSKF is designed to mitigate the negative effects of the unknown biases. Finally, the performance of the MAFSKF algorithm is verified by simulation and the results are discussed as well.


## 2. Problem Statement

Consider a linear discrete dynamic system with the unknown biases as follows:(1a)
x
k
+
1
=
Φ
k
+
1
k
x
k
+
Ψ
k
+
1
k
p
k
+
G
k
w
k
(1b)
z
k
=
H
k
x
k
+
N
k
b
k
+
v
k
,where x
k is the n
×
1 state vector and z
k is the m
×
1 measurement vector. Φ
k
+
1
k and Ψ
k
+
1
k are the state and bias transition matrices, G
k is the coefficient matrix of the process noise, H
k is the measurement matrix, and N
k is the measurement bias transition matrix. p
k is referred to as the n
p
×
1 dynamical bias vector and b
k is called the m
b
×
1 measurement bias vector. w
k and v
k are independent zero-mean Gaussian noise processes and their covariance are, respectively, Q
k and R
k. They satisfy
(2)
E
w
i
w
j
T
=
Q
k
δ
i
j
,
E
v
i
v
j
T
=
R
k
δ
i
j
,
E
w
i
v
j
T
=
0
,
where δ
i
j is the Kronecker delta function and Q
k
>
0, R
k
>
0.Here, the biasesp
k and b
k, which are considered as unknown constants and remain the same in filtering, are modeled as
(3)
p
k
+
1
=
p
k
,
p
0
=
p
,
b
k
+
1
=
b
k
,
b
0
=
b
.
The initial states x
0 and biases p
0 and b
0 are assumed to be independent of the Gaussian noise w
k and v
k and be Gaussian random variables with
(4)
E
x
0
=
x
^
0
,
E
x
0
-
x
^
0
x
0
-
x
^
0
T
=
P
0
>
0
,
E
p
0
=
p
^
0
,
E
p
0
-
p
^
0
p
0
-
p
^
0
T
=
Q
0
p
>
0
,
E
b
0
=
b
^
0
,
E
b
0
-
b
^
0
b
0
-
b
^
0
T
=
Q
0
b
>
0
,
E
x
0
-
x
^
0
p
0
-
p
^
0
T
=
C
0
x
p
,
E
x
0
-
x
^
0
b
0
-
b
^
0
T
=
C
0
x
b
.Based on the assumption that the stochastic information of the unknown biases is incomplete, a multiple adaptive fading Schmidt-Kalman filter is designed to overcome the problem with the unknown biases.


## 3. MAFKF Algorithm

Consider the linear discrete stochastic system as follows:(5a)
x
k
+
1
=
Φ
k
+
1
k
x
k
+
G
k
w
k
,
(5b)
z
k
=
H
k
x
k
+
v
k
.If the system is observable, the optimal estimate is given by the conventional Kalman filter [7]. Unfortunately, the information is always incomplete in practice, and this leads the filter to “learn the wrong state too well” [20]. To compensate the effects of the incomplete information, the adaptive fading Kalman filter (AFKF) is proposed to overcome the problem [12, 13]. When the older data from the current estimate are no longer meaningful due to the erroneous model, the negative effects of these data are mitigated by the AFKF. Between the AFKF and the conventional Kalman filter, the big difference is that a constant fading factor is inserted into thea priori error covariance equation. There are three representative types with a single fading factor to be assigned [12, 13, 15, 21],(6a)
P
k
+
1
k
=
λ
k
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
,
(6b)
P
k
+
1
k
=
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
λ
k
G
k
Q
k
G
k
T
,
(6c)
P
k
+
1
k
=
λ
k
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
.However, only one constant fading factor cannot “weight” the covariance of all states, and the optimal filtering cannot be guaranteed, especially for the complicated multivariable systems. To overcome the shortcomings of the single fading factor, Zhou et al. [16] proposed a suboptimal multiple fading extended Kalman filter by using the error covariance equation of (6a), in which the single fading factor λ
k is substituted by a multiple fading factor matrix S
k, and the orthogonality of the residual errors is remained. Zhou et al. also gave one-step approximation algorithm of the multiple fading factor and verified the affectivity of the multiple fading factor in filtering. The equation of (6b) and (6c) was considered for a single fading factor in the literature [13, 16]. But for the multiple fading factor, no researchers consider the last two equations. To consider the incomplete information from both the covariance of the states and noises, the multiple fading factor should be inserted on the outside of thea priori error covariance equation. Hence, based on (6c) as the comment in the literature [17], the proposed MAFKF is defined as
(7)
P
k
+
1
k
=
S
k
+
1
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
,
where S
k
+
1
=
diag
⁡
{
λ
1
,
k
+
1
,
λ
2
,
k
+
1
,
…
,
λ
n
,
k
+
1
}; λ
i
,
k
+
1
≥
1
(
i
=
1,2
,
…
,
n
) is the multiple fading factor.In the conventional Kalman filter, the predicted residual vector can be expressed as(8)
γ
k
+
1
=
z
k
+
1
-
H
k
+
1
x
^
k
+
1
k
and the corresponding innovation covariance matrix can be calculated as
(9)
Ω
k
+
1
=
E
γ
k
+
1
γ
k
+
1
T
=
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
R
k
+
1
,
where P
k
+
1
k isa priori error covariance of the linear Kalman filter.In the optimal linear Kalman filter, there is an orthogonal principle that the predicted residual sequenceγ
k is mutually orthogonal when the optimal gain matrix is calculated online [16]. The optimal gain matrix is obtained in the linear Kalman filter by minimizing the following equation:
(10)
E
x
k
+
1
-
x
^
k
+
1
x
k
+
1
-
x
^
k
+
1
T
,
k
=
0,1
,
2
,
…
,
and then the following equation is satisfied:
(11)
E
γ
k
+
j
+
1
γ
k
+
1
T
=
0
,
k
=
0,1
,
2
,
…
,
j
=
1,2
,
3
,
…
.
Substituting (8) into the left formula of (11), the result can be obtained as follows:
(12)
E
γ
k
+
j
+
1
γ
k
+
1
T
=
H
k
+
j
+
1
Φ
k
+
j
+
1
k
+
j
I
-
K
k
+
j
H
k
+
j
⋯
Φ
k
+
3
k
+
2
×
I
-
K
k
+
2
H
k
+
2
Φ
k
+
2
k
+
1
Λ
k
+
1
,
j
=
1,2
,
3
,
…
,
where Λ
k
+
1 is defined as (for all k
=
0,1
,
2,3
,
…)
(13)
Λ
k
+
1
=
P
k
+
1
k
H
k
+
1
T
-
K
k
+
1
Ω
k
+
1
.
Substituting the optimal gain matrix K
k
+
1
=
P
k
+
1
k
H
k
+
1
T
[
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
R
k
+
1
]
-
1 of the linear Kalman filter into (13), Λ
k
+
1 is identically zero, and this means that (12) is identical to zero, too. The orthogonal principle is right when the optimal gain matrix is inserted.In practice, the dynamic model of the stochastic system always is partially known, and so the real covariance matrix may be increased by the unknown information, and it is different from the theoretical covarianceΩ
k
+
1 in (9). Thus, the real autocovariance matrix E
[
γ
k
+
j
+
1
γ
k
+
1
T
] may not be identically zero. For (12), if the multiple fading factor in (7) is chosen so that Λ
k
+
1
=
0, then the gain matrix K
k
+
1 is optimal. From the above, it can be seen that if K
k
+
1 is optimal, Λ
k
+
1
=
0 in (12), and if Λ
k
+
1
=
0, K
k
+
1 is optimal. The basic idea to design the adaptive fading filtering is obtained from aforementioned analysis.Hence, the optimality of the Kalman filter can be evaluated by the following function constructed:(14)
g
λ
k
+
1
=
∑
i
=
1
n
∑
j
=
1
m
Λ
i
j
,
k
+
1
2
,
where Λ
k
+
1
=
(
Λ
i
j
,
k
+
1
)
n
m and λ
k
+
1
=
λ
1
,
k
+
1
,
λ
2
,
k
+
1
,
…
,
λ
n
,
k
+
1
T. g
(
λ
k
+
1
) describes the distance to the optimal estimate in linear Kalman filter. When g
(
λ
k
+
1
) is minimum, a suboptimal estimate, which is the most close to the optimal estimate, will be obtained. Hence, we can obtain the multiple fading factor S
k by minimizing (14) as follows:
(15)
min
⁡
λ
k
⁡
g
λ
k
.Obviously, (15) can be solved by using any unconstrained multivariate nonlinear programming methods. However, finding the optimal solution is not suitable for the online state estimate [16]. Hence, a one-step approximate algorithm is proposed to obtain the multiple fading factors S
k for the online calculating.Here, when thea priori characters of the system are roughly known, we can assume that
(16)
λ
1
,
k
+
1
:
λ
2
,
k
+
1
:
⋯
:
λ
n
,
k
+
1
=
β
1
:
β
2
:
⋯
:
β
n
and then set
(17)
λ
i
,
k
+
1
=
β
i
τ
k
+
1
,
i
=
1,2
,
…
,
n
,
where β
i
≥
1 is the constant from the prognosis to the state and τ
k
+
1 is the undetermined factor.Substituting the Kalman gain matrixK
k
+
1
=
P
k
+
1
k
H
k
+
1
T
[
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
R
k
+
1
]
-
1 into the Λ
k
+
1
=
0 generates
(18)
P
k
+
1
k
H
k
+
1
T
I
-
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
R
k
+
1
-
1
Ω
k
+
1
=
0
.
It is obvious that one sufficient condition to establish (18) is
(19)
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
R
k
+
1
-
1
Ω
k
+
1
=
I
or
(20)
H
k
+
1
P
k
+
1
k
H
k
+
1
T
=
Ω
k
+
1
-
R
k
+
1
.Substituting (7) into (20) and reorganizing it gives
(21)
H
k
+
1
S
k
+
1
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
H
k
+
1
T
=
Ω
k
+
1
-
R
k
+
1
.
From the right part of (21), it is seen that the multiple fading factor S
k
+
1 is valid when Ω
k
+
1
-
R
k
+
1
>
0 is satisfied [16]. For the measurement covariance matrix R
k
+
1
>
0, a softening factor ε
≥
1, which is usually given by experience, is introduced to weaken the excessive adjust of the multiple fading factor and smooth the state estimates. Hence, (21) is restructured as
(22)
H
k
+
1
S
k
+
1
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
H
k
+
1
T
=
Ω
k
+
1
-
ε
R
k
+
1
.Based on the property of commutative matrices in trace operatortr
⁡
[
A
B
]
=
tr
⁡
[
B
A
], the trace of both sides in (22) is calculated as
(23)
tr
⁡
S
k
+
1
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
H
k
+
1
T
H
k
+
1
=
tr
⁡
Ω
k
+
1
-
ε
R
k
+
1
.Simplify (23) as
(24)
tr
⁡
S
k
+
1
M
k
+
1
=
tr
⁡
O
k
+
1
,
where
(25)
M
k
+
1
=
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
H
k
+
1
T
H
k
+
1
,
(26)
O
k
+
1
=
Ω
k
+
1
-
ε
R
k
+
1
.In fact, the real residual covariance matrixΩ
k
+
1 in (26) is unknown but can be evaluated by the following equation [16]:
(27)
Ω
k
+
1
=
γ
1
γ
1
T
,
k
=
1
ρ
Ω
k
+
γ
k
+
1
γ
k
+
1
T
1
+
ρ
,
k
>
1
,
where ρ is a forgetting factor, which is 0
<
ρ
≤
1.Substituting (17) into (24) gives
(28)
tr
⁡
β
1
τ
k
+
1
β
2
τ
k
+
1
⋱
β
n
τ
k
+
1
M
k
+
1
=
tr
⁡
O
k
+
1
and then τ
k
+
1 is calculated as
(29)
τ
k
+
1
=
tr
⁡
O
k
+
1
∑
i
=
1
n
β
i
M
i
i
,
k
+
1
.Synthesizing conditionλ
i
,
k
+
1
≥
1 and (17), (29) gives
(30)
λ
i
,
k
+
1
=
max
⁡
1
,
β
i
τ
k
+
1
,
i
=
1,2
,
…
,
n
.Algorithm 1 (one-step approximate MAFKF).
A discrete-time multiple adaptive fading Kalman filter is proposed by the following equations when the information about the linear stochastic system is incomplete:(31a)
x
^
k
+
1
k
=
Φ
k
+
1
k
x
^
k
,
(31b)
P
k
+
1
k
=
S
k
+
1
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
,
(31c)
K
k
+
1
=
P
k
+
1
k
H
k
+
1
T
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
R
k
+
1
-
1
,
(31d)
x
^
k
k
=
x
^
k
k
-
1
+
K
k
γ
k
+
1
,
(31e)
P
k
=
I
-
K
k
H
k
P
k
k
-
1
,where
(32)
γ
k
+
1
=
z
k
+
1
-
H
k
+
1
x
^
k
+
1
k
,
S
k
+
1
=
diag
⁡
λ
1
,
k
+
1
,
λ
2
,
k
+
1
,
…
,
λ
n
,
k
+
1
,
λ
i
,
k
+
1
=
max
⁡
1
,
β
i
τ
k
+
1
,
i
=
1,2
,
…
,
n
,
τ
k
+
1
=
tr
⁡
O
k
+
1
∑
i
=
1
n
β
i
M
i
i
,
k
+
1
,
M
k
+
1
=
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
G
k
Q
k
G
k
T
H
k
+
1
T
H
k
+
1
,
O
k
+
1
=
Ω
k
+
1
-
ε
R
k
+
1
,
Ω
k
+
1
=
γ
1
γ
1
T
,
k
=
1
ρ
Ω
k
+
γ
k
+
1
γ
k
+
1
T
1
+
ρ
,
k
>
1
.To consider the difference between the states and the multisource incomplete information, the MAFKF algorithm is proposed to use the multiple fading factor as a multiplier for the wholea priori covariance P
k
+
1
k of the states and mitigate the negative effects of the uncertainties. Compared to the single adaptive fading Kalman filter, the MAFKF is introduced into the multiple fading factor and adjusts each component of the state vector by different fading factor to perform better. In addition, the multiple fading factor is derived by one-step approximate algorithm to decrease the computational complexity.The asymptotical stability of the proposed MAFKF is easily proved in the literature [15], by using the results in the literature [22–24].Remarks. The proportionality factor β
i of the multiple fading factor S
k can be designed with thea priori knowledge of the states before the filtering [16].


## 4. MAFSKF for the Unknown Biases

The unknown biases in the problem statement (1a) and (1b) have a greatly negative impact on the filter accuracy and even result in filter divergence [6]. In the SKF algorithm, the covariance of unknown biases is used to update the state and covariance estimates but is not estimated directly. However, as the most important part in the SKF, the unknown covariance matrices Q
0
p and Q
0
b and the uncertain initial values of the unknown biases are still not considered. To consider the negative effects in the SKF filtering from this incomplete information, the MAFKF is proposed to solve this problem. Based on the two aforementioned aspects, the MAFSKF is designed by using the MAFKF and the conventional SKF.Similarly to (8) and (9) in the conventional Kalman filter, the predicted residual vector and the corresponding innovation covariance matrix in SKF can be expressed as
(33)
γ
k
+
1
=
z
k
+
1
-
H
k
+
1
x
^
k
+
1
k
-
N
k
+
1
b
,
(34)
Ω
k
+
1
=
E
γ
k
+
1
γ
k
+
1
T
=
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
N
k
+
1
C
k
+
1
k
b
T
H
k
+
1
T
+
H
k
+
1
C
k
+
1
k
b
N
k
+
1
T
+
N
k
+
1
Q
0
b
N
k
+
1
T
+
R
k
+
1
,
where the unknown real residual covariance matrix Ω
k
+
1 is calculated by (27).The incomplete information, coming from the unknown biases in models, can be obtained from (27), (33), and (34). So the multiple fading factor can be calculated from (27) and (34) and used to compensate the corresponding covariance matrix and autocovariance matrix.The SKF algorithm is derived as follows [4, 25]. First, the unknown biases are augmented into the states and the new augmented system is produced. Second, the standard linear Kalman filter is derived from the augmented system. Third, the estimation equations for the biases are thrown away, but the covariance between the states and biases is retrained. From the recursions in SKF [25], thea priori error covariance includes
(35)
P
k
+
1
k
=
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
Φ
k
+
1
k
C
k
p
Ψ
k
+
1
k
T
+
Ψ
k
+
1
k
C
k
p
T
Φ
k
+
1
k
T
+
Ψ
k
+
1
k
Q
0
p
Ψ
k
+
1
k
T
+
G
k
Q
k
G
k
T
,
C
k
+
1
k
p
=
Φ
k
+
1
k
C
k
p
+
Ψ
k
+
1
k
Q
0
p
,
C
k
+
1
k
b
=
Φ
k
+
1
k
C
k
b
.From the recursive process, the three above covariance matrices should be adjusted by the multiple fading factorS
k
+
1, for the incomplete information of the unknown biases. The multiple fading factor S
k
+
1
=
diag
⁡
{
λ
1
,
k
+
1
,
λ
2
,
k
+
1
,
…
,
λ
n
,
k
+
1
} is calculated for the augmented system like the proposed MAFKF. Under assumption that λ
i
,
k
+
1
=
max
⁡
{
1
,
β
i
τ
k
+
1
}, i
=
1,2
,
…
,
n, τ
k
+
1 is calculated as in (29), and O
k
+
1 still remains the same, but M
k
+
1 in (29) is changed into
(36)
M
k
+
1
=
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
Φ
k
+
1
k
C
k
p
Ψ
k
+
1
k
T
h
h
h
+
Ψ
k
+
1
k
C
k
p
T
Φ
k
+
1
k
T
h
h
h
+
Ψ
k
+
1
k
Q
0
p
Ψ
k
+
1
k
T
+
G
k
Q
k
G
k
T
H
k
+
1
T
H
k
+
1
+
Φ
k
+
1
k
C
k
b
N
k
+
1
T
H
k
+
1
.From the analysis above, a multiple adaptive fading Schmidt-Kalman filter is proposed to mitigate the negative effects of the unknown biases.Algorithm 2 (one-step approximate MAFSKF).
Based on the one-step approximate MAFKF algorithm, a multiple adaptive fading Schmidt-Kalman filter is proposed by the following equations when the information about the linear stochastic system is incomplete:(37a)
x
^
k
+
1
k
=
Φ
k
+
1
k
x
^
k
+
Ψ
k
+
1
k
p
,
(37b)
P
k
+
1
k
=
S
k
+
1
Φ
k
+
1
k
P
k
Φ
k
+
1
k
T
+
Φ
k
+
1
k
C
k
p
Ψ
k
+
1
k
T
h
h
h
h
h
h
h
h
+
Ψ
k
+
1
k
C
k
p
T
Φ
k
+
1
k
T
h
h
h
h
h
h
h
h
+
Ψ
k
+
1
k
Q
0
p
Ψ
k
+
1
k
T
+
G
k
Q
k
G
k
T
,
C
k
+
1
k
p
=
S
k
+
1
Φ
k
+
1
k
C
k
p
+
Ψ
k
+
1
k
Q
0
p
,
C
k
+
1
k
b
=
S
k
+
1
Φ
k
+
1
k
C
k
b
,
(37c)
K
k
+
1
=
P
k
+
1
k
H
k
+
1
T
+
C
k
+
1
k
b
N
k
+
1
T
Ξ
k
+
1
-
1
,
(37d)
Ξ
k
+
1
=
H
k
+
1
P
k
+
1
k
H
k
+
1
T
+
N
k
+
1
C
k
+
1
k
b
T
H
k
+
1
T
+
H
k
+
1
C
k
+
1
k
b
N
k
+
1
T
+
N
k
+
1
Q
0
b
N
k
+
1
T
+
R
k
+
1
,
(37e)
x
^
k
+
1
=
x
^
k
+
1
k
+
K
k
+
1
γ
k
+
1
,
(37f)
P
k
+
1
=
I
-
K
k
+
1
H
k
+
1
P
k
+
1
k
-
K
k
+
1
N
k
+
1
C
k
+
1
k
b
T
,
C
k
+
1
p
=
I
-
K
k
+
1
H
k
+
1
C
k
+
1
k
p
,
C
k
+
1
b
=
I
-
K
k
+
1
H
k
+
1
C
k
+
1
k
b
-
K
k
+
1
N
k
+
1
Q
0
b
,where
(38)
γ
k
+
1
=
z
k
+
1
-
H
k
+
1
x
^
k
+
1
k
-
N
k
+
1
b
,
S
k
+
1
=
diag
⁡
λ
1
,
k
+
1
,
λ
2
,
k
+
1
,
…
,
λ
n
,
k
+
1
,
λ
i
,
k
+
1
=
max
⁡
1
,
β
i
τ
k
+
1
,
i
=
1,2
,
…
,
n
,
τ
k
+
1
=
tr
⁡
O
k
+
1
∑
i
=
1
n
β
i
M
i
i
,
k
+
1
,
O
k
+
1
=
Ω
k
+
1
-
ε
R
k
+
1
,
Ω
k
+
1
=
γ
1
γ
1
T
,
k
=
1
ρ
Ω
k
+
γ
k
+
1
γ
k
+
1
T
1
+
ρ
,
k
>
1
.


## 5. Simulation Results and Analysis

To evaluate the performance of the proposed MAFSKF algorithm, the spacecraft attitude tracing system with the gyroscope as a measurement sensor is considered [26]. The spacecraft attitude tracking system, which is mainly used to enhance and track the spacecraft drift signal, is corrupted by the unknown bias. The corresponding discrete-time dynamic stochastic system is expressed as
(39)
x
k
+
1
=
0
1
-
0.85
1.70
x
k
+
0.0129
-
1.2504
p
k
+
0
1
w
k
,
(40)
z
k
=
0
1
x
k
+
v
k
.As in the literature [21], we assumed that x
=
[
x
1
,
x
2
]
T, w
k
~
N
(
0,0.0
1
2
), and v
k
~
N
0,0.0
1
2. The true state x
0
=
[
2,1
]
T and the unknown bias p
0
~
N
(
0,0
.
5
2
) were added to the dynamic equation (39). The initial estimates of the state x
^
0
=
[
1.8,0.9
]
T, and bias p
^
0
=
0. In simulation, the dynamic system is disturbed by some external disturbances, and the values of the unknown biases p
k are plotted in Figure 1. The MAFSKF and SKF use Q
p
=
0.001
×
0
.
5
2 as the covariance of the bias p, which is one thousandth of the real covariance Q
p
=
0
.
5
2. The constant β in MAFSKF algorithm is set as β
1
=
1 and β
2
=
100, the softening factor ε is set as ε
=
1, and the forgetting factor is ρ
=
0.95.Figure 1
Values of the unknown bias.Each single run lasts for 200 samples and 100 Monte Carlo runs are performed. The root mean squared errors (RMSE) of the state estimate are calculated to compare the performance of the MAFSKF algorithm and the SKF algorithm at each epoch. The simulation results are shown in Figures2–5.Figure 2
Time evolution of the multiple fading factor.Figure 3
RMSE ofx
1 for 100 random simulation runs.Figure 4
RMSE ofx
2 for 100 random simulation runs.Figure 5
RMSE for MAFSKF.Figure2 shows the time evolution of the multiple fading factor in simulation. From Figure 2, we can see that the fading factors of the states become larger in order to recover the filter from divergence, and the second fading factor is greatly larger than the first one because the second state changes largely. Figures 3 and 4 show the RMSEs of the state estimates both x
1 and x
2 by using the conventional SKF and MAFSKF algorithm, respectively. The RMSEs of the MAFSKF algorithm on its own are given in Figure 5 to well show the results. From Figures 3 and 4, it is obviously seen that the MAFSKF algorithm can adapt these unknown biases and well track the true states, compared to the SKF. As a result, the performance of the MAFSKF algorithm is better than the SKF when the information of the unknown biases is incomplete.


## 6. Conclusions

In this paper, the multiple adaptive fading Schmidt-Kalman filter is presented to mitigate the negative effects of the unknown biases in dynamic or measurement model. In practice situations, the dynamic and measurement models include some additional unknown biases, which always bring greatly negative effects to the state estimates. Although the Schmidt-Kalman filter “considers” the biases, the uncertain initial values and incorrect covariance matrices of the unknown biases still are not considered. To solve the problem, the MAFKF is proposed to adjust the covariance of the states and noise by using the multiple fading factors as a multiplier on the outside of thea priori covariance equation when the information about the dynamic or measurement model is incomplete. Then, the MAFSKF is designed based on the MAFKF. Numerical simulation shows that the MAFSKF can mitigate the negative effects of incorrect covariance matrices of the unknown biases compared to the SKF.



---

*Source: 623930-2014-11-24.xml*