Академический Документы
Профессиональный Документы
Культура Документы
_ .. 12/19/90
c o,,v
F-¢,,o -/
q ATTITUDE CONTROL OF A SPINNING ROCKET SAND--90-3230C
VIA THRUST VECTORING
DE91 006267
John E. White
I. Introduction .
=
control of a spinning rocket that i_ equipped with thrust
MASIER
2
i
3
that are the basis for the control system design. Section
Section VI.
A. Nonlinear Dynamics
the body frame [2], however, since the control torques are
applied in this frame. The vehicle is assumed to be
_= the moments about point A, and the right side is the time
-
torques assumed to be acting on the system are due to the
5°
rocket thrust vector control moments, which are expressed as
1
i
' 5
l
|
i
! " ( _y ) 3 + ( _z ) _ (2)
i
+ [(-mxy)PB+ (I+mz2)qB ]
i
,lm
I
The derivative of _A is written as
d hA A+ _ X hA ) (8)
where the two teI-me o'l the right hand side are given by
Substitution of (9) and (10) into (4), and then (4) and (8)
i (l
+ #myz mxy (I-I x} qBrB
-ro(l-#) z
(Ix-I) -mxz -#myz rBP B
+su(1-_ )yi
I
where Cp - Ixx + m(1-#)(y2+z2)
+
I0011 T1 s
0
, Cq -
0
T1 s
I
sin(Sy)
sin(6z)
+ m(1-#)z 2 ,
(11)
2 12 2 2
Cr - I . m(1-#ly 2, and Is + (#y) + (#z) . Nonlinear
to produce
m.
MA - [_I_Iki
-_ ] IA_I_ + ( _I X [_I _ IkI
]* IA_I ) (13)
B. Linear Dynamics
- 0 (14)
The right hand sides of (15) and (16) represent the gyro-
%
III. State Space Formulation And LQR Synthesis
Es - 0C - e (19)
E_ = ¢c - _ (20)
where the variables with C subscripts are assumed here to be
E0 " - q (21)
_ = - r (22)
The state space used with the LQR synthesis procedure is
i structure, and
be symmetrical. theThis
samecontroller
gains if the vehicle
isdesigned is assumed
to track a to
step
I
i
10
- Ny6y (23)
Eo " - q (24)
= My&y (25)
_
11
%e o z o o Ee 0
oo J
EO_ o o -z o _e o
= o o o My ,_ + o _y
_y 0 0 0 -H 6y H (26)
used, but the resulting gains on the actuator rate state are
states an_ controls are zero in steady s%ate for step input
' commands. This state space is, therefore, suitable for LQR
xT" [ E0' E0' _' E_, E%, f, 6y, 6z] T and vT - [ _y , _z ] '
where the A and B matrices are defined, respectively, as
0 1 0 0 0 0 0 0
0 0 -i 0 0 0 0 0
0 0 0 0 0 Mr 0 0
A m (27a)
0 0 0 0 1 0 0 0
0 0 0 0 0 -i 0 0
0 _ 0 Nq 0 0 0 0 0
0 0 0 0 0 0 H 0
0 0 0 0 0 0 0 H
m 0 0 0 0 00 0 H0 H0 (27b)
BT I
L
0 0 0 0 0 1 T
...
dependent terms, and has zero steady state values for all
_, " A X + B V (29)
_m
|- v - - ( R-IBTp )x - -G x (30)
0|
where P is the algebraic matrix Riccati equation solution
i
_ J
assoclated discrete gains for a particular sample rate.
- The LQR state weighting matrix for both the SZSO and
qm
i
14
for the MIMO case primarily with the choice of the weighting
shown in Table 2.
, -i
; T(S) = Z + (X(S) G(S) ) (32)
M
I
t
lC
| a
m (T(s) ) > _ (L(s) :) for all s - J_ (33)
-
both controllers, as is discussed in the next section.
--.
,in
1
• ,
17
V. System Performance
and 12-13 show the behavior for roll rates of 0.25, 0.5,
1.0, and 2.0 Hz, respectively. These plots are polar plots
J
at lower frequencies. Off-nominal responses due to para-
i
G
18
i
'
i signlficantlyduring the burn of a large rocket. The actual
|
(31) for the MIMO controller is given in Fig. 14. This plot
dB. The gain and phase margins can be determined from [I01
,|
q as a gain margin of ( -TBD, +TBD ) dB and a phase margin of
±TBD degrees for the MIMO controller, and ( -TBD, +TBD) and
l
19
VI. Conclusions
I
a trial and error approach to achieve the primary goal of
q
the compensator, which is to provide adequate tracking of
W
m
J
L
20
i been
SISO confirmed
design via a singular
relative value
to the MIMO stability
design, a factanalysls.
which has
ii
ii
.I
I
m
m
i
!
I
J
i
!
i
I
r, + I
r 21 +
REFERENCES
[4] Speyer, J.L., White, J.E., Douglas, R., and Hull, D.G.,
"Multi-Input/Multi-Output Controller Design for Longitudinal
Decoupled Aircraft Motion," Journal of Guidance, Control,
and Dynamics, Vol. 7, No. 6, Nov.-Dec. 1984, pp. 695-702.
[8] Safonov, M.G., and Athans, M., "Gain and Phase Margin
for Multiloop LQG Regulators, " IEEE Transactions on
Automatic Control, Vol. AC-22, April 1977, pp. 173-179.
i
m pp. 156-171.
m
mt- zooo Ibm, m- 10 ibm
Ix" _400 ib m ft2, I - 5500 Ib m ft2
SISO Controller
-z.zs99_+jo.s0 5
-62.7354
Closed-Loop Eigenvalues: -2.4079
a MIMO Controller
i Gains:
• 0.0295 0.0554 -0.0378 0.0113 0.0212 0.0006 0.0739 0.0000
|
l
J
lr, •
• i /
,
w , u
_,me'
..
_.J
Zrr o
_-_W 0
j ....
p-Q
mn,,
_--
UZ
OG
0_f(_.) o
Z>
ZO
Z ,,
( _
°
o
,
o O
Z o
o .......... ,.5 _.
I--
_E ''
....J tn
Zn/ o
_..4LI..I O I_
u")d j i ,,,
' ---_ up
t-E)
I..LIrv'
_I---
UZ
(DO
o
OU .... '........ --ai
z> \
ZO
0.. ,-,
_I.'IU
Ibcl I
ii ii li ul
I
i.
o
0
0
i *o _'
_
- !
I
i
0
........ _
c_
N
z __. °
_ o
_..I ff.I _
_n,, b '
_--4I.LI oLD ..
O_._l OW 0
.s _...... n -
WC_ CO UJ
__ . n
LJZ d_
Z
ZO
=i O_",
,, .
i, i ,, , ,, _
q
n , ,.... ,,
CD
6
0
-(',d
c_
_.(.D
0
z o ,4
o ,., _ .d _
I---I _f uJ
_.-,I
A _:
i _ _ °°-.
oo
°
. uZ _ / ' ' -o60
a oo _-
i " 0
EEL) _ LI.
l_ ,--,I--
Z
tl zo
i O_ _-,4
-.--Na 0
_ " "0 ,
q
ii
alli
i
" I,,
DISCLAIMER
This report was prepared as an account of work sponsoredby an agency of the United States
i employees,
Government. makes any warranty,
Neither the United express
States or implied, ornor
Government assumes any legal
any agency liability
thereof, or responsi-
nor any of their
• bility for the accuracy, completeness, or usefulness of any information, apparatus, product, or
II process disclos=_,d,or represents that its use would not infringe privately owned rights. Refer-
j ence herein to any specific commercial product, process,or service by trade name, trademark,
=
_!1 manufacturer, or otherwise does not necessarily constitute or imply its endorsement, recom-
i mendation, or favoring by the United States Government or any agency thereof. The views
i 1 and opinions of authors expressed herein do not necessarily state or reflect those of the
I United States Government or any agency thereof.
i
l
=
,m