Mathematical Problems in Engineering

Volume 2015, Article ID 946952, 6 pages

http://dx.doi.org/10.1155/2015/946952

## New Viewpoints about Pseudo Measurements Method in Equality-Constrained State Estimation

College of Mathematics, Sichuan University, Chengdu, Sichuan 610064, China

Received 4 October 2014; Revised 20 February 2015; Accepted 25 February 2015

Academic Editor: Elmetwally Elabbasy

Copyright © 2015 Bingjie Zhu 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

We discuss the pseudo measurement method which is one of the main approaches to equality-constrained state estimation for a dynamic system. We demonstrate by the fundamental theory of Kalman filtering that reviewing the equality constraint as a pseudo measurement seems questionable. The main reason is that the additional pseudo measurement is actually a constant here which cannot help to estimate the state. More specifically, when the states in an unconstrained dynamic system model have already satisfied the equality constraint, the extra constraint is obviously not necessary. When the true equality-constrained states do not satisfy the unconstrained dynamic process equation, the effect of pseudo measurement is projecting the estimate which is not optimal onto the constraint set. However, since the performance of a projected estimate is also certainly influenced by its original estimate, we show through a numerical example that the pseudo measurement method is not always a good choice, especially when the process equation mismatch is large.

#### 1. Introduction

In practice, filtering problems often have certain inherent and known constraints in the physical dynamic systems [1], for example, target tracking [2, 3], robotics [4], multisensor data fusion [5, 6], vision-based systems [7], econometric modeling [8], biomedical systems [9] and others [10, 11]. For equality-constrained state estimation, numerous approaches have been developed, for example, the model reduction method [5, 6, 12], the pseudo measurement method [13–18], the estimate projection method [19, 20], the system projection method [21], the gain projection method [22], and some other methods [11, 23].

Among these methods, the pseudo measurement method has been deeply investigated. This method is to augment the measurement space of the filter with the equality constraints (i.e., as perfect noise-free measurements) at each iteration. It is clearly simple and easy to be implemented. However, since the pseudo measurements are error free, the augmented measurement noise has a singular covariance. Numerical problems may arise when the Kalman filtering is applied. Moreover, the increase in the dimension of the augmented measurement will increase the computational burden of the state estimator [20]. In order to deal with this problem, Duan and Li proposed two sequential forms of the pseudo measurement method in [18]. By the sequential forms, they computed the equivalence of Kalman filtering with and without pseudo measurement and proved that, under certain conditions, the use of the pseudo measurement for filtering is redundant. There are also many discussions about the equivalence between the pseudo measurement method and the others (see [17, 24–26]). Gupta [24] proved that, under certain conditions, the pseudo measurement method and the estimate projection method result in mathematically equivalent constrained estimate structures. Moreover, this equivalent estimate has a smaller error covariance than that of the unconstrained state estimate [20].

In this paper, we discuss the reasonability of the pseudo measurement method. By the fundamental theory of Kalman filtering, we demonstrate that reviewing the equality constraint as a pseudo measurement seems questionable. The main reason is that the additional pseudo measurement is actually a constant here which cannot help to estimate the state. More specifically, when the states in an unconstrained dynamic system model have already satisfied the equality constraint, the extra constraint is obviously not necessary. When the true equality-constrained states do not satisfy the unconstrained dynamic process equation, but they are actually observed, that is, the true state only satisfies the measurement equation, the optimality of Kalman filtering is of course lost. The effect of pseudo measurement in this case, as said by Gupta [24], is to project the estimate which is not optimal onto the constraint set. Therefore, when such an estimate is outside the constraint set, the projected estimate will of course be better than the Kalman filtering without the pseudo measurement. Our analysis seems more straightforward and essential. Moreover, since the performance of a projected estimate is also certainly influenced by its original estimate, we show through a numerical example that the pseudo measurement method is not always a good choice especially when the process equation mismatch is large.

This paper is organized as follows. In Section 2, problem formulation and a brief summary of the pseudo measurement method are presented. In Section 3, we demonstrate that the pseudo measurement method is redundant simply by using the fundamental theory of Kalman filtering rather than computing the equivalence of Kalman filtering with and without pseudo measurement. We also discuss the pseudo measurement method in the mismatch process equation. Numerical examples are provided in Section 4. Finally, we present our conclusions in Section 5.

#### 2. Problem Formulation

Consider the following dynamic system:where is the system state, is the measurement vector, and the process noise and measurement noise are zero-mean white noise sequences with the following covariances where is the Kronecker delta function, that is if and if . Matrices and are of appropriate dimensions. It is known that the state vector in (1) is subject to the following linear equality constraint:where is a known constant matrix and is a known constant vector.

To deal with this problem, the pseudo measurement method first augments the measurement space of the filtering with the equality constraints (i.e., as perfect noise-free measurements) at each iteration and rewrites the measurement equation (2) as partitioned form accordingly:and the state equation (1) is not changed. Then classic Kalman filtering can be used to estimate the state vector in the remodeled dynamic system (1) and (5). The details are omitted here.

*Remark 1. *We must notice that the modification from (2) and (4) to (5) is not equivalent. The state vector is random and its value depends on the sample of the process noise . However, the equality constraint equation (4) of the state exists objectively. For example, a car moves on a road. It means that every possible sample of the state should satisfy the equality constraint. On the other hand, if we take the equality constraints as a pseudo measurement (5), it only requires the current measured sample of state to satisfy the equality constraint and does not restrict all possible values of in the constraint set. Therefore, the equality constraint has been changed significantly in this method.

In fact, the true state vector must satisfy the equality constraint equation (4). However, in practice, we often give the dynamic system equation (1) at first. Then, if we get extra information about the state vector, we give the additional constraint (4). In this situation, usually, in (1) cannot be guaranteed to satisfy the equality constraint equation (4). We call the process equation in this situation mismatch. In the following, we will discuss the pseudo measurement method in the cases of both an* exactly matched process equation* and a* mismatched process equation*.

#### 3. Analysis of Pseudo Measurement Method

In this section, we will discuss the pseudo measurement method for more details. From Section 2, we can see that the essence of the pseudo measurement method is augmented measurement Kalman filtering. Kalman filtering is the best known recursive least mean square error (LMSE) algorithm to optimally estimate the unknown state of a dynamic system. For later use with analyzing the pseudo measurement method, we first present the famous LMSE estimate theorem (see [27]).

Lemma 2. *Let the random variable**have mean and covariance**Then, the LMSE estimate of using is given by**where denotes the pseudoinverse.*

We denote the following: is the estimation of the dynamic system equations (1)-(2) by Kalman filtering; is the estimation of the augmented dynamic system equations (1), (5) by Kalman filtering, that is, the pseudo measurement method.

We have the following theorem for the pseudo measurement method with exactly matched process equation.

Theorem 3. *If the two estimators are initialized by the same and error covariance matrix , the use of the pseudo measurement for exactly matched process equation is redundant; that is,*

*Proof. *When the process equation is exactly matched, the pseudo measurement method is just a recursive LMSE estimation using all observations to estimate . Since is a constant vector, . According to Lemma 2, it is no use to estimate by a constant vector . Thus, it is easy to see that the pseudo measurement method, which adds a constant vector to estimate the state vector , is redundant for the LMSE estimation; that is, .

*Gupta [24] proved that under certain conditions, the pseudo measurement method and the estimate projection method result in mathematically equivalent constrained estimate structures. Moreover, this equivalent estimate has a smaller error covariance than that of the unconstrained state estimate [20]. This is to say the estimation given by the pseudo measurement method should satisfy the equality constraint equation (4) and its result is better than ; that is,*

*By Gupta’s conclusion, the estimate of pseudo measurement method, is the projection of onto the constraint set. However, we have in Theorem 3. In fact, Theorem 3 does not contradict Gupta’s conclusion, since, in the following corollary, we show that , without the pseudo measurement in Theorem 3, has already satisfied the constraint.*

*Corollary 4. If the state vector in (1) has already satisfied the equality constraint equation (4), the estimate by Kalman filtering without the pseudo measurement must satisfy the constraint; that is, .*

*Proof. *As we know, the estimate of Kalman filtering is the LMSE estimate. By Lemma 2, we havewhereMultiplying both sides of (11) by the same matrix ,We complete the proof.

*Remark 5. *By Corollary 4, Gupta’s conclusion and the conclusion in Theorem 3 are consistent. Since satisfies the constraint, the projection of onto the constraint set is still equal to itself. Thus, we show in another way.

*By Gupta’s conclusion, although the pseudo measurement can make the estimate better than the estimate without the pseudo measurement in the case of mismatched process equation, we have to note that the model mismatch is also an important factor in estimation performance. In practice, it is quite possible for a large mismatch to result due to an extra constraint, especially when the constraint not only constrains the trajectory of target but also significantly changes its moving conditions. For example, if the unconstrained process equation originally presents a car as moving on a high way, then one discovers that it is moving on a countryside road. In this case, the velocity of the car and road noise would be very different; that is, the original process equation mismatches the present state significantly. In the next section, we will show through a numerical example that the pseudo measurement method is not always a good choice when the process equation mismatch is large.*

*4. Numerical Examples*

*In this section, simulations will be done for a dynamic system with equality constraints. We discuss the performances of the pseudo measurement method in both an exactly matched process equation and a mismatched process equation.*

*Example 1 (exactly matched process equation). *A two-dimension target tracking problem is considered. The target dynamic models are given as (1)-(2). The first two elements of the state vector are positions in two coordinates and the last two elements of the state vector are their velocities, respectively. The state transition matricesand the measurement matrix is given byThe target starts at , . The covariance matrices of the noises are given byIt is clear that the target moves along a line and the state satisfies the following equality constraint:Using 100 Monte-Carlo runs, we can evaluate the estimation performance of an algorithm by estimating the second moment of the tracking error:Figure 1 compares the tracking errors of Kalman filtering with and without pseudo measurement. The performance of the pseudo measurement method is the same as that of Kalman filtering. The use of pseudo measurement for filtering is redundant.