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.

Appendix H / Steady State Tracking Filters<br />

_ _<br />

21.1 Introduction<br />

Kalata [K.7] produced an α−β filter in 1984 which minimised the sum of the<br />

expected PV errors for a filter driven by piecewise constant acceleration.<br />

He also introduced the tracking index (TI) concept that has become a key<br />

element in selecting static filter gains. Sudano [S.17] was responsible for the<br />

α−β−γ filter driven by piecewise continuous jerk minimising expected<br />

PVA error in 1993. The constant acceleration dynamics was replaced by<br />

manoeuvre driven filters first by Sudano [S.16] (1 st order Gauss-Markov in<br />

1995), and by Vorley [V.3] (2 nd order Gauss-Markov in 1991). In these cases<br />

the filter gains are complex functions of the TI requiring iterative<br />

numerical solution, the TI representing the ratio of system to measurement<br />

noise, balancing measurement smoothing with accurate tracking.<br />

21.2 Constant Velocity Filter<br />

An α−β filter with states {X,d(X)/dt}, minimising the Performance Index<br />

used by Kalata [K.7] ,<br />

∑<br />

2 2<br />

2<br />

( E ( ∆X<br />

) + ∆t<br />

⋅ E ( ∆X<br />

) )<br />

J : = min<br />

&<br />

Resulting in the recursive state equations,<br />

( 1 − α ) ⋅ ( X + X&<br />

⋅ ∆t<br />

) + α ⋅ X ( k )<br />

Xk 1 : =<br />

k k<br />

I<br />

+<br />

X&<br />

β<br />

k + 1 : = ⋅<br />

⋅<br />

∆t<br />

( XI<br />

( k ) − Xk<br />

) + ( 1 − β ) X&<br />

k<br />

21-3<br />

Equation 21.2-1<br />

Equation 21.2-2<br />

Equation 21.2-3<br />

Kalata also introduced the tracking index (TI) on which the filter gains in<br />

many subsequent papers on this subject rely. The TI relates the<br />

uncertainty in the X-state (σS) to the uncertainty in the measurement of<br />

that state (σM),<br />

TI<br />

: =<br />

σS<br />

⋅ ∆t<br />

σ<br />

M<br />

2<br />

Equation 21.2-4<br />

The noise characteristics, and the update rate of the filter (∆t), define the<br />

tracking index from which the gains are computed. The filter gains are a<br />

function of the number of measurements processed (n), Quigley [Q.1] ,

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

Saved successfully!

Ooh no, something went wrong!