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 3 / Sensors / Accelerometers<br />

_ _<br />

3.5.3.3 Sensor Cross Coupling Error<br />

Imperfect and finite bandwidth re-balancing of the pendulum causes<br />

misalignment of the Pendulum and Input axes. The angular displacement of<br />

the pendulum about the Hinge axis (γ) is kept as small as possible<br />

commensurate with pick-off scale factor. The specific acceleration<br />

experienced by each accelerometer is thus,<br />

∀<br />

∈<br />

{ R , P , Y }<br />

⇒<br />

⎛ Ii<br />

⎡ 1 0 − γ ⎞<br />

i ⎤ f<br />

⎜ r, u ⎟<br />

⎛ 0 ⎞<br />

i ⎢<br />

⎥<br />

⎜ ⎟<br />

Hi<br />

f r, u : = ⎢ 0 1 0 ⎥ ⋅ ⎜ fr,<br />

u ⎟ + ⎜ γ&<br />

⎟<br />

⎢<br />

⎥ ⎜ Pi ⎟ ⎜ ⎟<br />

⎣<br />

γ i 0 1<br />

⎦ ⎝<br />

fr,<br />

u ⎠ ⎝ 0 ⎠<br />

i i<br />

3.5-5<br />

Equation 3.5-3<br />

The pendulum forcer is similar in principle to the gyroscope torquer, with<br />

typical PWM re-balancing loop bandwidths of 80-150 Hz and a damping of<br />

0.6-0.8. The forcer can be reduced to the 2 nd order lag with range limiting<br />

and quantisation described later. Applying a masking matrix [AXM] to<br />

deal with the different Hinge axis orientations, and relating the Hinge axis to<br />

individual sensor RPY axes,<br />

f<br />

U<br />

r,<br />

u<br />

⎛ XR<br />

f ⎞<br />

⎜ r, u ⎟ ⎛ ⎡ YR XP XY ⎤ ⎞<br />

XP<br />

⎜<br />

fr,<br />

u fr,<br />

u fr,<br />

u<br />

: = ⎜ f ⎟ − γ ⊗ [ ] ⋅<br />

⎟<br />

r, u<br />

AXM<br />

AC ⎜<br />

⎢ ZR ZP YY ⎥<br />

⎜ ⎟<br />

⎟<br />

XY<br />

⎝ ⎢⎣<br />

fr,<br />

u fr,<br />

u fr,<br />

u ⎥⎦<br />

⎠<br />

⎝<br />

fr,<br />

u ⎠<br />

AC<br />

For the configuration selected,<br />

γ<br />

( ) T<br />

γ , γ ,<br />

: =<br />

γ<br />

AC<br />

R<br />

[ AXM ]<br />

: =<br />

AC<br />

P<br />

⎡ 0<br />

⎢<br />

⎢<br />

1<br />

⎢⎣<br />

−1<br />

1<br />

0<br />

0<br />

⎤<br />

⎥<br />

⎥<br />

⎥⎦<br />

AC<br />

Y<br />

Equation 3.5-4<br />

Equation 3.5-5<br />

Equation 3.5-6<br />

The cross-coupling misalignment angle (γ) is determined from the 2 nd order<br />

PWM dynamics activated by setting bit 3 of MS_AC_ER.<br />

3.5.4 Measured Specific Acceleration and Velocity Increments<br />

Ignoring biases caused by pendulum angular velocity and acceleration,<br />

Savage’s model of a single axis mechanical accelerometer expressed in<br />

(I,H,P) axes reduces to,

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

Saved successfully!

Ooh no, something went wrong!