Research Article  Open Access
Hongtao Yang, Huibin Gao, Xin Liu, "Strong Tracking Filtering Algorithm of Randomly Delayed Measurements for Nonlinear Systems", Mathematical Problems in Engineering, vol. 2015, Article ID 869482, 14 pages, 2015. https://doi.org/10.1155/2015/869482
Strong Tracking Filtering Algorithm of Randomly Delayed Measurements for Nonlinear Systems
Abstract
This paper focuses on the filtering problems of nonlinear discretetime stochastic dynamic systems, such as the model simplification, noise characteristics uncertainty, initial conditions uncertainty, or system parametric variation. Under these circumstances, the measurements of system have one sampling time random delay. A new method, that is, strong tracking filtering algorithm of randomly delayed measurements (STF/RDM) for nonlinear systems based on recursive operating by analytical computation and firstorder linear approximations, is proposed; a principle of extended orthogonality is presented as a criterion of designing the STF/RDM, and through the residuals between available and predicted measurements, the formula of fading factor is obtained. Under the premise of using the extended orthogonality principle, STF/RDM proposed in this paper can adjust the fading factor online via calculating the covariance of residuals, and then the gain matrices of the STF/RDM adjust in real time to enhance the performance of the proposed method. Lastly, in order to prove that the performance of STF/RDM precedes existing EKF method, the experiment of tracking maneuvering aircraft is carried out.
1. Introduction
Filtering task is obtaining state variables from a series of noisy measurements available online. The main aim is to minimize the estimation error, which is referred to as the residual or innovation vector.
Currently, most suboptimal methods for obtaining the posterior density in nonlinear discretetime stochastic dynamic systems are using global and local approximation methods. Taking the pointmass filter based on adaptive algorithm [1] and particle filters with Gaussian mixtures based on Gaussian mixture approximation [2], for example, it is the advantage of the global approximate approach that any clear assumption pertaining to the form of posterior density is not needed. Although the global methods have strong adaptability, they suffer from enormous computational complexity. In contrast, the local methods have simple design of the filter and fast implementing speed, and the performance of this method is always with acceptable accuracy in actual applications. In local methods, the form of posterior density usually is assumed to be Gaussian. Sometimes several local filters can be derived without an assumption on the density (just the first two moments are required) such as extended Kalman filter or unscented Kalman filter. Up till now, there are plenty of variations about local methods of approximation, such as the extended Kalman filter (EKF) based on the method of linearization [3], the centraldifference Kalman filter (CDKF) based on the interpolation method [4], the unscented Kalman filter (UKF) based on the method of unscented transform [5], the quadrature Kalman filter (QKF) based on the rule of GaussHermite [6], and the cubature Kalman filter (CKF) based on the cubature rule of sphericalradial cubature [7]. However, since the aforementioned state estimation methods are all formulated under the assumption of statistics of the noises and system parameters accurate modeling, in real applications they have some disadvantages; for example, the uncertainties in the model, initial conditions, or noise characteristics may lead to bias in the estimation process. In order to overcome the above disadvantages, one solution is to introduce fading factors in the state error covariance matrix based on the residual sequence. This method is named as the strong tracking filter (STF), which was proposed by Zhou and Frank [8–11].
In general, all the above filtering estimations often consider the fact that in real time the measurements generated by system are available, but the measurements directly obtained are affected by random delay in many actual applications. Therefore, the problem of filtering having randomly delayed measurements has been attracting wide attention [12–15], in nonlinear state estimation. In [12], two modified filtering algorithms, EKF and UKF, with one sampling time randomly delayed measurements have been proposed; an improved unscented filtering algorithm in [13] was proposed based on twostep randomly delayed measurements; the literature [14] considered onestage prediction, filtering, and fixedpoint smoothing problems in nonlinear discretetime stochastic systems having onestep randomly delayed measurements; in this situation, the recursive estimation algorithm, that is, the signal produced by statespace model is uncertain and only the covariance information can be utilized, has been proposed; recently, considering observations of onestep randomly delayed measurements, a generic framework of Gaussian approximation (GA) filter has been given in [15].
To overcome the common disadvantages of filtering method having onestep randomly delayed measurements and normal filtering method, here, a novel STF/RDM is proposed; an extended orthogonality principle is presented as a criterion of designing the STF/RDM and through the residuals between available and predicted measurements, the formula of fading factor is obtained. Since the STF/RDM can implement the online tuning of the fading factor by monitoring the covariance of residuals, the gain of the STF/RDM will be adjusted in real time to enhance performance of ESFT.
The structure of this paper is as follows. The basis of theory and elementary knowledge about the existing EKF having onestep randomly delayed measurements is reviewed in Section 2. Then, the extended orthogonality principle which is the basis of STF/RDM is proposed in Section 3. Thereafter, in Section 4, the STF/RDM having onestep randomly delayed measurements is derived. In Section 5, simulation experiment on tracking a maneuvering aircraft is implemented to compare the performance of the STF/RDM with existing EKF. Finally, Section 6 gives some conclusions.
Throughout this paper, stands for mathematical expectation; stands for the unit matrix; denotes a blockdiagonal matrix; the superscripts , , , and , respectively, denote the inverse matrix, the matrix transposition, the estimate, and the estimation error. For example, stands for the estimate of variable and stands for the estimate error of variable .
2. Problem Formulation and Preliminaries
In this section, the nonlinear model having onestep randomly delayed observations and the filtering algorithm derived from this model are reviewed.
2.1. Nonlinear System Model
Consider a nonlinear, discretetime, stochastic system as state model shown byand the model of one sampling randomly delayed observationwhere is the state vector, is the real measurement, is the available measurements, and are sequences of uncorrelated Gaussian white noises that have zero means and the covariance matrices which are and , respectively, where is the Kronecker delta function, the initial state is a random Gaussian vector having mean and covariance , for all , the nonlinear functions and are infinitely continuously differentiable, and denotes a sequence of uncorrelated Bernoulli random variables that can take the values 0 or 1 withwhere represents the probability of a delay in measurement at time .
Substituting (2) into (3) givesIn (1)–(3), assume that , , , and are mutually independent.
Obviously, the Bernoulli variable in (3) imitates the random delay in the following sense: at each time , if , then which means that the measurement is one sampling time randomly delayed; otherwise, if , then which means that the measurement is updated.
2.2. Extended Kalman Filter with OneStep Randomly Delayed Observations
In [15], a general and common framework of Gaussian approximation (GA) applied in the system shown by (1)–(3) has been presented; under these circumstances, the measurements with one sampling time random delay often occur. Here, the functions of onestep posterior predictive probability density and are all assumed to be Gaussian, where is the set of the available measurements in (3). In (5), it is clear that the Gaussian approximation of and needs to be known when deriving a GA filter for the system in (1)–(3). Therefore, the augmented state vector is defined as follows:whose mean and covariance are conditioned by , approximated byNote that is independent of and . Hence, the augmented state prediction and the covariance are
In [15], the equations describing the Gaussian approximation (GA) filter applied in the system shown by (1)–(3) are as follows: where , , , , , , , , , and and , respectively, express the gain matrices of the filtering estimated state and measurement noise. Based on (9)–(19), the extended Kalman filter in [12] can be described by the following equations.
Assuming that the and at time have been computed, by linearization of and with the first term of the Taylor series expansion about , we get where and . Then, and are approximated by the linear Kalman filter: Moreover, given and by (22) and (23), by linearization of with the first term of the Taylor series expansion about , we getwhere . Then, , , , , , and are computed by the linear Kalman filter as follows:At time , combining (22)(23) and (25)–(30) with (9)–(19) computes and in (7). For the derivation process of (20), (21), (24), and (26), see the literature [12].
3. Extended Orthogonality Principle
As is known to all, model mismatch due to model simplification, noise characteristics uncertainty, initial conditions uncertainty, or system parametric variation causes the robustness of EKF to be bad and even diverging [16, 17]. Under the orthogonality principle, the literature [18] first presented the strong tracking filter (STF) applied in nonlinear systems with white noise. The excellent characteristics of STF are described as follows:(1)It has strong robustness when the model is uncertain.(2)For the state changing suddenly or slowly and even the system reaching a steady state or not, it has excellent ability of tracking to the states.(3)It has moderate computational complexity.
Further, we hold opinion that STF fit coping with the problem of model uncertainties and other unpredictable disturbances in nonlinear state estimation that have onestep randomly delayed observations.
The standard STF cannot be directly applied to the state estimation with onestep randomly delayed observations, because of the arbitrarily selected pairs of residuals, in orthogonality principle of standard STF, which is calculated according to all observations having been updated. Therefore, in the following section, STF/RDM is proposed according to the principle of extended orthogonality applied in fusion onestep randomly delayed observations efficiently.
Definition 1 (extended orthogonality principle). For the discretetime nonlinear process having onestep randomly delayed observations in (1)–(3), (9), (10), and (22), the sufficient condition of the augmented state estimator is called a strong tracking filter that the criteria must satisfy (through choosing time varying gain matrices and online): where the criteria of minimum mean square error (MMSE) is shown as (31), the condition of orthogonality is shown as (32), in which the condition is that all of the residuals should be mutually orthogonal at any time.
Remark 2. Equation (31) is just the criterion of the existing EKF, the derivation of which for the problem is presented in the Appendix. Equation (32) is the core formulation of extended orthogonality principle; using other criteria to replace (31), the deformation of extended orthogonality principle can be obtained. Therefore, once (32) was introduced into the original filter, it has the characteristics of STF.
4. Derivation of the STF/RDM
In this section, an STF/RDM algorithm is derived according to the principle of extended orthogonality. It is easy to find that the idea of the EKF with onestep randomly delayed observations depends upon the past measurement data and the heavy reliance may lead to diverge state estimation. In order to restrain the divergence, the filter should be capable of eliminating the effect of past data from a current state estimate if these data are no longer meaningful. The literature [18] presented a method to modify the covariance of state error at time through introducing the fading factor of suboptimal as follows:Then, the covariance of predicted state error is also modified through substituting (33) into (23) as follows:where . As a consequence, the influence of the latest measurement data in state estimation is dominant and divergence is restrained.
The purpose of the STF/RDM is to impair the influence of the historical data when they are no longer significant, by using a time varying suboptimal fading factor, and modify the gain matrices online so that the filter has strong tracking ability. Therefore, a key problem in STF/RDM is how to calculate the suboptimal fading factor according to the principle of extended orthogonality.
Substituting (21) and (24)–(26) into (15) yieldsUsing (20) minus (22) yieldsSubstituting (22) and (36) into (35) yieldsUsing a similar derivation method yieldsSubstituting (38) into (32) yieldsSince the initial state , , , and that can generate the state and observations are mutually independent and taking (4) into account, then the (39) can be simplified toBased on (9), (20), and (22) and by a similar derivation method applied in (38), this yieldsSubstituting (41) into (40) yieldsAgain, since the initial state , , , and that can generate the state and observations are mutually independent and taking (4) into account, then (42) can be simplified toFrom (40) and (43), the following form can be obtained by using an iterative operationEquation (9) yieldsSubstituting (29) and (30) into (18) yieldsSubstituting (46) into (45) yieldswhere is the covariance of the residual.
Substituting (17), (22), (25)–(28), and (46) into (14) yieldsSubstituting (48) into (47) yields Substituting (49) into (44) yieldsIn order to satisfy the principle of extended orthogonality in (32), an appropriate fading factor needs to be chosen, according to (50), to ensure that (51) is workable:
Equation (51) is equivalent toSubstituting (33) and (34) into (52) yieldsIn both sides of (53), the traces are directly calculated similarly to the idea of the literature [8] as follows:DefineHence, (54) is equivalent toSo, the fading factor can be calculated byIn (56), the actual value of the covariance of residual is unknown, which can be calculated roughly bywhere is a forgetting factor which can be heuristically selected like that in the literature [18]; for details, see the simulation results in situation I of Section 5. Because the fading factor takes effect only when , it can be finally determined as follows:
The formulae of the STF/RDM algorithm are similar to those of the EKF with onestep randomly delayed observations shown by (22)(23) and (25)–(30). The differences are that (23), (28), and (30) should be rewritten as follows:Then, the calculating process of the STF/RDM algorithm is inserting (22), (61), (25)–(27), (62), (29), and (63) into (9)–(19) and computes and in (7).
Remark 3. For nonlinear systems having onestep randomly delayed observations, if directly applying the principle of extended orthogonality to them, (31) and (32) may be difficult to be strictly satisfied. Under these circumstances, the approximate method is usually applied to satisfy these two conditions and obtain the approximate solution of a fading factor , such as calculating the traces directly in both sides of (53) and roughly determining through (59) to ensure that the filtering algorithm can be calculated in real time.
5. Simulation Results and Analysis
In this section, to analyze and compare the performance of the proposed method in Section 4 and the existing EKF in Section 2, the simulation experiments of tracking a maneuvering aircraft are implemented. Assume that the initial position, velocity, and turn rate of the aircraft in the twodimensional plane are (1 km, 1 km), (300 m/s, 0 m/s), and , respectively. The simulation aircraft trajectory is generated as follows:(1)It moves with constant velocity during 0–26 s.(2)It maneuvers and moves with constant turn rate during 27–59 s.(3)It moves with constant velocity during 60–68 s.(4)It maneuvers and moves with constant turn rate during 69–73 s.(5)It moves with constant velocity during 74–100 s.
Figures 1(a), 1(b), and 1(c) show the simulation trajectory of the aircraft position, velocity, and turn rate, respectively, during an interval of 0–100 s.
(a)
(b)
(c)
Considering the coordinated turn model with unknown turn rate in [19], there is bias between real value of turn rate and estimate value of it, and the bias leads to the model mismatch. The mismatch kinematics model of the maneuvering aircraft can be obtained, which is shown as follows:where is state vector; , , , and express the position and velocity in direction and direction, respectively; denotes turn rate; denotes sampling period; denotes the process noise which has zero mean and covariancewhere the parameters , , and , respectively, denote the coefficient of process noise in direction, direction, and turn rate.
Using twodimensional radar location the origin of plane measures the range and bearing of maneuvering aircraft. The measurement can be calculated by the following equation:where is radar measurement noise which has zero mean and its covariance , where m and . Assume that the measurements applied in the estimation have one sampling time random delay and the measurements can be calculated as follows:The is initial state. In each simulation, the initial state estimation is selected randomly from , where the initial covariance isThe period of sampling is 1 second and the total time of each simulation is 100 seconds.
In order to compare the filtering performance, the root mean square error (RMSE) is chosen, because it can yield a measure which combines the bias and variance of a filter estimate. At time , both RMSEs of position are defined bywhere denotes the total number of Monte Carlo experiment, and , respectively, denote the simulated position, which can be replaced by true position and filtering estimate position, when th Monte Carlo experiment is run. Like the RMSE of position, the formulas of RMSE about velocity and turn rate can also be defined.
In situation I, assuming , , , and , the average of RMSEs of position, velocity, and turn rate obtained by using the STF/RDM is shown in Figure 2. The values of fading factor determined by forgetting factor are shown in Figure 3. As shown in Figures 2 and 3, with the increase of the forgetting factor , the mean of RMSEs about the proposed STF/RDM is almost stable and is insensitive to the value of . Therefore, the forgetting factor is selected as in the following situation.
In situation II, assuming , , and , the RMSEs of position, velocity, and turn rate obtained by using the proposed STF/RDM and the existing EKF are shown in Figures 4, 5, and 6, respectively. The values of fading factor determined by proposed STF/RDM are shown in Figure 7. The estimated autocovariance of and position calculated by STF/RDM and the existing EKF is, respectively, shown in Figures 8 and 9. According to Figures 4–9, the analysis is as follows:(1)During 0–68 seconds, aircraft moves with constant velocity at first and then maneuvers with lesser turn rate. The values of fading factor are close to 1, and the proposed STF/RDM deteriorates into the existing EKF. In this case, besides the RMSEs of position, velocity, and turn rate, the estimated autocovariance of position and that of position based on proposed STF/RDM and existing EKF are almost equal.(2)During 69–100 seconds, aircraft maneuvers with greater constant turn rate at first and then moves with constant velocity. Since the turn rate changes suddenly, both filters appear divergence. In the divergence period, the estimated autocovariance of position and that of position of STF/RDM are larger than the EKF and the RMSEs of existing EKF are larger than the STF/RDM. The proposed STF/RDM can timely detect the increase of residual covariance and through the fading factors adaptively increasing, the RMSEs reduce and the estimated autocovariance of and position increases. Comparing with the existing EKF, the increasing of estimated autocovariance of STF/RDM can reflect the sudden change of and position in time. The decrease of RMSEs ensures STF/RDM having better tracking performance. After the divergence period, the RMSEs and the estimated autocovariance of STF/RDM quickly decrease, while the RMSEs and the estimated autocovariance of EKF gradually increase; in other words, unlike the existing EKF, the STF/RDM can eliminate the influence of the cumulative estimation error by increasing the fading factor to avoid further divergence. The above results verify that proposed STF/RDM have the ability to deal with the problem of system parametric variation.
For a judicial comparison, the same condition is set to initialize all the filters in each simulation, and 1000 independent Monte Carlo experiments are carried out.
In situation III, assuming , , and , the RMSEs of position, velocity, and turn rate obtained by using the proposed STF/RDM and the existing EKF are shown in Figures 10, 11, and 12, respectively, and the mean of RMSEs in position, velocity, and turn rate is shown in Table 1.
