Discrete Dynamics in Nature and Society

Volume 2012, Article ID 301043, 16 pages

http://dx.doi.org/10.1155/2012/301043

## Robust Filtering for Linear Equality Constrained Systems

^{1}Department of Automation, Shanghai Jiao Tong University, Shanghai 200240, China^{2}College of Electric Engineering, Shanghai Dianji University, Shanghai 200240, China^{3}Business School, University of Shanghai for Science and Technology, Shanghai 200093, China

Received 27 March 2012; Revised 28 April 2012; Accepted 29 April 2012

Academic Editor: Victor S. Kozyakin

Copyright © 2012 Chuanbo Wen et al. This is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

#### Abstract

This paper deals with the robust filtering problem for linear discrete-time constrained systems. The purpose is the design of a linear filter such that the resulting error system is bounded. An orthogonal factorization is used to decompose the original robust filtering problem into stochastic and deterministic parts, which are then solved separately. Finally, a numerical example is presented to demonstrate the applicability of the proposed method.

#### 1. Introduction

Kalman filtering is one of the well-known filtering methods that is widely used in the fields of signal processing and automatic control [1]. It is noted that the Kalman filtering method is based on the assumption that the system has known model and its disturbances are Gaussian white noises with known statistics. In some applications, however, the statistics of the noises are not exactly known, and the standard Kalman filtering algorithms will generally not guarantee satisfactory performance and only can obtain the estimate value with great error. Also, the strict assumptions limit the application scope of this filtering especially when there are uncertainties in either the state model or the measurement model. To handle the above problem, an alternative regularized estimate method based on least square design technique has been proposed recently. The objective is to find a filter such that the resulting estimate error is bounded and the main idea of this method is to reduce the vector optimization problem to an equivalent scalar minimization problem [2, 3]. Compared with earlier studies, such as method and guaranteed-cost method, the new method simultaneously uses regularization and weighting to deal with a class of uncertainties [3–5].

On the other hand, constrained filtering and control problem has drawn considerable attention over the past decades due to extensive application backgrounds. Actually, constraint formulation arises naturally in many fields such as target tracking, manufacturing production, engine health estimation, and vehicle motion [6, 7]. One of the features of these systems is that some components of the state are affected by some equations without noises. In conventional linear stochastic models with additive white process noise, filtering method for constrained systems has been investigated by many scholars. For example, Wen and Durrant-Whyte have considered the constrained problem by treating the set of constraint equations as additional accurate observations without noises [8]. Simon and Chia have shown that the solution of constrained problem can be obtained by treating the constraint equation as a constrained condition and solving a Lagrangian equation [9]. Moreover, Hewett et al. have presented a reduced null space method based on the null space decomposition to solve such problems [10].

Among the previous works on constrained estimation, the most popular approach is the projection method. This method enforces linear equality constraints on state space estimation, and the constrained estimate is merely a correction that forces the unconstrained estimate onto the constraint space [9]. In actual estimate and in value of objective function, the null space method often produces similar results as that of the project method. For the problem of robust filtering for constrained systems, however, there are still no results available in the literature. This motivates the present study. The regularized robust filtering is originally developed by Sayed to deal with the regularized dynamic system [2, 3] and Ishihara et al. use this method to present the robust filtering for uncertain singular system [11]. In this paper, we will give the regularized robust design method for uncertain constrained system.

In this paper, we deal with the robust filtering problem for uncertain constrained systems. Attention is focused on solving the least square problem, and the robust Kalman type recursion is developed. The remainder of this paper is organized as follows. Section 2 formulates the constrained systems and the problems to be solved. We review the filtering method for accurate constrained model in Section 3. In Section 4, the QR factorization is used to gain a new reduced system and the robust filtering is presented. We show numerical example that illustrates the new method performance in Section 5 and offer conclusion in Section 6.

The notation used in this paper is standard. and are the transpose and the pseudoinverse of the matrix , respectively. () denotes a positive-definite (semidefinite) matrix. For a column vector and a positive matrix , is the Euclidean norm of , and is the weighted form. denotes a block diagonal matrix with entries and .

#### 2. Problem Formulation and Analysis

##### 2.1. Problem Formation

Consider a uncertain linear constrained system described by following model: where is the state vector satisfying equality constraints and is the measurement output. is a state update matrix, is an observation matrix, is a constraint matrix, and is a known vector. and are time-varying uncertainties to the nominal system matrices. The initial state , process noises sequence , and measurement noises sequence are uncorrelated zero mean white noises with variance where is the Kronecker function, , , and . The uncertainties are assumed with the following structure: where , , and are known matrices, and is a bounded matrix but otherwise arbitrary. We allow , , and to vary with time.

The purpose of this paper is to find a recursive robust state estimate algorithm for this constrained system with modeling uncertainties. With the constrained condition (2.3), the system (2.1)–(2.3) is not a standard form and the robust filtering presented in [2] is not applicable, so we cannot directly use them to present the analysis. The key to solving this problem is to transfer the constrained system into some new systems without constraint.

On the other hand, the final estimate result of the state should satisfy the additional constraint (2.3), which means that the estimate belongs to the space, denoted as , composed by the solutions of (2.3). The constraint matrix and vector are assumed to satisfy to make . We assume that the constraint matrix has full column row rank and .

#### 3. Standard Constrained Filter

The constrained filter algorithm has some advantages compared with the standard Kalman filter, which are given in [9, 10]. In this section, we will review the constrained filtering method for accurate state-space model.

The accurate constrained system is

In [10], it uses orthogonal factorization to decompose the original state into stochastic and deterministic parts. The factorization of and the initial state can be rewritten as where

It also gives a new reduced constrained system

The recursive estimate algorithm for accurate constrained system can be summarized as

*Step 0. *
Initialization

decomposition:

The deterministic part is

Set

*Step 1. *Prediction

decomposition:

The deterministic part is

According to (3.5), it gives

*Step 2. *Measurement Update

One has

*Step 3. *Reconstruction

Prediction reconstruction:

Estimate reconstruction:

The key for the above recursive estimation algorithm is finding the optimal estimation of . With (3.5), the optimal estimate of can be derived by solving the following regularized least-square problem:

Next, we will present the robust filter for the uncertain constrained system also by solving a uncertain least-square problem.

#### 4. Robust Filtering

Referring again to the state-space model (2.1)–(2.3), the optimum robust filtering method will be presented in this section. Firstly, we will decompose the original uncertain constrained system into two parts, and then solve them separately.

##### 4.1. New Dimension Reduced Uncertain Model

With the state evolution equation (2.1) and measurement equation (2.3), we will give the optimal estimate for state . Similar to the approach described in Section 3, we will use the null space method to deal with the uncertain model.

According to the uncertain model (2.1)–(2.3), we define the factorization of and rewrite the initial state equation as where is an matrix whose columns form a basis for , and is an matrix whose columns form a orthogonal basis for .

Substituting (4.1) into (2.3) gives then we have

Also substituting (4.1) into (2.1), we have

Both sides of above equation multiplying gives

Since

We have

Similarly, substituting (4.1) into (2.2) gives that is,

The uncertain constrained state space model in is converted into an unconstrained uncertain state space model in . Written together, (4.7) and (4.9) yield a new uncertain unconstrained state space model.

##### 4.2. Robust Filtering for the Uncertain Model

Reference [2] develops the framework for state estimation when the parameters of the state equations are subject to uncertainties. However, both the system matrix and measurement matrix in the system (4.7) and (4.9) have uncertainties, and the matrix defined in [2] cannot directly be used. In order to present the robust filtering for this system, some new matrices will be defined in next subsection.

Let us first introduce a lemma.

Lemma 4.1 (see [2]). * Consider the following optimization problem:
**
where denotes the data matrix, denotes a perturbation matrix, denotes the measurement vector, and denotes a perturbation vector. is the unknown vector, and is a weighting matrix. and are assumed to satisfy a model
**
where is an arbitrary contraction satisfying . , , and are known quantities of appropriate dimensions.**The problem (4.11) has a unique solution, which is given by
**
where the modified weighting matrix is defined by
**
and is a nonnegative scalar parameter obtained by following optimization problem:
**
where
**The auxiliary function are defined by
*

As mentioned in Section 3, the optimal estimate problem can be solved by minimizing the cost function (3.15). Similarly, the robust filtering problem for the dimension reduced model (4.7) and (4.9) can be turn to solve following least-square problem: where

In (4.18), the parameters and contain uncertainties. With appropriate definition, the lest-square problem can be rewritten more compactly. Let us define

Let and be the estimate result and estimate error covariance of the stochastic vector , respectively. With Lemma 4.1 and above definition, the robust filter for can be summarized as in the following theorem.

Theorem 4.2. *Assume that the estimate and the estimate error covariance of have been known. At time index , the robust filter of can be given by solving the following equation:
**
where
**
and is determined by minimizing the function of (4.16) in the interval , where
*

*Proof. *Analogous to [2, 3, 11], using Lemma 4.1 yields (4.21).

Theorem 4.2 gives the robust filter of , then, the robust constrained estimate of the full state can be constructed by using the relationship

It is easily verified that satisfies the constraint equation

Similarly, the constrained error covariance can be computed by using where of (4.35) is the estimate error covariance of .

##### 4.3. Recursive Form of Constrained Robust Filter

After some considerable algebra, similar to [2], the recursive robust estimate can be summarized as follows.

*Step 0. *Initialization

decomposition:

The deterministic part is

Set

*Step 1. *Determining *QR* decomposition:

It gives the deterministic part at time index
and the new dimension reduced robust system (4.7) and (4.9).

If , then set . Otherwise, with the definitions of (4.20), determine the scalar parameter by minimizing over the interval .

*Step 2. *Replace Parameters

If , the original parameters are replaced by

*Step 3. *Prediction and Update

Prediction:

Update:
where

*Step 4. *Reconstruction

Prediction reconstruction:

Estimate reconstruction:

Steps 1–4 give the robust estimate of the full state .

*Remark 4.3. * From the definition of and the prediction and update process in Step 3, it is easy to verify that for the constrained system without uncertainties, the robust filtering algorithm reduces to the filtering result introduced in [10].

*Remark 4.4. * If and , the matrix and the dimensional reduced model (4.7) will disappear, then we have .

#### 5. Numerical Example

In this section, simulations are presented to verify the performance of the new algorithm. We consider an example described by (2.1)–(2.3), with . The parameters are given as follows:

The initial state is , , and we will take sampling points. Figures 1 and 2 display the estimate error variance of and , respectively. The variance curves are computed via the ensemble-average

Each point at instant in each variance curve is the ensemble-average calculated over experiments. For each experiment with norm less or equal than one is selected randomly.

To demonstrate the performance of the new robust filter more clearly, we also present the variance curves of the Kalman filter for uncertain model and the system without uncertainties. The variances of these two filters are also shown in Figures 1 and 2.

From Figures 1 and 2, we see that the performance of new filter is better than that of Kalman filter when they are used to deal with the uncertain model, this is because Kalman filter does not consider the uncertain parameters. The variance of Kalman filter dealing with accurate model is smaller than that of new filter dealing with uncertain model.

Furthermore, the performance of an algorithm is often affected by the measurement noises, and larger noises variance always bring larger estimate error variance. Table 1 lists the error variance for with three different measurement noises variance to show the variation of performance.

From Table 1, we see that, for and , the larger is the noise variance, the larger is estimation error variance.

#### 6. Conclusions

This paper has studied the robust constrained filtering problem for linear discrete uncertain systems. The original constrained system is transformed into a new uncertain unconstrained system. The state of the new system is derived by the least square method and then the optimal estimate is obtained similar to the update process of the robust Kalman filter. A numerical example is presented to show the effectiveness of the new filter. Next, we will consider the regularized filtering method for the case when network-induced phenomena are taken into account [12–15].

#### Acknowledgments

This work was supported by Natural Science Foundation of China under Grant (60801048, 61004088, 91016020), the Key Foundation for Basic Research from Science and Technology Commission of Shanghai (09JC1408000), the Key Foundation for Innovative Research from Education Commission of Shanghai (12ZZ197), and the Key Training Foundation from Shanghai Dianji University (12C102).

#### References

- Y. Bar-Shalom and X. R. Li,
*Estimation with Applications to Tracking and Navigation*, John Wiley & Sons, New york, NY, USA, 2001. - A. H. Sayed, “A framework for state-space estimation with uncertain models,”
*IEEE Transactions on Automatic Control*, vol. 46, no. 7, pp. 998–1013, 2001. View at Publisher · View at Google Scholar · View at Zentralblatt MATH - A. H. Sayed, V. H. Nascimento, and F. A. M. Cipparrone, “A regularized robust design criterion for uncertain data,”
*SIAM Journal on Matrix Analysis and Applications*, vol. 23, no. 4, pp. 1120–1142, 2002. View at Publisher · View at Google Scholar · View at Zentralblatt MATH - K. M. Nagpal and P. P. Khargonekar, “Filtering and smoothing in an ${H}^{\infty}$ setting,”
*IEEE Transactions on Automatic Control*, vol. 36, no. 2, pp. 152–166, 1991. View at Publisher · View at Google Scholar · View at Zentralblatt MATH - P. Bolzern, P. Colaneri, and G. De Nicolao, “Optimal design of robust predictors for linear discrete-time systems,”
*Systems & Control Letters*, vol. 26, no. 1, pp. 25–31, 1995. View at Publisher · View at Google Scholar · View at Zentralblatt MATH - S. Ko and R. R. Bitmead, “State estimation for linear systems with state equality constraints,”
*Automatica*, vol. 43, no. 8, pp. 1363–1368, 2007. View at Publisher · View at Google Scholar · View at Zentralblatt MATH - G. Dissanayake, S. Sukkarieh, E. Nebot, and H. Durrant-Whyte, “The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications,”
*IEEE Transactions on Robotics and Automation*, vol. 17, no. 5, pp. 731–747, 2001. View at Publisher · View at Google Scholar · View at Scopus - W. Wen and H. F. Durrant-Whyte, “Model-based multi-sensor data fusion,” in
*Proceedings of the IEEE International Conference on Robotics and Automation*, pp. 1720–1726, May 1992. View at Scopus - D. Simon and T. L. I. Chia, “Kalman filtering with state equality constraints,”
*IEEE Transactions on Aerospace and Electronic Systems*, vol. 38, no. 1, pp. 128–136, 2002. View at Publisher · View at Google Scholar · View at Scopus - R. J. Hewett, M. T. Heath, M. D. Butala, and F. Kamalabadi, “A robust null space method for linear equality constrained state estimation,”
*IEEE Transactions on Signal Processing*, vol. 58, no. 8, pp. 3961–3971, 2010. View at Publisher · View at Google Scholar - J. Y. Ishihara, M. H. Terra, and J. C. T. Campos, “Robust Kalman filter for descriptor systems,”
*IEEE Transactions on Automatic Control*, vol. 51, no. 8, pp. 1354–1358, 2006. View at Publisher · View at Google Scholar - B. Shen, Z. Wang, H. Shu, and G. Wei, “${H}_{\infty}$ filtering for nonlinear discrete-time stochastic systems with randomly varying sensor delays,”
*Automatica*, vol. 45, no. 4, pp. 1032–1037, 2009. View at Publisher · View at Google Scholar · View at Zentralblatt MATH - B. Shen, Z. D. Wang, H. S. Shu, and G. L. Wei, “On nonlinear ${H}_{\infty}$ filtering for discrete-time stochastic systems with missing measurements,”
*IEEE Transactions on Automatic Control*, vol. 53, no. 9, pp. 2170–2180, 2008. View at Publisher · View at Google Scholar - H. L. Dong, Z. D. Wang, and H. J. Gao, “Robust ${H}_{\infty}$ filtering for a class of nonlinear networked systems with multiple stochastic communication delays and packet dropouts,”
*IEEE Transactions on Signal Processing*, vol. 58, no. 4, pp. 1957–1966, 2010. View at Publisher · View at Google Scholar - H. L. Dong, Z. Wang, D. W. C. Ho, and H. Gao, “Variance-constrained ${H}_{\infty}$ filtering for a class of nonlinear time-varying systems with multiple missing measurements: the finite-horizon case,”
*IEEE Transactions on Signal Processing*, vol. 58, no. 5, pp. 2534–2543, 2010. View at Publisher · View at Google Scholar