Linear State Estimation (GPS)

For deterministic systems, Section 3.6 discussed the problem of state estimation. This section considers state estimation for stochastic, linear, discrete-time state space systems

tmp3AC1075_thumb

wheretmp3AC1076_thumb: is a known signal. The standard notation and assumptions stated in Section 4.6.1 apply.

The state estimate is computed according to

tmp3AC1078_thumb


wheretmp3AC1079_thumbis called the measurement residual andtmp3AC1080_thumbis a designer specified gain vector. The notationtmp3AC1081_thumbindicates the estimate of x at timetmp3AC1082_thumbbefore correcting the estimate for the information in the measurementtmp3AC1083_thumbandtmp3AC1084_thumbdenotes the estimate of x after correcting the estimate for the information in the measurementtmp3AC1085_thumbSimilar interpretations apply totmp3AC1086_thumb

Defining the state estimation error vector at timetmp3AC1087_thumbprior and posterior to the measurement correction, as

tmp3AC1097_thumb

the state estimation error time propagation, output error, and measurement update equations are

tmp3AC1098_thumb

To determine conditions for stability in the time invariant case, substituting eqn. (4.124) into eqn. (4.122), taking the expected value, and simplifying yields

tmp3AC1099_thumb

where the notationtmp3AC1100_thumbhas been used fortmp3AC1101_thumbTherefore, the stability of the system requires that the eigenvalues of the matrixtmp3AC1102_thumbbe strictly less that one in magnitude.

From eqn. (4.122), the covariance of the state estimation error prior to the measurement update is given by eqn. (4.99):

tmp3AC1106_thumb

From eqn. (4.123), the covariance matrix for the predicted output error is

tmp3AC1107_thumb

From eqn. (4.124), the covariance matrix for the state estimation error posterior to the measurement correction is

tmp3AC1108_thumb

If the gain sequence Lk is known, then eqns. (4.125—4.127) can be iterated to quantify the expected accuracy of the state estimation design for the given Lk.

Eqn. (4.127) is true for any state feedback gain Lk; therefore, this equation allows the performance (as measured by state error covariance) of alternative gain sequences to be quantitatively compared. In fact, eqn. (4.127) expresses the covariance of the state estimate immediately after the measurement correction as a function of the estimation gain vector Lk ; therefore, a new gain vector could be selected at each time instant to minimize the state estimation error variance.

Next post:

Previous post: