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 / Seeker<br />

_ _<br />

This model is activated by setting bit 12, and either bit 13 or bit 14 of<br />

MS_SK_ER, invoking the torque and friction models respectively. Consider<br />

the yaw gimbal dynamic model shown in Figure 3-51 (the pitch gimbal<br />

model has exactly the same form). The model comprises in order, from left<br />

to right: a lead-lag gimbal controller, DAC gain, motor current limit, motor<br />

dynamics and gimbal inertia.<br />

1<br />

+<br />

+<br />

-<br />

CONTROLLER<br />

0.0105s+1<br />

0.0015s+1<br />

TIME<br />

120<br />

OL<br />

[-12,12]<br />

3.9-8<br />

MOTOR<br />

0.15*5026^2<br />

s 2+2*0.7*5026s+5026^2<br />

GIMBALS<br />

1<br />

0.0005s 2<br />

Figure 3-51 : Complex Yaw Gimbal Dynamic Model<br />

This open loop model is modelled at the seeker reference rate (SKfR) of<br />

4 kHz. The yaw gimbal demand is subject to a time delay before the gimbal<br />

error is passed through a controller and DAC gain providing the motor<br />

current (SKIG) which is limited to protect the electronics and motor coils,<br />

ϕ<br />

LIM<br />

⎛<br />

⎜<br />

K<br />

⎝<br />

AΨ<br />

⋅ ϕ<br />

DLL<br />

I<br />

SK GΨ<br />

: =<br />

1<br />

Mux<br />

yout<br />

( ) ⎟ ⎞<br />

D<br />

D 2 ⋅ π 2 ⋅ ⎞<br />

Ψ − Ψ , , ⎟ − I , I<br />

⎛ π<br />

⎜ ϕTD<br />

2000 Gk<br />

2000 Gk<br />

− 1<br />

⎝<br />

SK KCZ<br />

SK K<br />

CP<br />

⎟<br />

⎠<br />

MΨ<br />

MΨ<br />

Equation 3.9-10<br />

The torque generated by the gimbal motor depends on the input current,<br />

( I + τ , ζ , ω )<br />

SK τMΨ : = SKK<br />

MΨ<br />

⋅ ϕ<br />

D2L<br />

SK GΨ<br />

SK FΨ<br />

SK GΨ<br />

SK GΨ<br />

Equation 3.9-11<br />

The gimbal angles and angular rate obtained by separating the integrators to<br />

accommodate the torque and friction models,<br />

ϕ<br />

DI<br />

⎛<br />

⎜<br />

⎜<br />

⎝<br />

ϕ<br />

DI<br />

A<br />

5000<br />

( I , )<br />

⎛ SKτMΨ<br />

+ SKτEΨ<br />

GΨ<br />

Ψ<br />

⎜<br />

⎝<br />

SK JGΨ<br />

Ψ<br />

Gk<br />

− 1<br />

: =<br />

⎞<br />

⎟ +<br />

⎟<br />

⎠<br />

τ<br />

SK FΨ<br />

⎞<br />

( τ , τ , Ψ&<br />

) ⎟<br />

⎟<br />

SK MΨ<br />

SK EΨ<br />

Gk<br />

− 1<br />

Equation 3.9-12<br />

The gimbal characteristics listed in Table 3-18 were selected so that the<br />

closed loop response of both gimbals was a 3 dB overshoot, and stability<br />

margins of 18 dB and 45° as shown in Figure 3-52 and Figure 3-53. The<br />

step response without motor current limiting is shown in Figure 3-54.<br />

Introducing motor current limiting trades response time for a reduction in<br />

⎠<br />

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

Saved successfully!

Ooh no, something went wrong!