14.02.2013 Views

Thesis - Leigh Moody.pdf - Bad Request - Cranfield University

Thesis - Leigh Moody.pdf - Bad Request - Cranfield University

Thesis - Leigh Moody.pdf - Bad Request - Cranfield University

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

Chapter 5 / Missile State Observer<br />

_ _<br />

If (PIM) 2 is > 2 to 3 the measurements are discarded. If average value of<br />

(PIM) 2 exceeds 1 the state and/or measurement noise can be adapted on-line.<br />

5.10.8 Covariance Matrix Conditioning<br />

There are a number of approaches to ensure that the covariance matrix [C]<br />

remains symmetric and supposedly positive definite. On-line testing is<br />

often restricted to ensure that the main diagonal elements are positive and,<br />

C<br />

2 ( i , j ) < C ( i , i ) ⋅ C ( j , j )<br />

5-29<br />

Equation 5.10-2<br />

These simple tests provide a warning of ill-conditioning in [C] and the<br />

possibility of filter divergence; they are not a definitive indicator of positive<br />

definiteness. Sylvester’s Criteria is often used for the later where the<br />

determinant of [C], and all its sub-minors, must be positive. This is<br />

computationally intensive test and one rarely employed in practical systems<br />

where symmetry is assured by computing only a triangular partition of [C],<br />

( j , i ) : C ( i , j )<br />

i ≠ j ⇒ C =<br />

Equation 5.10-3<br />

To prevent state lockout indicated by a zero on the main diagonal of [C],<br />

and numerical instability if any of these values are negative, an artificially<br />

lower bound can be applied, Griffin [G.15] . Such lower thresholds must<br />

reflect any state scaling - see the thorough discourse on [C] matrix illconditioning<br />

by Kerr [K.6] .<br />

( i , i ) : C ( i , i )<br />

C =<br />

The off-diagonal terms are then modified,<br />

*<br />

( ≠ j ) ∧ ( j > i ) ⇒ C ( i , j )<br />

Equation 5.10-4<br />

2<br />

C ( i , j )<br />

( i , i ) ⋅ C ( j , j )<br />

i : = *<br />

*<br />

C<br />

Equation 5.10-5<br />

Kerr warns that these ad-hoc approaches to protect [C] can significantly<br />

alter the matrix beyond reason, and may not prevent filter divergence.<br />

5.10.9 Filter Performance and Observability<br />

Stochastic filters that meet the tenants of the KF are well tuned when the<br />

63% of the actual state errors after a measurement update are matched to the<br />

expected covariance [C]. A performance metric based on this principle is<br />

the normalised distance (PIX) provided by the utility defined in §22.13.15,

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!