1. Introduction
State estimation, which is generally applied in automatic control and signal processing, is a method for estimating the internal state of a dynamic system based on available measurement data. For linear systems with external disturbances of normal distribution characteristics, the standard Kalman filter (SKF) is the optimal filter under the minimum mean square error (MMSE) criterion and is extensively used in many fields [
1,
2,
3,
4] such as control, finance, communication, etc. The traditional state estimation methods assume that the measured data is transmitted to the filter with no delay. However, in practical systems, such as spacecraft systems [
5], satellite [
6], and photoelectric tracking systems [
7], all the measurements have time delays, which are mainly composed of the acquisition time, processing time, and transmission time of the sensor data. Meanwhile, the modelling errors are generally unavoidable [
8], and will further influence the performance of the systems. Therefore, both measurement delay and random model parametric uncertainties are the interest of this article.
Plenty of detectors have the characteristic of constant measurement delay. Frequently occurring severe network congestion or packet loss may cause a time-varying delay in many systems [
9,
10,
11]. Most sensors have similar or slightly changed measurement delay because of their fixed transmission environment, acquisition environment, and acquisition algorithm. Considering these subtle changes would have a weaker influence in the discrete domain, the measurement delay can be reasonably treated as a constant. For instance, in the field of our research, the target detector in the photoelectric tracking system has a considerable constant measurement delay, which is an increasingly attractive issue in high-precision tracking. Many innovative methods [
7,
12,
13] have been proposed to compensate its affect on tracking performance.
The measurement delay problem in state estimation is called the out-of-sequence measurement (OOSM) problem, the time-delayed measurement problem, or the time-varying measurement problem [
14]. For the problems with known delays, backward prediction, state augmentation, and extrapolation are three distinctive approaches. The backward prediction (or retrodiction) was originally proposed by Bar-Shalom [
15] to solve the one-step delayed OOSM problem under the Kalman filter algorithm framework. In this approach, the state and covariance matrices at the time OOSM occurs are backward predicted when the filtering system receives the OOSM. Then, the delayed measurement is utilized to update the current state and covariance. When the process noise satisfies the discrete continuous-time model, the approach can achieve optimal performance.The extended version for multiple-step delayed OOSM is proposed in [
16]. Zhang et al. [
17] proposed a sub-optimal version to reduce the computing burden under certain circumstances. The second valuable approach for the time-delayed measurement problem is summarized as the state augmentation approach, in which the delayed measurement is used to estimate the state of the corresponding past moment, and the prediction of the current state is obtained from the corrected past state. The key point to this approach is to elaborately augment the state vector and establish the correlation between the augmented state vector containing the corresponding past state and the delay measurement. One estimator based on the augmented state vector is proposed in [
18] to deal with the problem that the change of current state could be affected by the d-step preceding state. However, it could not be adopted to solve the problem in this paper that detectors have measurement delay and the preceding state has no influence in the target’s state transition. Based on the Bayesian theory, a state augmentation Kalman filter solution to the time-delayed measurement problem is suggested in [
19]. The third practical approach is called the extrapolation approach. In [
19], by assuming that the current measurement residual is equal to the residual at the corresponding time of the OOSM, the measurement for the current time is calculated by extrapolation. Then, the current state is estimated by incorporating the extrapolated measurement into the Kalman filter. Ref. [
7] suggested to use the delayed measurement to estimate the state at the corresponding time first, then use the process matrix to iteratively multiply the past state to extrapolate the current state.
The researches on the time-delayed measurement problem are fruitful. However, the problem that this article focuses on is the simultaneous existence of constant measurement delay and random model parametric uncertainties in state estimation.
The estimator to solve the problem of random parametric uncertainties in state estimation is collectively referred to as a robust filter/estimator. Here are three representative robust state estimation methods. The H-infinity filter is developed based on the H-infinity linear control theory proposed by Zames in 1980 [
20,
21]. Unlike the Kalman filter that uses the mean square error criterion, the H-infinity filter adopts the minimax criterion to minimize the maximum estimation error. It does not need to know prior information such as the statistical characteristics of environmental noise, and can minimize the influence of external interference on the state estimation results. Therefore, this method is more robust to system model errors and external interference. The blemish of the H-infinity filter is that it needs to continuously test specific existence conditions when performing recursive filtering operations. If these conditions fail during any iteration, the desired performance will be lost and the filter may diverge. The method of set-valued estimation assumes that the noise disturbance of the measurement is norm-bounded. Based on this assumption, ellipsoids are constructed around the state estimate [
22,
23]. Here again, this method is encountered with the requirement of inspecting for certain existence conditions, which may limit the application of this method to recursive filtering. The third solution to the robust filter design is a regularized least-squares (RLS)-based framework, which is first proposed by Sayed in [
24]. In this framework, the standard Kalman filter is regarded as the solution of a regularized least squares problem. Then, the objective function of this regularized least-squares problem is further improved considering the uncertainties of model parameters. Although this robust filter focuses on a worst-case analysis that may be conservative under relatively "small" uncertainties, it has many attractive properties. For example, it does not need to verify certain existence conditions at every moment of recursive filtering; it has a similar structure to the Kalman filter, and it also has low computational complexity, etc. Therefore, scholars have further extended this robust filter framework. In [
25], a new robust filter method that weighs nominal performance and uncertainty is proposed. Refs. [
8,
26] propose sensitivity penalization-based robust state estimation methods.
According to the above analysis, the research studies on the model parametric uncertainties are also prolific. However, in the public references, few papers specifically address the method of simultaneously overcoming the constant measurement delay and random model parametric uncertainties in the discrete-time linear systems. Fortunately, there are many similar studies in the published literature for reference. For example, the robust estimation problem of a class of discrete-time systems with delays and lossy measurements is studied in [
27]. Compared with the problem studied in this paper, the robust H-infinity filter designed by [
27] focuses more on the reduction of delay-dependent conditions and the processing of lossy measurements. Basically, there have been two ways to model the measurement of missing phenomena, that is, using a binary switching sequence and using a Markov chain. Refs. [
27,
28,
29] all pay more attention to the problem of lossy measurements. Excessive attention leads to these similar works, unable to focus on solving the problems of the content of this research. Meanwhile, in [
27], the H-infinity filtering method is used to handle the model parametric uncertainties. As mentioned earlier, the H-infinity filter needs to continuously test specific existence conditions when performing recursive filtering operations. To solve the problem of model parametric uncertainties, in [
27], the robust Kalman filtering is derived in the linear minimum variance sense by using the innovation analysis approach. The dimension of the designed filter is the same as the original systems. However, the recursive filtering process is complicated and is not conducive to engineering realization. In [
27], the robust recursive estimator is designed based on the orthogonal projection theorem. The stochastic uncertainties of the system model are described by multiplicative noises, which lead to a narrow applicability of the estimator to the actual systems. For more specific issues, the attitude estimation filtering problem with model uncertainties in the state, output, and process noise matrices and star sensor delays has been studied in [
30]. In [
30], the uncertain attitude estimation model is established for the actual system. Combined with star sensor delays, a new finite-horizon robust Kalman filter design is derived for the uncertain attitude estimation system. The optimized filter parameters can be obtained to minimize the upper bound on the estimation error covariance. However, the method proposed in [
30] is not universal enough, its application scenario is limited to a specific type of system, and the assumption about measurement delay is also different from this research. In addition, for the model uncertainties and time-delayed measurements of different types of nonlinear systems, refs. [
31,
32,
33] are worthy of reference. According to the above analysis, similar published documents are not suitable for solving the problems of this research. This research should provide a more focused and universal estimator design solution, and the final-designed estimator should be simple, reliable, and easy to implement.
Motivated by the aforementioned analysis, this study suggests a novel robust estimation method, which combines an RLS-based robust filter design framework and state augmentation. The main contributions of the paper are as follows: (1) This study elaborately designs the specific state augmentation method to deal with the constant measurement delay, and modifies the cost function of the Kalman filter RLS problem for the random model parametric uncertainties. (2) Based on this design, a recursive filtering procedure is derived. As long as the probability distribution of parametric uncertainties are known and the two matrices related to the filter are calculated offline in advance, online filtering can be performed. Compared with the similar works in [
27,
28,
29], the recursive filtering procedure designed in this study has similar computational complexity to the Kalman filter. Meanwhile, it does not need to design optimal parameters and continuously test specific existence conditions, which shows that the proposed estimator is simple and easy to implement. (3) The asymptotic stability conditions and the error covariance boundedness conditions of the proposed estimator are derived to guarantee the reliability of the proposed estimator. (4) Besides, this paper designs numerical simulations to verify the effectiveness of the proposed estimator.
The remaining structural arrangement of this article is as follows: The problem statement and the design of robust state estimation are presented in
Section 2.
Section 3 focuses on the recursive procedure, the asymptotic stability conditions of the estimator as well as the conditions for the boundedness of the estimation error matrix. The numerical simulations and verification of practical experimental system are discussed in
Section 4. Conclusions are presented in
Section 5. The appendices exhibit the derivation of recursive estimation procedures and proof of the proposed theory in this study.
Notations: Suppose x is a column vector and W is a positive definite matrix. Define and to represent the Euclidean norm of x and its weighted form, respectively. That is, and . is the Kronecker delta function and represents the vector/matrix stacked by . expresses the mathematical expectation of a stochastic variable, vector, or matrix. represents an n-dimensional Euclidean space. represents a matrix of all zeros with n rows and m columns. is a simplified representation of .
2. Problem Statement and the Design of Robust State Estimator
Consider the following discrete-time linear system with constant measurement delay and random parametric uncertainties:
where
is the state vector,
is the measurement vector, and
d is the frames of the measurement delay. The modelling error
is composed of
L real-valued bounded scalars
.
represents the parametric modelling error at moment
k in the
i-th experiment. That is
.
are matrices related to
and of size
.
and
are uncorrelated and gaussian random noise with variances
Q and
R, respectively. That is,
Remark 1. Unlike [8,24,34], System (1) neither requires the system matrices to be linearly dependent on the norm bounded uncertainty matrix nor requires the elements of the system matrices to be differentiable functions of . The way the modelling errors affect the plant parameters can be arbitrary. This feature makes it possible for the System (1) to capture more actual-system behavior than the ones in [8,24,34]. Assuming that
d is known and time-invariant, System (
1) can be equivalently reconstructed into a delay-free System (
3).
in which,
Furthermore, the definitions of
,
, and
are shown in (
4).
After converting System (
1) to an augmented delay-free model, the random parametric uncertainties of the system are considered. According to [
24,
35], a clear explanation of the SKF is to solve the RLS (regularized least squares) problem which is presented in (
5).
Considering the estimation performance deterioration caused by modeling errors, the cost function of the RLS problem is expanded as follows:
where,
In (
6), the expanded cost function has used mathematical expectations to handle the random parametric uncertainties of the augmented delay-free model. When there is no modelling error, the state estimator in (
6) degenerates into a SKF. According to the definitions of
and
, the cost function
is a strictly convex function. That is, there is a global minimum
at
. Expanding the cost function in (
6),
is obtained. Find the partial derivative of (
8) for
and let
,
is obtained. Substituting (
7) into (
9), (
10) is obtained.
The following matrices are defined for further simplification.
Obviously,
. Finally, (
10) can be simplified as
Remark 2. Assume that the statistical property of is known, if the relationships between the modelling errors and matrices A, B, and C are simple, and can be solved by direct algebraic operations. Otherwise, and are calculated by stochastic simulations [36]. For example, according to the statistical property of , 10,000 realizations of and by stochastic simulations are constructed, then the and can be calculated by averaging. In contrast, if the statistical property of is not known, and can also be calculated according to plenty of realizations of matrices A, B, and C obtained during the modelling process. According to the above analysis, it can be obtained that and can be calculated offline, which means that the filter proposed in this study may be more conducive to implementation and application than those in [8,24,34]. Remark 3. The proposed estimator is characterized by the ingenious combination of the Kalman filter RLS framework and state augmentation, which can cope with the simultaneous existence of model parametric uncertainties and time-delayed measurement. Since the proposed estimator is an improvement on the Kalman filter RLS framework, the proposed estimator has a recursive filtering form similar to the Kalman filter, which is conducive to engineering realization. Moreover, the proposed estimator does not require additional parameter design and optimization, as well as the online test of certain existing conditions. This property makes the proposed estimator more reliable and convenient. However, the computational cost of the state augmentation in the proposed estimator cannot be ignored. Fortunately, this article is not aimed at long-term trajectory prediction, and a short-term measurement delay that can be regarded as constant in most systems. For example, the time delay of the target detector of the photoelectric tracking system is generally 2 to 4 frames [7], and the computational cost of state augmentation is affordable. 4. Numerical Simulations
Before verifying the overall scheme of the proposed estimator, the processing capability of the proposed state augmentation method on the time-delayed measurements is verified first. Without loss of generality, a single-axis constant velocity model is employed to simulate the movement of a target. The state vector of the system is composed of the target’s position and velocity. (
19) specifies the detailed system model parameters.
In (
19),
represents the sampling period,
Q and
R represent the process noise covariance and measurement noise covariance, respectively.
is the initial state vector.
is the initial estimation error covariance.
Figure 1 shows the simulated target trajectory and its measurements with Gaussian noise and three-frame time delay. These measurements are used as the input of the standard KF and the state augmentation-based KF.
Figure 2 shows the estimation errors of the two methods. According to the comparison results in
Figure 2, it can be seen that the proposed state augmentation method effectively reduces the estimation error in the measurement delay situation because the proposed state augmentation method indirectly establishes the correlation between the delayed measurement and the current state.
In the proposed method, by elaborately designing a state augmentation method, the relationship between the delayed measurements and the current state is established, and then the original model is converted into a delay-free augmentation model. Since the current state is included in the augmented state vector, the augmented delay-free model can be further used in the filter design. If the system has no model parametric uncertainty, then the standard Kalman filter is the optimal linear estimator. When considering the influence of random parametric uncertainties, this work enters the mathematical expectation method to improve the cost function of the RLS-based Kalman filter framework. The recursive filtering procure derived from the modified cost function has a significant feature; that is, when the system model does not have random parametric uncertainties, the estimator degenerates into standard Kalman filter. When the system has random parametric uncertainties, the estimator can effectively suppress the influence of random parametric uncertainties on the estimation performance. In order to verify this part of the work individually, this research further designs a simulation experiment.
Without loss of generality, we add uncertain parameters with known statistical characteristics to the single-axis constant velocity model, and then compare the estimation performance between the standard Kalman filter and the proposed estimator to illustrate the effectiveness of this part of the work. The specific model parameters are as follows:
In (
20), we assume
.
Figure 3 shows the simulated target trajectory which is affected by model parametric uncertainties and its measurements with Gaussian noise. These measurements are used as the input of the standard KF and the proposed robust estimator.
Figure 4 shows the estimation errors of the two methods. According to the comparison results in
Figure 4, it can be seen that the proposed robust design effectively reduces the estimation error when the state is affected by model parametric uncertainties.
Through a comparative approach,
random simulations have been performed to demonstrate the effectiveness of the proposed estimator. Each simulation generates 1000 time-domain input/output data pairs for the state estimation of the plant, in which all initial states are set to 0, and the disturbances
and
are produced following normal distributions. The ensemble-average estimated error variance of these
random simulations at each sampling time is calculated as follows:
in which
i is the serial number of the random simulations.
Two other Kalman-based estimation methods are also simulated to compare with the proposed one in order to illustrate the effectiveness of the proposed method. One of them combines both the nominal parameters and the proposed augmented delay-free model (KFND). The other one combines with the actual parameters and the proposed augmented delay-free model (KFAD). Referencing the nominal parameters of [
8,
24,
34], the system parameters selected in this example are as follows:
In which the sampling period is and the measurement delay frames of the system is . Besides, and .
The convergence properties of the example could be confirmed by the given theorems before the experiment. Definitions in (
4) and (
11), together with the determined distribution of
, exhibit that
are time-invariant. According to [
37], the detectability of
is equal to that if
, then
, where
is the eigenvalue of
A. In the example of this article,
, and
Therefore,
is detectable. Similarly, the stabilization of
has similar equivalent conditions. That is, if
, then
, where
is the eigenvalue of
. It can be further verified by direct algebraic operations that
is stabilizable. From the conditions required by Theorem 2, it can be proved that the estimator proposed in this paper is asymptotically stable when applied to the example in this section. Obviously,
are all bounded for
and
. Simple algebraic operations show that the eigenvalues of System (
3) can be obtained as
. They are all inside of the unit circle. With reference to [
38], it can be drawn that System
3 is exponentially Lyapunov stable. On the basis of Theorem 2, the estimation error matrix of the proposed estimator of System (
22) is confirmed to be bounded.
Next, the simulation is divided into two cases: Case 1. In these simulations, the modelling errors follow a normal distribution(). However, in the same simulation, at each moment does not change. Case 2. In the same simulation, the modelling errors at each moment follow a normal distribution(). For the two cases mentioned above, three sets of experiments are made. The differences among these three sets of experiments are the change of p. The purpose is to change the “size” of uncertainty. is in the first group, , and are in the second and third group, respectively.
Figure 5 and
Figure 6 show the simulation results of Case 1 and Case 2, respectively. According to the experimental results, the proposed method is robust to model parametric uncertainties. Especially when the uncertainty is “large”, the contrast is more obvious. From the third group of experiments in Case 1, it can be concluded that the estimation error of the proposed method is about 50% lower than that of the KFND method. The result of Case 2 shows that even if the model changes all the time, the proposed method is still robust. As the uncertainty decreases, the estimated performance of the three methods tends to be a similar level. This is because the method proposed in this article is an improvement on Kalman filter’s RLS framework. When the uncertainty is 0, the proposed method degenerates into a standard Kalman filter.