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 I / Utilities / Digital Filters<br />

_ _<br />

1<br />

χ− 1 : = χ−2<br />

: =<br />

⎜<br />

⋅<br />

3 ⋅ ξ ⎟<br />

1 − ξ2<br />

− ξ3<br />

22.8-6<br />

⎛<br />

⎜<br />

⎝<br />

ξ<br />

−1<br />

⎞<br />

⎟<br />

⎠<br />

X<br />

I<br />

Equation 22.8-41<br />

If (I := 1), and on first use, the filter is re-initialised without integration<br />

using input (XI). Each filter is identified by a unique number (N).<br />

22.8.7 Digital α−β−γ Filters<br />

D_ABG propagates 50 α−β−γ filters with time varying gains (α,β,γ). The<br />

input (XI) is returned filtered (F_X) together with its 1 st and 2 nd derivatives<br />

(F_DX and F_D2X) using the equations given in §21.2.<br />

D_ABG<br />

( , X , DX , D2X<br />

, α , β , γ , F _ X , F _ DX , F _ D2X<br />

, N , I )<br />

t I I I<br />

Equation 22.8-42<br />

The provision of current time (t) allows for variable update rates, the time<br />

interval for filter propagation being determined for each channel (N),<br />

∆<br />

t : = t − t k −1<br />

Equation 22.8-43<br />

If argument (I) is set to 1, and on first use, the filter is re-initialised using the<br />

input (XI) and its 1 st and 2 nd derivatives. Each filter is identified by a unique<br />

number (N).<br />

22.8.8 Tuned Digital α−β−γ Filters<br />

T_ABG propagates 50 weave frequency (ωW) tuned α−β−γ filters using 1 st<br />

order integration with time varying gains based on the filter bandwidth (ωE).<br />

The input (XI) is returned filtered (F_X) together with its 1 st and 2 nd<br />

derivatives (F_DX and F_D2X) using the equations given in §21.4.<br />

T_ABG<br />

( t , X , DX , D2X<br />

, ω , ω , F _ X , F _ DX , F _ D2X<br />

, N , I )<br />

I<br />

I<br />

WT<br />

ϕ<br />

I<br />

αβγ<br />

E<br />

≡<br />

( X , ω , ω )<br />

Equation 22.8-44<br />

If (I := 1), and on first use, the filter is initialised using input (XI) and its 1 st<br />

and 2 nd derivatives. Each filter is identified by a unique number (N).<br />

22.8.9 Digital α−β−γ Filter Covariances<br />

I<br />

ABG_COVARS takes a set of α−β−γ filter gains at time (t), and the input<br />

variance (E(XI)), and returns a [3,3] covariance matrix [P] using the<br />

equations given in §20.2.<br />

W<br />

E<br />

W

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

Saved successfully!

Ooh no, something went wrong!