Professional Documents
Culture Documents
Solution Manual
Krishna Dev Kumar
ii
c
Copyright
2012 by Krishna Dev Kumar. All rights are reserved whether
the whole or part of the material is concerned, especially the right of transla-
tion, reprinting, reuse of illustrations, recitation, broadcasting, reproduction
on microfilm or any other ways, and storage in data banks.
Solution Manual
Preface v
4 Dynamics I 39
5 Dynamics II 45
7 Control System 85
Index 121
vii
viii CONTENTS
Chapter 2
Kinematics, Momentum
and Energy
Problem Set 2
2.2 The inertial frames are those coordinate frames that are nonrotating
and nonaccelerating frames. The inertial frames are relevant because
in applying the Newton’s second law of motion
~
dV
F~ = m (2.1)
dt
where r is the position of the point of the Earth center of mass and ω
is the rate of spin of the Earth. With the earth a point on its surface
also orbits the Sun. With the solar system, it orbits the center of the
galaxy. Thus, the Earth-fixed frame is an accelerating frame and not
an inertial frame.
We consider just the effect of the spinning motion of the Earth and
therefore the inertial acceleration can be written as
~
dV ~
dV
=
+ω ~body
~ ×V (2.2)
dt dt
inertial body
Orbit m2
β
L
S
R
Y
m1
θ
E
X
~ and L
Expressing R ~ in terms of unit vectors of the respective coordinate
frames as
~ = Rîo ,
R ~ = Lî
L (2.9)
and using this relation in Eqs. (2.7) and (2.8), we have the inertial
positions of the spacecraft m1 and m2 as
~˙ 1 = R
V~1 = R ~˙ − γ L
~˙ (2.13)
~˙ 2 = R
V~2 = R ~˙ + (1 − γ)L
~˙ (2.14)
~˙ 2 + γ 2 L
V1 = [R ~˙ 2 − 2γ R~˙ · L]
~˙ 1/2 (2.15)
~˙ 2 + (1 − γ)2 L
V2 = [R ~˙ 2 + 2(1 − γ)R~˙ · L]
~˙ 1/2 (2.16)
4 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
~˙ and L
R ~˙ can be written as
~˙ = R
~˙
R +ω ~
~o × R (2.17)
xo y o zo
~˙ = L
~˙
L +ω ~
~ ×L (2.18)
xyz
Knowing the system is orbiting in a circular orbit (i.e., Ṙ = 0), and the
cable connecting the two spacecraft is moving with a constant speed of
v, we get
~˙ ~˙
R = 0, L = ~v (2.19)
xo y o zo xyz
~˙ = ω
R ~o × R~ (2.20)
~˙ = ~v + ω
L ~ ×L~ (2.21)
~˙ 2 and L
The terms R ~˙ 2 can be written as
~˙ 2 = (~
R ωo × R)~ 2 (2.22)
~˙ 2 = v 2 + (~
L ~ 2 + 2~v · (~
ω × L) ~
ω × L) (2.23)
Writing ω ~ ω
~ o , R, ~ and ~v in terms of the unit vectors of the respective
~ , L,
coordinate frames, we have
ωo = θ̇k̂o , ~ = Rîo ,
R ω
~ = (θ̇ + β̇)k̂, ~ = Lî,
L ~v = v î (2.24)
~˙ 2 = θ̇2 R2
R (2.25)
~˙ 2 = v 2 + (θ̇ + β̇)2 L2
L (2.26)
Note that as ~v ⊥ (~ ~ ~v · (~
ω × L), ~ = 0.
ω × L)
Next we derive R ~˙ · L.
~˙ Using Eqs. (2.20)-(2.21), we can write
~˙ · L
R ~˙ = (~ ~ · (~v + ω
ωo × R) ~
~ × L)
= (~ ~ · ~v + (~
ωo × R) ~ · (~
ωo × R) ~
ω × L)
= θ̇Rv(ĵo · î) + θ̇(θ̇ + β̇)RL(ĵo · ĵ) (2.27)
5
~˙ · L
Thus, we can express R ~˙ as
~˙ · L
R ~˙ = θ̇Rvsinβ + θ̇(θ̇ + β̇)RLcosβ (2.30)
The inertial acceleration vectors for the spacecraft m1 and m2 are writ-
ten using Eqs. (2.13)-(2.14) for their velocity vectors, as
~˙ 1 = R
~a1 = V ~¨ − γ L
~¨ (2.33)
~˙ 2 = R
~a2 = V ~¨ + (1 − γ)L
~¨ (2.34)
~¨ and L
Here R ~¨ can be expressed as
~¨ = R
R ~¨ xo yo zo + 2(~
ωo × R ~˙ xo yo zo ) + ω
~ o × (~
ωo × R) ~˙ o × R
~ +ω ~ (2.35)
~¨ = L
L ~¨ xyz + 2(~ ω×L ~˙ xyz ) + ω ~ × (~ ~ +ω
ω × L) ~˙ × L
~ (2.36)
ω
~ o × (~ ~ = (~
ωo × R) ~ ωo − ωo2 R
ωo · R)~ ~ = −ωo2 R~ (2.37)
ω
~ o × (~ ~ = (~
ωo × L) ~ ωo − ω 2 L
ωo · L)~ ~ = −ω 2 L
~ (2.38)
o
and writing all vectors in Eqs. (2.35)-(2.36) in terms of the unit vectors
along the respective coordinate frames, we obtain
~¨ = −θ̇2 Rîo
R (2.40)
~¨ = 2(θ̇ + β̇)v(k̂ × î) − (θ̇ + β̇)2 Lî + β̈L(k̂ × ~i)
L
= 2(θ̇ + β̇)v ĵ − (θ̇ + β̇)2 Lî + β̈Lĵ
= −(θ̇ + β̇)2 Lî + [2(θ̇ + β̇)v + β̈L]ĵ (2.41)
~a1 = −θ̇2 Rîo + γ(θ̇ + β̇)2 Lî − γ[2(θ̇ + β̇)v + β̈L]ĵ} (2.42)
2 2
~a2 = −θ̇ Rîo − (1 − γ)(θ̇ + β̇) Lî − (1 − γ)[2(θ̇ + β̇)v − β̈L]ĵ} (2.43)
~ and L
Writing R ~ in terms of the unit vectors of the respective coordinate
frames, we have
~ = Rîo ;
R ~ = Lî
L (2.52)
Applying the above relation and using Eqs. (2.52), we obtain the mag-
nitudes of the position vectors as
~˙ 1 = R
~1 = R
V ~˙ − γ L
~˙ (2.58)
~˙ 2 = R
~2 = R
V ~˙ + (1 − γ)L
~˙ (2.59)
~˙ 2 + γ 2 L
V1 = [R ~˙ 2 − 2γ R~˙ · L]
~˙ 1/2 (2.60)
~˙ 2 + (1 − γ)2 L
V2 = [R ~˙ 2 + 2(1 − γ)R~˙ · L]
~˙ 1/2 (2.61)
~˙ and L
The R ~˙ can be written as
~˙ = R ~˙
R +ω ~
~o × R (2.62)
xo y o zo
~˙ = L ~˙
L +ω ~
~ ×L (2.63)
xyz
~˙ ~˙
R = 0, L =0 (2.64)
xo y o zo xyz
~˙ = ω
R ~o × R~ (2.65)
~˙ = ω
L ~ ×L~ (2.66)
~˙ 2 and L
The terms R ~˙ 2 can be written as
~˙ 2 = (~
R ~ 2
ωo × R) (2.67)
~˙ 2 = (~
L ~ 2
ω × L) (2.68)
Writing ω ~ ω
~ o , R, ~ and ~v in terms of the unit vectors of the respective
~ , L,
coordinate frames, we have
ωo = θ̇k̂o , ~
R = Rîo , ω
~ = (θ̇ + β̇)k̂o + η̇ ĵ, ~ = Lî
L (2.69)
ω
~ = ωx î + ωy ĵ + ωz k̂ (2.71)
where
Inserting the expressions given by Eqs. (2.69) and (2.71) into Eqs.
(2.67)-(2.68) and solving, we have
~˙ 2 = θ̇2 R2
R (2.73)
~˙ 2 = [(θ̇ + β̇)2 + η̇ 2 ]L2
L (2.74)
~˙ · L.
Next we derive R ~˙ Using Eqs. (2.65)-(2.66), we can write
~˙ · L
R ~˙ = (~ ~ · (~
ωo × R) ~
ω × L)
= θ̇RL{ĵo · [−η̇ k̂ + (θ̇ + β̇)cosη ĵ]}
= θ̇RL[−η̇(ĵo · k̂) + (θ̇ + β̇)cosη(ĵo · ĵ)] (2.75)
~˙ · L
Thus, we can express R ~˙ as
~˙ · L
R ~˙ = θ̇RL[−η̇sinβsinη + (θ̇ + β̇)cosβcosη] (2.77)
~˙ 2 , L
Substituting the expressions for R ~˙ 2 from Eqs. (2.73)-(2.74) and the
˙~ ~˙
expression for R · L from Eq. (2.77) into Eqs. (2.60)-(2.61), we finally
obtain the magnitudes of the inertial velocity vectors for spacecraft m1
and m2 as
The inertial acceleration vectors for the spacecraft m1 and m2 are writ-
ten using Eqs. (2.58)-(2.59) for their velocity vectors, as
~˙ 1 = R
~a1 = V ~¨ − γ L
~¨ (2.80)
~˙ 2 = R
~a2 = V ~¨ + (1 − γ)L
~¨ (2.81)
~¨ and L
Here R ~¨ can be expressed as
~¨ = R
R ~¨ xo yo zo + 2(~
ωo × R ~˙ xo yo zo ) + ω
~ o × (~ ~ +ω
ω × R) ~˙ o × R
~ (2.82)
~¨ = L
L ~¨ xyz + 2(~ ω×L ~˙ xyz ) + ω ~ × (~ ~ +ω
ω × L) ~˙ × L
~ (2.83)
Knowing that the system is in a circular orbit and the cable connecting
the two spacecraft are moving with constant velocity, i.e.,
~˙ xo yo zo = R
R ~¨ xo yo zo = 0, ~˙ o = 0,
ω ~˙ xyz = L
L ~¨ xyz = 0 (2.84)
and writing all vectors in terms of the unit vectors along the respective
coordinate frames, we obtain
~¨ = −θ̇2 Rîo
R (2.85)
(2.86)
ω
~ × (~ ~ = (~
ω × L) ~ ω − ω2L
ω · L)~ ~ = ωx L~ ~
ω − ω2L (2.87)
~˙ × L
ω ~ = [−ω̇y k̂ + ω̇z ĵ]L (2.88)
where
where
aLx = [ωx2 − ω 2 ]L, aLy = [ωx ωy + ω̇z ]L, aLz = [ωx ωz − ω̇y ]L
(2.91)
R1 = R (2.101)
R2 = [R + 2
L21
+ 2R~ ·L
~ 1 ]1/2 (2.102)
~ ·L
R3 = [R22 + 2R ~ 2 + 2L
~ 1 · L~2 ]1/2 (2.103)
~ L
Expressing R, ~ 1 , and L
~ 2 in terms of unit vectors of their respective
coordinate frames as
~ = Rîo ,
R ~ 1 = L1 î1 ,
L ~ 2 = L2 î2
L (2.104)
12 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
îo · î1 = cosβ1 , îo · î2 = cosβ2 , î1 · î2 = cos(β2 − β1 ) (2.105)
R1 = R (2.106)
2
R2 = [R + L21 + 2RL1 cosβ1 ] 1/2
(2.107)
R3 = [R22 + L22 + 2RL2 cosβ2 + 2L1 L2 cos(β2 − β1 )]1/2 (2.108)
~˙ 1 = R
~1 = R
V ~˙ (2.109)
~˙ 2 = R
~2 = R
V ~˙ + L
~˙ 1 (2.110)
V ~˙ 3 = V
~3 = R ~2 + L~˙ 2 (2.111)
~˙ 2 ]1/2
V1 =[R (2.112)
~˙ 2 + L
V2 =[R ~˙ 21 + 2R ~˙ · L
~˙ 1 ]1/2 (2.113)
V3 =[V22 + 2R ~˙ · L
~˙ 2 + 2L ~˙ 1 · L
~˙ 2 ]1/2 (2.114)
~˙ L
The R, ~˙ 1 , and L
~˙ 2 can be written as
~˙ = R~˙
R +ω ~
~o × R (2.115)
xo y o zo
~˙ 1
~˙ 1 = L
L +ω ~1
~1 × L (2.116)
x1 y 1 z1
~˙ 2
~˙ 2 = L
L +ω ~2
~2 × L (2.117)
x2 y 2 z2
Knowing that the system is in a circular orbit, and the cable connecting
the two spacecraft is moving with a constant speed of v, we get
~˙ ~˙ 1 ~˙ 2
R = 0, L = 0, L =0 (2.118)
xo y o zo x1 y 1 z1 x2 y 2 z2
~˙ = ω
R ~
~ o × R, ~˙ 1 = ω
L ~ 1,
~1 × L ~˙ 2 = ω
L ~2
~2 × L (2.119)
13
~˙ 2 , L
The terms R ~˙ 21 , and L
~˙ 22 can be written as
~˙ 2 = (~
R ~ 2,
ωo × R) ~˙ 21 = (~
L ~ 1 )2 ,
ω1 × L ~˙ 22 = (~
L ~ 2 )2
ω2 × L (2.120)
Writing ω ~ ω
~ o , R, ~ 1 , and ω
~ 1, L ~ 2 in terms of the unit vectors of
~ 2 , and L
the respective coordinate frames, we have
~ = Rîo , ω
ωo = θ̇ k̂o , R ~ 1 = L1 î1 ω
~ 1 = (θ̇ + β̇1 )k̂1 , L ~ 2 = (θ̇ + β̇2 )k̂2 ,
~
L2 = L2 î2 (2.121)
ωo = ωo k̂o , ω
~ 1 = ω1 k̂1 , ω
~ 2 = ω2 k̂2 (2.122)
where
~˙ 2 = ω 2 R2 ,
R ~˙ 2 = ω 2 L2 ,
L ~˙ 2 = ω 2 L2
L (2.124)
o 1 1 1 2 2 2
~˙ · L
Next we derive R ~˙ 1 , R
~˙ · L
~˙ 2 and L
~˙ 1 · L
~˙ 2 . Using Eqs. (2.119), we can
write
~˙ · L
R ~˙ 1 = (~ ~ · (~
ωo × R) ~ 1 ) = ωo ω1 RL1 (ĵo · ĵ1 )
ω1 × L (2.125)
~˙ · L
R ~˙ 2 = (~ ~ · (~
ωo × R) ~ 2 ) = ωo ω2 RL2 (ĵo · ĵ2 )
ω2 × L (2.126)
~˙ 1 · L
L ~˙ 2 = (~ ~ 1 ) · (~
ω1 × L ~ 2 ) = ω1 ω2 L1 L2 (ĵ1 · ĵ2 )
ω2 × L (2.127)
ĵo · ĵ1 = cosβ1 , ĵo · ĵ2 = cosβ2 , ĵ1 · ĵ2 = cos(β2 − β1 ) (2.128)
~˙ · L
Thus, we can express R ~˙ 1 , R
~˙ · L
~˙ 2 , and L
~˙ 1 · L
~˙ 2 as
R~˙ · L
~˙ 1 = ωo ω1 RL1 cosβ1 (2.129)
R~˙ · L
~˙ 2 = ωo ω2 RL2 cosβ2 (2.130)
~˙ 1 · L
L ~˙ 2 = ω1 ω2 L1 L2 cos(β2 − β1 ) (2.131)
14 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
~¨ L
Here R, ~¨ 1 , and L
~¨ 2 can be expressed as
~¨ = R
R ~¨ xo yo zo + 2(~ ~˙ xo yo zo ) + ω
ωo × R ~ o × (~
ω × R)~ +ω ~˙ o × R
~ (2.138)
~¨ 1 = L ~¨ 1 ~˙ 1
L +2 ω ~1 × L +ω~ 1 × (~
ω1 × L ~˙ 1 × L
~ 1) + ω ~1
x1 y 1 z1 x1 y 1 z1
(2.139)
~¨ 2
~¨ 2 = L ~˙ 2
L ~2 × L
+2 ω +ω
~ 2 × (~
ω2 × L ~˙ 2 × L
~ 2) + ω ~2
x2 y 2 z2 x2 y 2 z2
(2.140)
Knowing that the system is in a circular orbit and the cable connecting
the two spacecraft is constant, i.e.,
~˙ xo yo zo = R
~¨ xo yo zo = 0, ω ~¨ 1 ~¨ 2
R ~˙ o = 0, L = 0, L =0
x1 y 1 z1 x2 y 2 z2
(2.141)
and writing all vectors in terms of the unit vectors along the respective
coordinate frames, we obtain
~¨ = −ω 2 Rîo
R (2.142)
o
¨
~ 1 = −ω12 L1 î1 + β̈1 L1 ĵ1
L (2.143)
Similarly,
îo · î1 = cosβ1 , îo · ĵ1 = cos(90 + β1 ) = −sinβ1 , îo · î2 = cosβ2 ,
îo · ĵ2 = cos(90 + β2 ) = −sinβ2 , î1 · î2 = cos(β2 − β1 ),
î1 · ĵ2 = cos(90 + β2 − β1 ) = −sin(β2 − β1 ),
ĵ1 · î2 = cos(90 − (β2 − β1 )) = sin(β2 − β1 ), ĵ1 · ĵ2 = cos(β2 − β1 )
(2.150)
Using the preceding relations into Eqs. (2.148), we obtain the acceler-
ations as
n o1/2
a2 = (ωo2 R)2 + ω14 L21 + β̈12 L21 + 2ωo2 ω12 RL1 cosβ1 + 2ωo2 β̈1 L1 Rsinβ1
(2.151)
n
a3 = a22 + ω24 L22 + β̈22 L22 + 2ωo2 ω22 RL2 cosβ2 − 2ωo2 β̈2 RL2 sinβ2
+ 2ω12 ω22 L1 L2 cos(β2 − β1 ) + 2ω12 β̈2 L1 L2 sin(β2 − β1 )
+ 2ω22 β̈1 L1 L2 sin(β2 − β1 ) + 2β̈1 β̈2 L1 L2 cos(β2 − β1 )}1/2
(2.152)
2.6 Let ~r1 , ~r2 , and ~r3 denote the position vectors of m1 , m2 , and m3 ,
respectively. We can write the center of mass relation as
Knowing
~ 1,
~r2 = ~r1 + L ~2
~r3 = ~r2 + L (2.154)
we have
where
m2 + m3
γ1 =
M
m3
γ2 =
M
M = m1 + m2 + m3
~¨ 1 = R
R ~¨ + ~r¨1 (2.159)
we obtain
~¨ + γ2 ~x¨
~r¨1 = γ1 L
= γ1 [−ω 2 Lî + β̈Lĵ] + γ2 [ẍî + 2ω ẋĵ − ω 2 xî + β̈xĵ]
= [−γ1 ω 2 L + γ2 ẍ − γ2 ω 2 x]î + [γ1 β̈L + 2γ2 ω ẋ + γ2 β̈x]ĵ (2.163)
where ω ~˙ = β̈ as θ̈ = 0.
~ = (θ̇ + β̇)k̂ and ω
We can further express ~r¨1 as
where C = −Rθ̇2 .
Substituting Eqs. (2.164) and (2.165) into Eq. (2.159), we obtain the
inertial acceleration of m1 as
~¨ 1 = C îo + Aî + B ĵ
R (2.166)
Using coordinate transformation between S − îo ĵo k̂o and S − îĵ k̂:
γ1 = −1, γ2 = 1 (2.171)
From the preceding equation, the acceleration has maximum and min-
imum values at β = 0 and β = π, respectively. However, in the case
of librating system with β ≤ π/2, the minimum acceleration occurs at
β = π/2.
2.14 The linear momentum of the system is
~˙ = M ωo R
p~ = (m1 + m2 + mL )R ~ (2.175)
~ =(m1 + m2 + mL )(R
H ~˙ + m2 (~r2 × ~r˙2 )
~ × R)
+ mL (~rL × ~r˙L ) + I~
ω + IL ω
~L (2.176)
where
ωo = θ̇, ω = θ̇ + α̇, ωL = θ̇ + β̇
1
IL = mL L 2
12
2.15 The potential energy U of the system is sum of the potential energy due
to the spacecraft m1 , U1 and the potential energy due to the spacecraft
m2 , U2 , i.e.,
U = U1 + U2 (2.178)
19
~ as
Using Eqs. (2.182-2.183), we can write ~r1 and ~r2 in terms of L
m2 ~
~r1 = − L (2.184)
m1 + m2
m1 ~
~r2 = L (2.185)
m1 + m2
~ = Rîo ;
R ~ = Lî
L (2.186)
µM µ
U =− + Me [1 − 3(~io · ~i)2 ]L2 (2.187)
R 2R3
20 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
î î
o
ĵ = Rz y(β, η) ĵo (2.190)
k̂
k̂
o
or
cosβsinβcos2 η = 0 (2.196)
Knowing η = 0, we have
sin2β = 0 (2.197)
so,
2β = 0, π, 2π, 3π, · · ·
π 3π
⇒ β = 0, , π, ,··· (2.198)
2 2
µM µ
Uβ=0 = − + Me (1 − 3cos2 η)L2 (2.199)
R 2R3
The above result remains same for β = π, 2π, 3π, · · · .
In the case of β = π/2, the potential energy is
µM µ
Uβ=π/2 = − + Me L2 (2.200)
R 2R3
The preceding result remains same for β = (3/2)π, (5/2)π, · · · .
Comparing Eqs. (2.199) and (2.200), we find
2.16 Using Summary Sheet (System: Three Point Masses), we can write the
kinetic and potential energies of the system (N = 3) as
3 3
1X ~˙ 2 + 1 mi~r˙i2
X
T = mi R (2.202)
2 i=1 2 i=1
3 3
µX µ X
U =− mi + mi ri2
R i=1 2R3 i=1
3
3µ X ~ · ~ri )2
− mi (R (2.203)
2R5 i=1
22 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
The position vectors of the masses and the corresponding velocity vec-
tors are
~ 1 − γ2 L
~r1 = −γ1 L ~ 2 , ~r2 = (1 − γ1 )L
~ 1 − γ2 L
~2
~ 1 + (1 − γ2 )L
~r3 = (1 − γ1 )L ~2 (2.204)
~˙ 1 − γ2 L
~r˙1 = −γ1 L ~˙ 2 , ~r˙2 = (1 − γ1 )L
~˙ 1 − γ2 L
~˙ 2
~˙ 2
~˙ 2 + γ 2 L ~˙ ~˙
~r˙12 = γ12 L 1 2 2 + 2γ1 γ2 L1 · L2 (2.206)
~˙ 2
~˙ 2 + γ 2 L ~˙ ~˙
~r˙22 = (1 − γ1 )2 L 1 2 2 − 2(1 − γ1 )γ2 L1 · L2 (2.207)
~˙ 2 + (1 − γ2 )2 L~˙ 2 + 2(1 − γ1 )(1 − γ2 ) L~˙ 1 · L
~˙ 2 (2.208)
~r˙32 = (1 − γ1 )2 L 1 2
Knowing
~˙ 1 =~
L ~ 1 = ω1 k̂1 × L1 î1 = ω1 L1 ĵ1
ω1 × L (2.209)
~˙ 2 =~
L ~ 2 = ω2 k̂2 × L2 î2 = ω2 L2 ĵ2
ω2 × L (2.210)
we have
~r˙12 = γ12 ω12 L21 + γ22 ω22 L22 + 2γ1 γ2 ω1 ω2 L1 L2 cos(β1 − β2 ) (2.211)
~r˙22 = (1 − γ1 )2 ω12 L21 + γ22 ω22 L22 − 2(1 − γ1 )γ2 ω1 ω2 L1 L2 cos(β1 − β2 )
(2.212)
˙~r2 = (1 − γ1 )2 ω 2 L2 + (1 − γ2 )2 ω 2 L2 + 2(1 − γ1 )(1 − γ2 )
3 1 1 2 2
× ω1 ω2 L1 L2 cos(β1 − β2 ) (2.213)
1 ~˙ 2 1
T = MR + [m1 γ12 + m2 (1 − γ1 )2 + m3 (1 − γ1 )2 ]ω12 L21
2 2
1
+ [m1 γ2 + m2 γ22 + m3 (1 − γ2 )2 ]ω22 L22
2
2
+ [m1 γ1 γ2 − m2 (1 − γ1 )γ2 + m3 (1 − γ1 )(1 − γ2 )]ω1 ω2 L1 L2 cos(β1 − β2 )
(2.217)
(
µM µ
U =− + [m1 γ12 + m2 (1 − γ1 )2 + m3 (1 − γ1 )2 ]L21
R 2R3
+ [m1 γ22 + m2 γ22 + m3 (1 − γ2 )2 ]L22
)
+ 2[m1 γ1 γ2 − m2 (1 − γ1 )γ2 + m3 (1 − γ1 )(1 − γ2 )]L1 L2 cos(β1 − β2 )
(
3µ
− [m1 γ12 + m2 (1 − γ1 )2 + m3 (1 − γ1 )2 ]L21 cos2 β1
2R3
+ [m1 γ22 + m2 γ22 + m3 (1 − γ2 )2 ]L22 cos2 β2
)
+ 2[m1 γ1 γ2 − m2 (1 − γ1 )γ22 + m3 (1 − γ1 )(1 − γ2 )]L1 L2 cosβ1 cosβ2
(2.218)
Taking
1 ~˙ 2 1 1
T = MR + Mt1 ω12 L21 + Mt2 ω22 L22 + Mt3 ω1 ω2 L1 L2 cos(β1 − β2 )
2 2 2
(2.222)
( )
µM µ
U =− + Mt1 L21 + Mt2 L22 + 2Mt3 L1 L2 cos(β1 − β2 )
R 2R3
( )
3µ 2 2 2 2
− Mt1 L1 cos β1 + Mt2 L2 cos β2 + 2Mt3 L1 L2 cosβ1 cosβ2
2R3
(2.223)
24 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
1 ~˙ 2 + 1 m2~r˙ 2 + 1 m3~r˙ 2 + 1 Iz ω 2
T~ = (m1 + m2 + m3 )R 2 3
2 2 2 2
˙ ˙ ~˙
where ~r˙2 = d~ and ~r˙3 = d~ + L + ~x˙ . The nomenclature d,
~ L,
~ and ~x are
expressed with respect to coordinate frames as
(Note ~jc is unit vector along cable) and their derivatives with respect
to time are obtained as
˙
d~ =ȧî + ω
~ × dˆ = (ȧ − ωb)î + ωaĵ (2.225)
~˙ =~
L ω×L ~ = ω k̂ × Lĵ = −ωLî (2.226)
~x˙ =ωc x[cosβ î + sinβ ĵ] (2.227)
1 1 1 n o
T = M ωo2 R2 + Iz ω 2 + (m2 + m3 ) (ȧ − ωb)2 + ω 2 a2
2 2 2
1 n 2 2 2 2
+ m3 ω L + x ωc − 2ωL(ȧ − ωb)
2 o
+ 2ωc x[(ȧ − ωb)cosβ + ωasinβ] − 2ωωc Lxcosβ (2.228)
Knowing
~r1 =0 (2.229)
~r2 =d~ = aî + bĵ (2.230)
~r3 =d~ + L
~ + ~x = (a + xsinβ)î + (b + L − xcosβ)ĵ (2.231)
25
2.18 For a 1-3-2 Euler angle rotation sequence, we obtain the rotation ma-
trix, R132 (α, φ, γ) as
î
ˆ
io
ĵ = R132 (α, φ, γ) ˆ
jo (2.234)
ˆ
k̂
k
o
We can obtain the rotation matrix R231 by taking the inverse of the
−1
transformation R132 . However, from the properties of a rotation matrix
−1 T
explained earlier, R132 is the transpose of R132 (i.e., R132 ). Thus, we
find R231 as
cosφcosγ −sinφ cosφsinγ
R231 (−γ, −φ, −α) = cosαsinφcosγ + sinαsinγ cosαcosφ cosαsinφsinγ − sinαcosγ
sinαsinφcosγ − cosαsinγ sinαcosφ sinαsinφsinγ + cosαcosγ
(2.235)
26 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
and thus, the transformation from the frame S − ijk to the body fixed
frame S − io jo ko is
î î
o
ĵo = R231 ĵ (2.236)
k̂
k̂
o
~ = ωx î + ωy ĵ + ωz k̂ = α̇îo + φ̇k̂1 + γ̇ ĵ
ω (2.237)
ω cosφ cos γ
−sinγ 0 α̇
x
ωy = −sinφ 0 1 φ̇ (2.240)
ω
cosφ sin γ cosγ 0 γ̇
z
cosφcosγ sinφ −cosφsinγ
= −cosαsinφcosγ + sinαsinγ cosαcosφ cosαsinφsinγ + sinαcosγ
sinαsinφcosγ + cosαsinγ −sinαcosφ sinαsinφsinγ + cosαcosγ
T
R132 =R2 (γ)R3 (φ)R1 (α) = R231 (−γ, −φ, −α)
cosφcosγ cosαsinφcosγ + sinαsinγ sinαsinφcosγ − cosαsinγ
= −sinφ cosαcosφ sinαcosφ
cosφsinγ cosαsinφsinγ − sinαcosγ sinαsinφsinγ + cosαcosγ
1 φ −γ
R231 = −φ 1 α R132
γ −α 1
Thus, the order of rotation does not matter if α, φ and γ are very
small.
28 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
2.20 (a) Either 3 Euler angles plus the defined sequence or 4 Euler param-
eters (q1 ,q2 ,q3 ,q4 ).
(b) Yes. The Euler’s equations of motion of a torque-free body are
I1 × 0 = 0
I2 ω̇2 = 0
I3 ω̇3 = 0
1 0 0
R1 = 0 cosθ sinθ (2.241)
0 −sinθ cosθ
cosθ 0 −sinθ
R2 = 0 1 0 (2.242)
sinθ 0 cosθ
cosθ sinθ 0
R3 = −sinθ cosθ 0 (2.243)
0 0 1
29
ω
~ = pî + q ĵ + rk̂ (2.244)
ω
~ = ψ̇ k̂f + θ̇ĵ1 + φ̇î2 = ψ̇ k̂1 + θ̇ĵ2 + φ̇î (2.245)
î î 1 0 0 î
2
−1
ĵ2 = R1 ĵ = 0 cosφ −sinφ ĵ
k̂
k̂
0 sinθ cosθ k̂
2
ω
~ = (−ψ̇sinθ + φ̇)î + (ψ̇cosθsinφ + θ̇cosφ)ĵ + (ψ̇cosθcosφ)k̂
(2.246)
or
p = − ψ̇sinθ + φ̇
q = − ψ̇cosθsinφ + θ̇cosφ (2.247)
r =ψ̇cosθ cos φ − θ̇sinφ
(2.248)
or
p
1 0 −sinθ φ̇
q = 0 cosφ cosθsinφ θ̇ (2.249)
r
0 −sinφ cosθcosφ
ψ̇
30 CHAPTER 2. KINEMATICS, MOMENTUM AND ENERGY
1 0 −sinθ
0 cosφ cosθsinφ = cosθcos2 φ + cosθsin2 φ = cosθ
0 −sinφ cosθcosφ
(2.250)
The inverse of the above matrix does not exist if θ = ±90 deg
or we can say singularity occurs at θ = ±90 deg. Using Euler
angle sequences (1-3-2), (3-1-3), (3-1-2) the singularities occur at
θ = ±π/2, θ=0 or π, and θ = ±π/2, respectively. In fact, the
determinant of the matrix (Eq. 2.250) may always involve sine or
cosine terms of the the angle of the second rotation and therefore
as sine or cosine angle becomes zero when the angle is 0 or π (sine
angle) or ±π/2 (cosine angle), the inverse of the determinant will
have singularity. Therefore, no matter what sequence is taken for
the Euler angle rotations, the angle of the second rotation displays
a similar singularity at either zero or ±90 deg.
To avoid the singularity problem, direction cosines or Euler pa-
rameters or quaternions are used to define the orientation of the
spacecraft.
(d) Yes, it is possible to have the first and the last rotations about the
same body axes in the Euler angle rotations?
2.21 The kinetic and potential energies of a rigid satellite are given by
1 1
T = m(Ṙ2 + θ̇2 R2 ) + [Ix ωx2 + Iy ωy2 + Iz ωz2 ] (2.251)
2 2
(
µm µ
U =− − (Iyy + Izz − Ixx )[3(cosαsinφcosγ + sinαsinγ)2 − 1]
R 4R3
+ (Izz + Ixx − Iyy )[3(cosαcosφ)2 − 1]
)
2
+ (Ixx + Iyy − Izz )[3(cosαsinφsinγ − sinαcosγ) − 1]
(2.252)
31
2.23
1 ~˙ 1
T = MR + (ω 2 cos2 η + η̇ 2 )Me L2 (2.253)
2 2
µM µ
U =− + Me (1 − 3cos2 βcos2 η)L2 (2.254)
R 2R3
Problem Set 3
where m is the mass of the satellite, mp is the mass of the planet, and
G is the universal gravitational constant.
Planet
Inertial Fps
Reference
Frame rp rps Satellite
O Fp
Fe
R Satellite
−Fe
Re r
Earth
Earth Free−Body Diagrams
Knowing ~rps = ~rp −~r, the gravitational perturbation acceleration (F~d /m)
34 CHAPTER 3. FORCES AND TORQUES
can be written as
~rp − ~r ~rp
f~d =µp 3
− 3
|~rp − ~r| rp
!
~rp − ~r ~rp
=µp 2 2 3/2
− 3 (3.2)
[rp − 2(~rp · ~r) + r ] rp
Writing ~r and ~rp in terms of unit vectors ( ~r = rî and ~rp = rp îp ) leads
to
µp h i
f~d = 3 r 3(î · îp )îp − î (3.5)
rp
We express the perturbation force f~d along orbital reference frame îĵ k̂
as
µp r h i
fx = f~p · î = 3 3(î · îp )(îp · î) − 1 (3.6)
rp
3µp r
fy = f~p · ĵ = 3 (î · îp )(îp · ĵ) (3.7)
rp
3µp r
fz = f~p · k̂ = 3 (î · îp )(îp · k̂) (3.8)
rp
1 ~
2 Vrel
F~d = − CD ρAVrel (3.9)
2 Vrel
where CD is the drag coefficient, A is the area of the satellite surface
~rel , Vrel is the velocity of the satellite relative to the
perpendicular to V
atmosphere, and ρ is the density of the atmosphere.
35
Using Eqs. (3.10-3.13), the aerodynamic drag as per Eq. (3.9) can be
written along î, ĵ, and k̂ as follows:
1 esinθ
fx = − CD ρAv 2 (3.14)
2m (1 + e + 2ecosθ)1/2
2
1 1 + ecosθ
fy = − CD ρAv 2 (3.15)
2m (1 + e2 + 2ecosθ)1/2
fz = 0 (3.16)
3.4 The solar radiation force on a highly reflective surface (i.e., ρa ≈ 0 and
ρd ≈ 0) is
Here (ŝ·n̂) = cosζ. The expression for ŝ in terms of Iˆn -Jˆn -K̂n coordinate
frame (where Iˆn in the direction towards the ascending node; K̂n is
perpendicular to the orbit plane along ~h, and K̂n × Iˆn =Jˆn ) as
ŝ = −cos(ψ − Ω)Iˆn − sin(ψ − Ω)cos(i − )Jˆn + sin(ψ − Ω)sin(i − )K̂n
(3.18)
36 CHAPTER 3. FORCES AND TORQUES
where ψ is the Sun angle with respect to the Vernal equinox, and is
the angle between the equatorial and the ecliptic plane (=± 23 deg
27 min). The Iˆn , Jˆn , and K̂n vectors can be expressed in terms of the
satellite coordinates i, j and k as
Iˆ cos(ω + θ) −sin(ω + θ) 0 î
n
ˆ
Jn = sin(ω + θ) cos(ω + θ) 0
ĵ (3.19)
K̂
0 0 1 k̂
n
The unit vector n̂ is with respect to the satellite body fixed frame.
3.6 The Earth’s magnetic field with respect to the orbital reference frame
is
cosim
~ µ f
B= 3 −2sin(ω + θ)sinim (3.20)
R
cos(ω + θ)sini
m
For a satellite in equatorial orbit (i.e., îm ≈ 0), the Earth’s magnetic
field simplifies to
1
µ
~ f
B= 3 0 (3.21)
R
0
or
µf
B= (3.22)
R3
For a satellite in polar orbit (i.e., îm ≈ 0), the Earth’s magnetic field
reduces to
0
~ = µf
µf
B −2sin(ω + θ) = îo (3.23)
R3
R3
cos(ω + θ)
or
µf p
B= [4sin2 (ω + θ) + cos2 (ω + θ)] (3.24)
R3
Approximating the term inside the square root by taking the average,
Z 2π
1 5
4sin2 (ω + θ) + cos2 (ω + θ) d(ω + θ) =
(3.25)
2π 0 2
37
where îR and îV are unit vectors along the satellite position and velocity
vectors R~ and V ~ , respectively.
The the components of B ~ along the pitch z-axis can be expressed as
µf
Bz = − [îm · (îR × îV )] (3.31)
R3
Dynamics I
Problem Set 4
4.1 Given.
At time t=0,
a=46800 km
e=0.85
θ=52 deg
Find.
t − tp
Solution.
Consider Kepler’s time equation,
M = n(t − tp ) = E − esinE
"r #
−1 1−e θ
E = 2tan tan
1+e 2
"r #
1 − 0.85 52deg
= 2tan−1 tan = 0.2759rad
1 + 0.85 2
40 CHAPTER 4. DYNAMICS I
r r
µ 3.986 × 105
n= = = 6.2359 × 10−5 rad/s
a3 468003
Thus, the time that has elapsed since the satellite passed through pe-
riapsis can be obtained as
E − esinE
t − tp =
n
0.2759 − 0.85sin(0.2759)
0 − tp = = 711.5sec
6.2359 × 10−5 rad/s
4.2
"r #
1−e θ
E = 2tan−1 tan
1+e 2
"r #
−1 1 − 0.85 297deg
= 2tan tan = −19.8deg
1 + 0.85 2
5.938rad − 0.85sin(5.938rad)
t = t0 +
6.231 × 10−5 sec−1
or
5.938rad − 0.85sin(5.938rad)
t = −711.2sec + = 99122sec
6.231 × 10−5 sec−1
4.3
vr
φ = tan−1
vθ
−3.475
= tan1 = −30.3deg
5.940
41
µ v2 µ v 2 + vθ2
E=− + =− + r
r 2 r 2
= −7.969 km2 /s2
µ
a=− = 25009.411 km
2E
2πa3/2
T = = 39361 sec
µ
c) eccentricity
The momentum is
~h = ~r × ~v
= rvsin(90o − φ)k̂ = rvcosφk̂
= rvθ k̂ = 74819.646 km2 /s
h2
p= = 14044 km
µ
p
e= 1 − p/a = 0.6621
d) true anomaly
p
r=
1 + ecosθ
1 p
cosθ = − 1 = 0.1736
e r
42 CHAPTER 4. DYNAMICS I
θ = ±cos−1 (0.1736)
θ = −80 deg
4.4
v02 µ −µ
E= − =
2 r0 2a
h = r0 v0 cosβ0
h2 (r0 v0 cosβ0 )2
p= =
µ µ
h2 (r0 v0 cosβ0 )2
a(1 − e2 ) = =
µ µ
s
(r0 v0 cosβ0 )2 (v02 − 2µ/r0 )
e= 1+
µ2
~r = rcosθîe + rsinθîp
Differentiating with respect to time and considering dîe /dt = dîp /dt =
0), we have
p
r=
1 + ecosθ
~h = ~r × ~v = r2 θ̇
43
dr d p peθ̇sinθ
ṙ = = =
dt dt 1 + ecosθ (1 + ecosθ)2
r2 eθ̇sinθ h µ
= = esinθ = esinθ
p p h
µ µ
~v = − sinθîe + (e + cosθ)îp
h h
4.6 Part I.
The J2 -perturbation affects (on average) the Longitude of the ascending
node, Ω, the Argument of the periapsis, ω, and the Mean anomaly. The
effects on orbital elements are as follows:
Constant (on average): a, e, i
Changing (on average): ω, Ω, M
Part II.
Given.
a=7000 km
e=0.08
i=28.5 deg
Find.
dΩ
dt avg
Solution.
The average rate of change of the longitude of the ascending node is
−3J2 Re2 n
dΩ
= cosi
dt avg 2p2
p
Using the relations n = µ/a3 and p = a(1 − e2 ), and substituting
J2 =1.0826× 10−3 , Re =6378 km, and µ = 3.986 × 105 km3 /s2 , we have
−3J2 Re2 µ1/2 cosi
dΩ
=
dt avg 2a7/2 (1 − e2 )2
−3(1.0826 × 10−3 )(6378 km)2 (3.986 × 105 km3 /s2 )1/2 cos(28.5o)
=
2(7000 km)7/2 [1 − (0.08)2 ]2
= −1.294 × 10−6 rad/sec = −6.4o /day
44 CHAPTER 4. DYNAMICS I
Chapter 5
Dynamics II
Problem Set 5
~˙
T~ = H (5.1)
Note, the above expression can be easily derived using the rigid body
analogy where the attitude angular momentum of the rigid satellite
about the principal moments of inertia axes is given by
~ = Ix ωx î + Iy ωy ĵ + Iz ωz k̂
H (5.3)
For the dumbbell system, Ix =0 and Iy =Iz =Me L2 with Me =(m1 m2 )/(m1 +
m2 ). The angular velocity vector is
~ = ωx î + ωy ĵ + ωz k̂
ω (5.4)
where
Differentiating Eq. (5.2) with respect to time and assuming the system
is in a circular orbit (i.e., θ̈ = 0) yield the rate of change of the system
angular momentum as
~˙ =H
H ~˙ xyz + ω
~ ×H~
n h i o
=Me L2 η̈ ĵ + (θ̈ + β̈)cosη − (θ̇ + β̇)η̇sinη k̂
h i
+ Me L2 ω ~ × η̇ ĵ + +(θ̈ + β̈)cosη k̂
h i
=Me L2 η̈ + (θ̇ + β̇)2 sinηcosη ĵ + Me L2 [β̈cosη − 2(θ̇ + β̇)η̇sinη]k̂
(5.5)
~1
µm1 R
F~1 = − 3 (5.6)
R1
~1
R
T~1 = m1~r1 × F~ = −µm1~r1 × 3 (5.7)
R1
~1 = R
Here R ~ + ~r1 . Substituting |R
~ 1 | in Eq.(5.7), we get
~ + ~r1 )
(R
T~1 = − µm1~r1 ×
~ · ~r1 + ~r2 )3/2
(R2 + 2R 1
" #−3/2
µm1 2 R~ · ~r1 r 2
~ 1+
= − 3 (~r1 × R) + 2 1
(5.8)
R R2 R
Applying Binomial series expansion for the term inside the bracket, we
get
" #
µm1 ~ · ~r1 ) 3 r2
3(R ~ · ~r1 )2
15 (R
~ ~
T1 = − 3 (~r1 × R) 1 − − 1
+ + ···
R R2 2 R2 2 R4
(5.9)
O(1/R3 ), we get
" #
µm1 3(R ~ · ~r1 ) 1
~ ~
T1 = − 3 (~r1 × R) 1 − + O( 3 )
R R 2 R
" #
~
µR 3(R~ · ~r1 )~r1
= 3 × m1~r1 − m1 (5.10)
R R2
Thus, the total torque exerted on the system is the sum of the torques
exerted on mass m1 and m2 . Adding T1 and T2 , we obtain the total
torque
~ n
µR 3 o
T~ = 3 × m1~r1 + m2~r2 − 2 [m1 (R
~ · ~r1 )~r1 + m2 (R
~ · ~r2 )~r2 ] (5.12)
R R
Knowing
m2 ~
~r1 = − L
m1 + m2
m1 ~
~r2 = L
m1 + m2
and
m1~r1 + m2~r2 = 0
the preceding equation simplifies to
3µ
T~ = − 3 Me L2 (îo · î)(îo × î) (5.13)
R
Knowing
îo = cosβcosη î − sinβ ĵ + cosβsinη k̂
we have
3µ h i
T~ = − 3 Me L2 sinηcosηcos2 β ĵ + sinβcosβcosη k̂ (5.14)
R
Using the preceding equation and Eqs. (5.1) and (5.5) as well as rear-
ranging the terms, we obtain equations of motion of the system as
3
β̈ − 2(θ̇ + β̇)η̇tanη + θ̇2 sin2β = 0 (5.15)
2
1 3 2
η̈ + (θ̇ + β̇) sin2η + θ̇ sin2ηcos2 β = 0
2
(5.16)
2 2
48 CHAPTER 5. DYNAMICS II
p
where θ̇ = µ/R3 .
Lagrange Method
The equations of motion of the system with generalized coordinates
q1 = β and q2 = η are given by
d ∂T ∂T ∂U
− + = 0, k = 1, 2 (5.17)
dt ∂ q̇k ∂qk ∂qk
Here
∂T
=Me L2 (θ̇ + β̇)cos2 η (5.21)
∂ β̇
d ∂T
⇒ =Me L2 [β̈cos2 η − 2(θ̇ + β̇)cosηsinη] (5.22)
dt ∂ β̇
∂T
=0 (5.23)
∂β
∂U 3µ
= Me L2 cosβsinβcos2 η (5.24)
∂β R3
η-equation
d ∂T ∂T ∂U
− + =0 (5.26)
dt ∂ η̇ ∂η ∂η
49
Here
∂T
=Me η̇L2 (5.27)
∂ η̇
d ∂T
⇒ =Me η̈L2 (5.28)
dt ∂ η̇
∂T
= − Me L2 (θ̇ + β̇)2 cosηsinη (5.29)
∂η
∂U 3µ
= Me L2 cosηsinηcos2 β (5.30)
∂η R3
∂~λ ∂~λ
Qβ = T~ · , Qη = T~ · (5.35)
∂β ∂η
Qβ = T~ · k̂o , Qη = T~ · ĵ (5.36)
50 CHAPTER 5. DYNAMICS II
Knowing
T~ =Tη ĵ + Tβ k̂
and
we have
Qβ = Tβ cosη (5.37)
Qη = T η (5.38)
Lβ = Eβ cosη (5.39)
Lη = Eη (5.40)
Here
∂T
=Mt1 ω1 L21 + Mt3 ω2 L1 L2 cos(β1 − β2 )
∂ β̇1
d ∂T
⇒ = Mt1 ω̇1 L21 + Mt3 ω̇2 L1 L2 cos(β1 − β2 )
dt ∂ β̇1
− Mt3 ω2 L1 L2 (β̇1 − β̇2 )sin(β1 − β2 ) (5.44)
∂T
= − Mt3 ω1 ω2 L1 L2 sin(β1 − β2 ) (5.45)
∂β1
∂U µ
= − 3 Mt3 L1 L2 sin(β1 − β2 )
∂β1 R
( )
3µ 2
+ 3 Mt1 L1 cosβ1 sinβ1 + Mt3 L1 L2 sinβ1 cosβ2 (5.46)
R
Dividing by Mt1 L21 and taking Mp1 = Mt3 /Mt1 = m3 /(m2 + m3 ) and
knowing
we have
L2 L2
β̈1 + Mp1 cos(β1 − β2 )β̈2 + Mp1sin(β1 − β2 )
L1 L1
n o µ L2
× − ω2 (β̇1 − β̇2 ) + ω1 ω2 − 3 Mp1 sin(β1 − β2 )
R L1
( )
3µ L2
+ 3 cosβ1 sinβ1 + Mp1 sinβ1 cosβ2 = 0 (5.48)
R L1
β2 -equation
d ∂T ∂T ∂U
− + =0 (5.50)
dt ∂ β̇2 ∂β2 ∂β2
Here
∂T
=Mt2 ω2 L22 + Mt3 ω1 L1 L2 cos(β1 − β2 )
∂ β̇2
d ∂T
⇒ = Mt2 ω̇2 L22 + Mt3 ω̇1 L1 L2 cos(β1 − β2 )
dt ∂ β̇2
− Mt3 ω1 L1 L2 (β̇2 − β̇1 )sin(β2 − β1 ) (5.51)
∂T
= − Mt3 ω1 ω2 L1 L2 sin(β2 − β1 ) (5.52)
∂β2
∂U µ
= − 3 Mt3 L1 L2 sin(β2 − β1 )
∂β2 R
( )
3µ 2
+ 3 Mt2 L2 cosβ2 sinβ2 + Mt3 L1 L2 sinβ2 cosβ1 (5.53)
R
Dividing by Mt2 L22 and taking Mp2 = Mt3 /Mt2 = m1 /(m1 + m2 ) and
knowing
we have
L1 L1
β̈2 + Mp2 cos(β1 − β2 )β̈1 + Mp2
sin(β2 − β1 )
L2 L2
n o µ L1
× − ω1 (β̇2 − β̇1 ) + ω1 ω2 − 3 Mp2 sin(β2 − β1 )
R L2
( )
3µ L1
+ 3 cosβ2 sinβ2 + Mp2 sinβ2 cosβ1 = 0 (5.55)
R L2
Knowing Rµ3 = θ̇2 and writing the derivative with respect to θ (i.e., ()0 =
d()/dθ; ()00 = d2 ()/dθ2 . Here θ denotes an angle with respect to a
reference line), the preceding equation can be written as
n
L1 L1
β200 + Mp2 cos(β2 − β1 )β100 + Mp2 β10 (2 + β10 )sin(β2 − β1 )
L2 L2
o
+ 3sinβ2 cosβ1 + 3sinβ2 cosβ2 = 0
(5.56)
and
Applying Binomial series expansion for the term inside the bracket, we
get
" #
µm 3(R~ · ~r1 ) 3 r12 15 (R~ · ~r1 )2
F~1 = − 3 (R
1 ~ + ~r1 ) 1 − − + + ···
R R2 2 R2 2 R4
(5.79)
or
(
µm ~ ~ ~ 2
1
F~1 = − 3 R ~ + ~r1 − 3(R + ~r1 )(R · ~r1 ) − 3 (R + ~r1 )r1
R R2 2 R2
)
~ + ~r1 )(R
15 (R ~ · ~r1 )2
+ 4
+ ··· (5.80)
2 R
~ 1 (R
15 R[m ~ · ~r1 )2 + m2 (R~ · ~r2 )2 ]
+ (5.83)
2 R4
Knowing
and
~
~r1 = −γ L, ~
~r2 = (1 − γ)L, ~ = Lî,
L ~ = Rîo
R (5.85)
we write
where M = m1 + m2 .
For this problem of three-dimensional motion of the system, the unit
vector î in the body-fixed rotating frame Sxyz is related to the unit
vectors in the orbital reference frame Sxo yo zo as follows
Applying the above relation, we have the resultant force vector on the
system as
µ 3
F~ = − 3 M Rîo − Me L2 − [3cos2 βcos2 η]îo + [sin2βcos2 η]ĵo
R 2R
!
+ îo − [cosβsin2η]k̂o (5.89)
Alternatively, the force F~ can derived from the system potential energy.
It is the gradient of potential energy U , given by
F~ = −∇U (5.90)
where x, y, z are the components along unit vectors î, ĵ, and k̂, respec-
tively. These unit vectors represent axes of a right-handed orthogonal
coordinate frame. Note the variable f is the function of x, y, and z,
only.
58 CHAPTER 5. DYNAMICS II
Here î, ĵ, and k̂ are the unit vectors of the body-fixed coordinate frame
S − xyz. We write R ~ as
~ = Rîo
R (5.93)
we have
~ = Rcosβcosη î − Rsinβ ĵ + Rcosβsinη k̂
R (5.96)
Thus, we write
As we are required to derive the force F~ along unit vectors îo , ĵo , and
k̂o in the local-vertical coordinate frame S − xo yo zo , we express Eq.
(5.92) in terms of unit vectors îo , ĵo , and k̂o
∂U ∂U ∂U
∇U = cosβcosη − sinβ + cosβsinη îo
∂x ∂y ∂z
∂U ∂U ∂U
+ sinβcosη + cosβ + sinβsinη ĵo
∂x ∂y ∂z
∂U ∂U
+ − sinη + cosη k̂o (5.98)
∂x ∂z
59
∂U ∂U ∂x ∂U ∂y ∂U ∂z
= + +
∂R ∂x ∂R ∂y ∂R ∂z ∂R
∂U ∂U ∂U
=−R cosβcosη − sinβ + cosβsinη (5.100)
∂x ∂y ∂z
∂U ∂U ∂x ∂U ∂y ∂U ∂z
= + +
∂β ∂x ∂β ∂y ∂β ∂z ∂β
∂U ∂U ∂U
=−R sinβcosη + cosη + sinβsinη (5.101)
∂x ∂y ∂z
∂U ∂U ∂x ∂U ∂y ∂U ∂z
= + +
∂η ∂x ∂η ∂y ∂η ∂z ∂η
∂U ∂U
=Rcosβ sinη + cosη (5.102)
∂x ∂z
Thus, we obtain
∂U 1 ∂U 1 ∂U
∇U = îo − ĵo + k̂o (5.103)
∂R R ∂β Rcosβ ∂η
Alternatively, we can obtain the same equation for ∇U by first deriving
∂U ∂U ∂R ∂U ∂β ∂U ∂η
= + + , X = x, y, z (5.104)
∂X ∂R ∂X ∂β ∂X ∂η ∂X
and substitute these derivatives in Eq. (5.98).
Knowing
µM µ
U =− + Me (1 − 3cos2 βcos2 η)L2
R 2R3
the force F~ is obtained as
µ 3 µ
F~ = −∇U = − M − M e (1 − 3cos 2
βcos 2
η)L 2
îo
R2 2 R4
3 µ 2 2 3 µ 2
− M e L sin2βcos η ĵo − M e L sin2ηcosβ k̂o
2 R4 2 R4
(5.105)
Referring to the solution of Problem set 5.1, the external torque due to
gravitational force acting on the system is derived as
3µ h i
T~ = − 3 Me L2 sinηcosηcos2 β ĵ + sinβcosβcosη k̂ (5.106)
R
60 CHAPTER 5. DYNAMICS II
µ 3µ Me L2
R̈ − Rθ̇2 + − [1 − 3cos2 βcos2 η] = 0 (5.111)
R2 2R2 M R2
Ṙ 3µ Me L2
θ̈ + 2 θ̇) − sin2βcos2 η = 0 (5.112)
R 2R3 M R2
Me L2
Ṙ 3 µ
β̈ − θ̇ − 2(θ̇ + β̇)η̇tanη + 3
sin2β + sin2βcos2 η = 0
R 2R M R2
(5.113)
1 3 µ
η̈ + (θ̇ + β̇)2 sin2η + sin2ηcos2 β = 0 (5.114)
2 2 R3
Lagrange Method
The equations of motion of the system with generalized coordinates
q1 = R, q2 = θ, q3 = β, and q4 = η are given by
d ∂T ∂T ∂U
− + = 0, k = 1, 2, 3, 4 (5.115)
dt ∂ q̇k ∂qk ∂qk
Here
∂T d ∂T
=M Ṙ, ⇒ = M R̈ (5.119)
∂ Ṙ dt ∂ Ṙ
∂T
=M θ̇2 R (5.120)
∂R
∂U µM 3µ
= 2 − Me (1 − 3cos2 βcos2 η)L2 (5.121)
∂R R 2R4
Thus, the R-equation of motion is
µM 3µ
M R̈ − M θ̇2 R + − Me (1 − 3cos2 βcos2 η)L2 = 0 (5.122)
R2 2R4
θ-equation
d ∂T ∂T ∂U
− + =0 (5.123)
dt ∂ θ̇ ∂θ ∂θ
Here
∂T
=M θ̇R2 + Me L2 (θ̇ + β̇)cos2 η (5.124)
∂ θ̇
d ∂T
⇒ =M θ̈R2 + 2M θ̇RṘ + Me L2 [(θ̈ + β̈)cos2 η − (θ̇ + β̇)η̇sin2η]
dt ∂ θ̇
(5.125)
∂T ∂U
=0, =0 (5.126)
∂θ ∂θ
Thus, the θ-equation of motion is
M θ̈R2 + 2M θ̇RṘ + Me L2 [(θ̈ + β̈)cos2 η − (θ̇ + β̇)η̇sin2η] = 0 (5.127)
β-equation
d ∂T ∂T ∂U
− + =0 (5.128)
dt ∂ β̇ ∂β ∂β
Here
∂T
=Me L2 (θ̇ + β̇)cos2 η (5.129)
∂ β̇
d ∂T
⇒ =Me L2 [(θ̈ + β̈)cos2 η − (θ̇ + β̇)η̇sin2η] (5.130)
dt ∂ β̇
∂T
=0 (5.131)
∂β
∂U 3µ
= Me L2 cosβsinβcos2 η (5.132)
∂β R3
62 CHAPTER 5. DYNAMICS II
3µ
Me L2 [(θ̈ + β̈)cos2 η − (θ̇ + β̇)η̇sin2η] + Me L2 cosβsinβcos2 η = 0
R3
(5.133)
η-equation
d ∂T ∂T ∂U
− + =0 (5.134)
dt ∂ η̇ ∂η ∂η
Here
∂T
=Me η̇L2 (5.135)
∂ η̇
d ∂T
⇒ =Me η̈L2 (5.136)
dt ∂ η̇
∂T
= − Me L2 (θ̇ + β̇)2 cosηsinη (5.137)
∂η
∂U 3µ
= Me L2 cosηsinηcos2 β (5.138)
∂η R3
3µ
Me L2 η̈ + Me L2 (θ̇ + β̇)2 cosηsinη + Me L2 cosηsinηcos2 β = 0
R3
(5.139)
µM 3µ
M R̈ − M θ̇2 R + − Me (1 − 3cos2 βcos2 η)L2 = 0 (5.140)
R2 2R4
M θ̈R2 + 2M θ̇RṘ + Me L2 [(θ̈ + β̈)cos2 η − (θ̇ + β̇)η̇sin2η] = 0 (5.141)
3µ
Me L2 [(θ̈ + β̈)cos2 η − (θ̇ + β̇)η̇sin2η] + 3 Me L2 cosβsinβcos2 η = 0
R
(5.142)
3µ
Me L2 η̈ + Me L2 (θ̇ + β̇)2 cosηsinη + 3 Me L2 cosηsinηcos2 β = 0
R
(5.143)
63
or
µ 3µ Me L2
R̈ − Rθ̇2 + 2
− [1 − 3cos2 βcos2 η] = 0 (5.144)
R 2R2 M R2
Ṙ 3µ Me L2
θ̈ + 2 θ̇) − sin2βcos2 η = 0 (5.145)
R 2R3 M R2
Me L2
Ṙ 3 µ
β̈ − θ̇ − 2(θ̇ + β̇)η̇tanη + sin2β + sin2βcos2 η = 0
R 2 R3 M R2
(5.146)
1 3 µ
η̈ + (θ̇ + β̇)2 sin2η + sin2ηcos2 β = 0 (5.147)
2 2 R3
64 CHAPTER 5. DYNAMICS II
Chapter 6
Mathematical and
Numerical Simulation
Problem Set 6
δβ 00 + 3δβ = 0 (6.1)
δη 00 + 4δη = 0 (6.2)
Ẋ = AX + Bu (6.5)
66 CHAPTER 6. MATHEMATICAL AND NUMERICAL SIMULATION
where
x 0 0 1 0
gm2 l2 −(J + ml2 )b
0 0
ẋ
X= , A =
J(M + m) + M ml2 J(M + m) + M ml2 ,
θ
0
0 0 1
θ̇
mgl(M + m) −mlb
0 0
J(M + m) + M ml2 J(M + m) + M ml2
0
J + ml2
2
J(M + m) + M ml
B=
0
ml
2
J(M + m) + M ml
is
λ2 + 5λ + 25 = 0 (6.7)
2ζωn = 5 (6.10)
ωn2 = 25 (6.11)
ωn = 5 rad/s (6.12)
5 5
ζ= = = 0.5 (6.13)
2ωn 10
p
λ1,2 = −ζωn ± jωn 1 − ζ2
= −ζωn ± jωd (6.14)
p
Here ωd = ωn 1 − ζ 2 is called damped natural frequency of the system.
So, ωd for the given system of Eq. (6.6) is
p p
ωd = ωn 1 − ζ 2 = 5 × 1 − 0.52 = 4.33 rad/s (6.15)
θ̈ + 2θ̇ + 5θ = −δ
ẋ1 = x2
ẋ2 = −2x2 − 5x1 − δ
ẋ 0 1 x1 0
1
= + δ
ẋ2 −5 −2 x2 −1
where
0 1
A=
−5 −2
0
B = δ
−1
|A − λI| = 0
0 1 1 0 0 1 λ 0
− λ = − = 0
−5 −2 0 1 −5 −2 0 λ
or
−λ 1
=0
−5 −2 − λ
λ(λ + 2) + 5 = 0
or
λ2 + 2λ + 5 = 0
The characteristic equation can be solved for the eigenvalues for the
system.
69
λ1,2 = −1 ± 2j
The eigenvalues are complex and the real part of the root is negative.
This means that the system is dynamically stable. If the system were
given an initial disturbance, the motion would decay sinusoidally and
the frequency of the oscillation would be governed by the imaginary
part of the complex eigenvalues.
6.7 Solving the differential equations for the highest order derivative yield
or in matrix form
ẋ −0.5 10 x1 −1
1
= + δ
ẋ −1.0 1.0 x2 2
2
ẋ = Ax + Bu
where
−0.5 10
A=
−1.0 1.0
−1
B = δ
2
|λI − A| = 0
1 0 −0.5 10
λ − = 0
0 1 −1.0 1.0
λ 0 −0.5 10
− = 0
0 λ −1.0 1.0
λ + 0.5 −10
=0
1.0 λ − 1.0
(λ + 0.5)(λ − 1.0) + 10 = 0
or
λ2 − 0.5λ + 9.5 = 0
The characteristic equation can be solved for the eigenvalues for the
system.
The eigenvalues for this particular characteristic equation are
The eigenvalues are complex and the real part of the root is positive.
This means that the system is dynamically unstable. If the system were
given an initial disturbance, the motion would grow sinusoidally and
the frequency of the oscillation would be governed by the imaginary
part of the complex eigenvalues.
6.8 Given the differential equation
...
x + ẍ − 4ẋ + 6x = r
ẋ1 = x2
ẋ2 = x3
ẋ3 = r − 6x1 + 4x2 − x3
ẋ 0 1 0 x1
0
1
ẋ2 = 0 0 1 x2 + 0 r
ẋ
−6 4 −1 x3
1
3
where
0 1 0
A= 0 0 1
−6 4 −1
0
B = 0 r
1
|A − λI| = 0
0 1 0 1 0 0 0 1 0 λ 0 0
0 0 1 − λ 0 1 0 = 0 0 1 − 0 λ 0 = 0
−6 4 −1 0 0 1 −6 4 −1 0 0 λ
72 CHAPTER 6. MATHEMATICAL AND NUMERICAL SIMULATION
or
−λ 1 0
0 −λ 1 =0
−6 4 −1 − λ
−λ[−λ(−1 − λ) − 4] − 1[0 + 6] = 0
or
λ3 + λ2 − 4λ + 6 = 0
The characteristic equation can be solved for the eigenvalues for the
system.
The eigenvalues for this particular characteristic equation are
λ1 = −3
λ2,3 = 1 ± j
ẋ = Ax + Bu (6.16)
x = x0 eλt (6.17)
λ = η + jω (6.18)
The real part η states about the magnitude of x whereas the imaginary
part ω says about an oscillatory motion of x. As we are interested in
magnitude of x, we take only the real part, i.e.,
λ=η (6.19)
x
ln = ηt
x0
or
1 x
t= ln (6.20)
η x0
1 2x0 1 0.693
t2 = ln = ln2 = (6.21)
η x0 η η
1 x0 /2 1 0.693
t1/2 = ln = − ln2 = − (6.22)
η x0 η η
Here η will have negative value as explained earlier.
Thus, from Eqs. (6.21) and (6.22) we conclude that the time for dou-
bling or halving of the amplitude is
0.693
t2 or t1/2 = (6.23)
|η|
74 CHAPTER 6. MATHEMATICAL AND NUMERICAL SIMULATION
t2
N (cycles)2 =
T
t1/2
N (cycles)1/2 = (6.24)
T
where
2π
T = time period = (6.25)
ω
Using Eqs. (6.23) and (6.25), Eqs. (6.24) can be rewritten as
0.693|ω| |ω|
N (cycles)2 or N (cycles)1/2 = = 0.110 (6.26)
|η|2π |η|
6.10 For a given characteristic equation of the system, the eigenvalues ob-
tained are
λ1,2 = −0.0171 ± j0.213
λ3,4 = −2.5 ± j2.59
the system is dynamically stable as all real parts of the roots are neg-
ative.
For the given system, T (period), t1/2 (time to half amplitude), and
N1/2 (number of cycles to half amplitude) corresponding to λ1,2 and
λ3,4 are tabulated below.
λ1,2 λ3,4
η = −ζωn = −0.0171 η = −2.5
ω = 0.213 rad/s ω = 2.59 rad/s
T = 2π 2π
ω = 0.213 T = 2π 2π
ω = 2.59
T = 29.5 s T = 2.42 s
t1/2 = 0.693 = 0.0171
0.693 t1/2 = 0.693 = 0.693
2.5
|η| |η|
t1/2 = 40.3 s t1/2 = 0.28 s
t1/2 t
N1/2 = T = 0.11ω N1/2 = 1/2T = |η|
0.11ω
|η|
N1/2 = 0.11 × 0.213 = 1.37 cycles N
0.0171 1/2 =
0.11 × 2.59 = 0.11 cycles
2.5
75
λ2 + a1 λ + a0 = 0 (6.28)
λ1 + λ2 = −a1
or
a1 = −(λ1 + λ2 ) (6.30)
Thus, the coefficient of λ1 is the negative of the sum of all the real parts
as well as imaginary parts of the roots.
For n=3, the characteristic equation is written as
λ3 + a2 λ2 + a1 λ + a0 = 0 (6.31)
λ = η + jω (6.32)
η
1
η= η2 (6.33)
η
3
1
η3 η12 η1 1
1
a
2
=0 (6.34)
3
η2 η22 η2 1
a1
η33 η32 η3 1
a
0
1
η13 η12 η1 1
a2
=0 (6.35)
3
η2 − η13 η22 − η12 η2 − η1 0
a1
η33 − η13 η32 − η12 η3 − η1 0
a
0
η13 η12 η1 1
1
(η2 − η1 )2 η1 + η2 1 0
a2
(η2 − η1 )(η3 − η1 ) +3η1 η2 = 0 (6.36)
a1
(η3 − η1 )2 η1 + η3 1 0
a0
+3η1 η3
η13 η12 η1 1
1
η1 + η2 + η2 1 1 0 a2
(η2 − η1 )(η3 − η1 )(η2 − η3 ) =0
(η3 − η1 )2 η1 + η3 1 0 a1
+3η1 η3 a
0
(6.37)
As η1 6= η2 6= η3 , we can write
η13 η12 η1 1 1
η1 + η2 + η3 1 1 0 a2
=0 (6.38)
(η3 − η1 )2 η1 + η3 1 0 a1
+3η1 η3 a
0
η1 + η2 + η3 + a2 = 0
or
a2 = −(η1 + η2 + η3 ) (6.39)
Thus, a2 the coefficient of λ2 is the negative of the sum of the real parts
of all the roots.
6.14 The equations of motion of the given system can be written as
ẋ = Ax (6.41)
where
78 CHAPTER 6. MATHEMATICAL AND NUMERICAL SIMULATION
0 1 0 0
−a12 a21 0 0 a11 a22
1
A=
a21 − a11
0 0 0 1
a12 0 0 −a22
As there are four state variables, the order of the characteristic equation
is four. However, all elements in the third column of A (corresponding
to β1 ) are zero. It implies that the state variable β1 is not involved in
the system equations of motion and the corresponding eigenvalue would
be zero. So, the system state variables are reduced to x = [α, α̇, β̇1 ]T
and thus, the order of the characteristic equation is three.
ẋ = Ax (6.42)
where
As there are eight state variables, the order of the characteristic equa-
tion is eight. However, all elements in the fifth and seventh columns of
A (corresponding to β2 and be3 ) would be zero. It implies that the state
variables β2 and β3 are not involved in the system equations of motion
and corresponding two eigenvalues would be zero. So, the system state
variables are reduced to x = [φ, φ̇, γ, γ̇, β̇2 , β̇3 ]T and thus, the order
of the characteristic equation is six.
x1 = r, x2 = ṙ, x3 = θ, x4 = θ̇
then
ẋ1 = x2 , ẋ3 = x4
79
ẋ1 = x2
ẋ3 = x4
µ
ẋ2 = x1 x24 − + ar
x21
x2 x4 aθ
ẋ4 = −2 +
x1 x1
0 1 0 1
0 1 0 1
0 0 11
0 0 11
0 0 11
0 1 0 1
0 1
04 5 1
0 1 0 1
0 0 11
0 1
0 1
0 1
04 5 1
0 1
0 1 0 1
0 1 0 1 0 1
0 1
0 1
04 5 1
0 1
0 1 0 1
0 1 0 1
0 1
§
0 1 ©
§
© 0 1 0 1 ¶¸¶¸
0 1 0 0 0 1
0 111
0
0 1 0 0 1 0 11 1 0 0
0 1 0 111
0 0 1 0 0 1 0 11 1
0 0 1 0 11
0 1 0 0 0 1
0 111
0 0 1 0 0 1 0 11 1
0 0 1 0 11
04 5 1
0 1 00 1 0 1 0
10 0 1 0 1 0 111 0 1
0 0 1 0 0 1 0 11 1
0 0 1 0 11
4
5 1
0 1 0 1
0 1
0 0 1 0 0 1 0 11 1
0 0 1 0 11
0 1
0 0 1 0 1 0 0 1 0
1 0 11 0 1 0 11 0 1
0
4
5 1
0 0 1 0 1
0 0 1 0 1 0 11 0
1 0 11 0 1
0 1 0 1
0 1 0 1 0 0 1
0 1
0 0 1 0 1
0 1 0 1 0
1 0 1 0
1 0 1 0 11 0
1 0 1 0
1 0 1 0 11 0 1
0 1
0 0 1 0 0 1 0 1 0 111 0 1
0
4
5 1
0 0 1 0 0 1 0
1 0 111 0 1
0 1 0 1
0 0 1
0 0 1 0 1
0 1 0 1 0
1 0 1 0
1 0 1 0 111 0
1 0 10 0 1 0 1 0 11
0 0 1 0 0 1 0 11 0 11
0 1 0 1
0 1
0 0 1 0 1 0 11
0
4
5 1
0 0 1 0 1 0 11
0 1 0 1
0 0 1 0
1 0 1 0
1 0 1 0 11 0 10 0 1
0 1 0 11
0 0 1 0 0 1 0 11 0 11
0 1
0 0 1 0 11
0
4
5 1
0 0 1 0 11
0 1 0 1
0 0 1 0 1 0 1 0
1 0 1 0 11
Figure 6.5: Maple program for Problem 6.19.
Chapter 7
Control System
Problem Set 7
7.1
I θ̈ = T (7.1)
I s2 θ(s) − sθ0 − θ̇0 = T (s) (7.2)
1 1 1
θ(s) = T (s) + θ0 + 2 θ̇0 (7.3)
Is2 s s
Thus, the open-loop transfer function of the given system with input
as T (s) and output as θ(s) is
θ(s) 1
G(s) = = 2 (7.4)
T (s) Is
Is2 = 0 (7.5)
s1,2 = 0 (7.6)
(c) As the gas jet provides a constant thrust, the input is a step input.
(d)
(d.1) The characteristic equation of the closed loop system with a propor-
tional controller is
1 + Gc (s)G(s) = 0 (7.8)
Is2 + kp = 0 (7.9)
r r
kp kp
s1,2 = ±j = ±j (7.10)
I 100
As the roots of the characteristic equation of the closed loop system lie
on the imaginary axis, the closed loop system is marginally stable with
a proportional controller.
87
For the system stability, the roots in Eq. (7.10) should not have positive
real parts, i.e.,
I θ̈ = kp (θr − θ) (7.12)
or
I θ̈ + kp θ = kp θr (7.13)
r
kp
θ(t) = θr + (θ0 − θr )cos t (7.14)
I
(d.2) The final value of theorem of Laplace Transform can not be applied
here to find the steady state error as the system is not asymptotically
stable.
(d.3) The characteristic equation of the closed loop system with a derivative
controller is
1 + Gc (s)G(s) = 0 (7.15)
Is2 + kd s = 0 (7.16)
kd
s1 = 0, s2 = − =0 (7.17)
I
88 CHAPTER 7. CONTROL SYSTEM
or
I θ̈ + kd θ̇ = kd θ̇r (7.20)
kd sθr (s)
θ(s) = (7.22)
Is2 + kd s
kd sθr (s) 1 1
θ(t) = L−1 = L−1 sθr (s) − (7.23)
Is2 + kd s s s + kd
I
The solution of Eq. (7.23) assuming a step input θr (s) is
k
!
− dt
θ(t) = θr 1 − e I (7.24)
kd t
θ(∞) = lim θr [1 − e I ] = θr (7.25)
t→∞
(d.4) The characteristic equation of the closed loop system with a proportional-
derivative (PD) controller is
1 + Gc (s)G(s) = 0 (7.27)
Is2 + kd s + kp = 0 (7.28)
p
−kd ± kd2 − 4kp I
s1,2 = (7.29)
2I
kp > 0 ⇒ kp ∈ (0, ∞)
kd > 0 ⇒ kd ∈ (0, ∞) (7.30)
or
I θ̈ + kd θ̇ + kp θ = kp θr + kd θ̇r (7.32)
Is2 + kd s + kp = 0 (7.33)
kd kp
s2 + s+ =0 (7.34)
I I
we get
kd
= 2ζωn (7.36)
I
kp
= ωn2 (7.37)
I
2πf
ωn = p
1 − ζ2
So,
2π × 0.25
kd = 2Iζωn = 2 × 100 × 0.5 × √ = 181.4 (7.38)
1 − 0.52
2
2π × 0.25
kp = Iωn2 = 100 × √ = 284.91 (7.39)
1 − 0.52
91
7.2 Given.
θ̇r =30 /s; I=20 kg-m2 ; c=5 N-sec/m;
ess ≤ 0.1o ; τ ≤ 0.5 sec
The system equation of motion with a proportional-derivative controller
is
or
Is2 + (c + kd )s + kp = 0 (7.42)
c + kd kp
s2 + s+ =0 (7.43)
I I
we get
c + kd
= 2ζωn (7.45)
I
kp
= ωn2 (7.46)
I
1
τ= (7.47)
ζωn
92 CHAPTER 7. CONTROL SYSTEM
Substituting for the term ζωn from Eq. (7.46) into Eq. (7.47),
2I
τ= ≤ 0.5
c + kd
or
c + kd 5 + kd
≥2 ⇒ ≥2
2I 2 × 20
Solving we get
kd ≥ 75 (7.48)
The closed-loop transfer function of the system given by Eq. (7.41) can
be expressed as
θ(s) kp + skd
M (s) = = 2 (7.49)
θr (s) Is + (c + kd )s + kp
Here the input is ramp input. Substituting M (s) from Eq. (7.49) into
the preceding Eq. (7.50), we have
θ̇r Is2 + cs
ess = lim s (7.51)
s→0 s2 Is2 + (c + kd )s + kp
Is + c c
= lim θ̇r 2 = θ̇r (7.52)
s→0 Is + (c + kd )s + kp kp
Thus,
c
θ̇r
≤ 0.1deg
kp
5N-m-sec/rad
3deg/sec ≤ 0.1deg
kp
or
15
kp ≥ = 150N-m/rad (7.53)
0.1
(c) No, the desired performance can not be met.
93
7.3 Given.
θ̇r =30 /s;
m=20 kg; k=1 N/s; c=4 N-sec/m;
ts ≤ 1sec; Mp ≤ 0.2
Considering settling time (to within 5% of the final value),
3
ts = ≤1 (7.54)
ζωn
3×2
≤1 ⇒ 6 ≤ 4 + kd (7.55)
c + kd
or
kd ≥ 2 (7.56)
4.6
ts = ≤1 (7.57)
ζωn
4.6 × 2
≤1 ⇒ 9.2 ≤ 4 + kd (7.58)
c + kd
or
kd ≥ 5.2 (7.59)
s
(lnMp /π)2
ζ≥
1 + (lnMp /π)2
s
(ln0.2/π)2
≥ = 0.4559 (7.60)
1 + (ln0.2/π)2
or
c + kd c + kd
≥ 0.4559 ⇒ p ≥ 0.4559
2mωn 2 (k + kp )m
or
4 + kd p
≥ 1 + kp ⇒ kp ≤ 1.2025(4 + kd )2 − 1 (7.61)
2 × 0.4559
94 CHAPTER 7. CONTROL SYSTEM
I θ̈ + cθ̇ = Td (7.62)
1 + I θ̇0
θ(s) = (7.65)
Is2 + cs
1 + I θ̇0
θ(s) = (7.66)
Is2 + cs
" # " #
−1 1 + I θ̇0 −1 1 + I θ̇0 1 1
θ(t) = L =L − (7.67)
Is2 + cs c s s+ c
I
The solution of Eq. (7.67) is
1 + I θ̇0 −ct
θ(t) = (1 − e I ) (7.68)
c
or
1 + 100θ̇0 − 10 t
θ(t) = (1 − e 100 )
10
= (0.1 + 10θ̇0 )(1 − e−0.1t ) (7.69)
1
G(s) = (7.72)
Is2 + cs
The characteristic equation of the uncontrolled system,
Is2 + cs = 0 (7.73)
Thus, the eigenvalues are
c 10
s = 0; s= = = 0.1 (7.74)
I 100
Applying a proportional controller, the characteristic equation of the
controlled system is
1 + Gc (s)G(s) = 0 (7.75)
where Gc (s) is the controller transfer function given as Gc (s) = kp .
The term kp is the proportional gain.
Thus, the characteristic equation of the controlled system
Is2 + cs + kp = 0 (7.76)
p p
−c ± c2 − 4Ikp −10 ± 100 − 4 × 100kp
s1,2 = = (7.77)
2I 200
For kp = 50, the eigenvalues are
√
−10 ± 100 − 4 × 100 × 50
s1,2 = = −0.05 ± j0.7053 (7.78)
200
The closed-loop system will be asymptotically stable.
96 CHAPTER 7. CONTROL SYSTEM
(kp )G(s)
M (s) =
1 + kp G(s)
1.151kps + 0.1774kp
= (7.84)
s3 + 0.739s2 + (0.921 + 1.151kp )s + 0.1774kp
s3 1 0.921 + 1.151kp
2
s 0.739 0.1774kp
(7.86)
0.1774kp
s1 0.921 + 1.151kp − 0.739 0
s0 0.1774kp
(b) All elements in the first column of the Routh array should be
positive, i.e.,
0.1774kp
0.921 + 1.151kp − , 0.1774kp > 0
0.739
Thus, we can write the conditions of the system stability as
(kp + kd s)G(s)
M (s) =
1 + (kp + kd s)G(s)
1.151kds2 + (1.151kp + 0.1774kd)s + 0.1774kp
=
s3 + (0.739 + 1.151kd)s2 + (0.921 + 1.151kp + 0.1774kd)s + 0.1774kp
(7.90)
(b) All elements in the first column of the Routh array should be
positive, i.e.,
0.1774kp
0.921 + 1.151kp − , 0.1774kp > 0
0.739
Thus, we can write the conditions of the system stability as
s3 1 12.70
2
s 0.947 1.597
(7.95)
s1 11.47 0
s0 1.597
ki
(kp + s + kd s)G(s)
M (s) =
1 + (kp + + ksi + kd s)G(s)
1.151kds2 + (1.151kp + 0.1774kd)s + 0.1774kp
=
s3 + (0.739 + 1.151kd)s2 + (0.921 + 1.151kp + 0.1774kd)s + 0.1774kp
(7.96)
s4 1 3.76 0.71
s3 4.19 4.96 0
s 2
2.58 0.71 0 (7.98)
s1 3.81 0
0
s 0.71
4.6 (a)
−p
πζ
Mp = e 1 − ζ2 = 0 ⇒ζ=1 (7.99)
1.8 1.8
tr = ≤ 0.8 ⇒ ωn ≥ = 2.25 (7.100)
ωn 0.8
s2 + 2ζωn s + ω 2 = 0
or
We place the last pole far enough from the first and the second
poles which determine the response of the system. Let us take
s3 =-20. Then, the desired characteristic equation is
ki
[kp + s + skd ]G(s)
M (s) = ki
1 + [kp + s + skd ]G(s)
ki + kp s + kd s2
= (7.101)
s3 + (10 + kd )s2 + (20 + kp )s + ki
X(s) 1
G(s) = = 2 (7.103)
F (s) s + 10s + 20
s2 + 10s + 20 = 0 (7.104)
As the two roots are in the left half s-plane, the open-loop system
is stable.
The final value of X for the unit step input is
1 1
X(∞) = lim sG(s)F (s) = lim s ×
s→0 s→0 s s2 + 10s + 20
1
= (7.106)
20
The steady-state error ess is
1 19
ess = 1 − X(∞) = 1 − = = 0.95 (7.107)
20 20
As ess is quite large, we need to apply a suitable controller.
(c) Applying proportional control, the closed-loop transfer function of
the system is
kp G(s) kp
M (s) = = 2 (7.108)
1 + kp G(s) s + 10s + 20 + kp
s2 + 10s + 20 + kp = 0 (7.109)
s2 + (10 + kd )s + 20 + kp = 0 (7.112)
s2 1 20 + kp
s 1
10 + kd 0 (7.113)
s0 20 + kp
kp > −20
kd > −10 (7.114)
kp + kd s 1
X(∞) = lim sM (s)F (s) = lim s
s→0 s→0 s2 + (10 + kd )s + 20 + kp s
kp
= (7.115)
20 + kp
kp 20
ess = 1 − X(∞) = 1 − = (7.116)
20 + kp 20 + kp
103
r
400
s1,2 = −10 ± − 320 = −10 ± 14.832 (7.118)
4
As all the roots are in the left half s-plane, the closed-loop system
would be stable.
(e) Applying proportional-integral-derivative (PID) control, the closed-
loop transfer function of the system is
ki
[kp + s + skd ]G(s)
M (s) = ki
1 + [kp + s + skd ]G(s)
ki + kp s + kd s2
= (7.119)
s3 + (10 + kd )s2 + (20 + kp )s + ki
s3 1 20 + kp
s2 10 + kd ki
(7.121)
1 ki
s 20 + kp − 10+kd 0
s0 ki
(b) All elements in the first column of the Routh array should be
positive, i.e.,
ki
10 + kd > 0, 20 + kp − > 0, ki > 0
10 + kd
Thus, we can write the conditions of the system stability as
ki
kp > − 20
10 + kd
ki > 0 (7.122)
kd > −10
ki + kp s + kd s2
1
X(∞) = lim sM (s)F (s) = lim s
s→0 s→0 s3 + (10 + kd )s2 + (20 + kp )s + ki s
ki
= =1 (7.123)
ki
The steady state error ess is
For the given gains kp =350, ki =300, and kd =50, the characteristic
equation is
As all the roots are in the left half s-plane, the closed-loop system
would be stable.
(f ) Applying proportional-plus-integral (PI) control, the closed-loop
transfer function of the system is
ki
[kp + s ]G(s)
M (s) =
1+ [kp + ksi ]G(s)
ki + kp s
= (7.127)
s3 + 10s2 + (20 + kp )s + ki
105
s3 1 20 + kp
2
s 10 ki
(7.129)
ki
s1 20 + kp − 10 0
s0 ki
ki
20 + kp − > 0, ki > 0
10
Thus, we can write the conditions of the system stability as
ki
kp > − 20
10
ki > 0 (7.130)
ki + kp s 1
X(∞) = lim sM (s)F (s) = lim s 3
s→0 s→0 s + 10s2 + (20 + kp )s + ki s
ki
= =1 (7.131)
ki
For the given gains kp =30 and ki =70, the characteristic equation
is
As all the roots are in the left half s-plane, the closed-loop system
would be stable.
7.9 (a) The closed-loop transfer function is
G(s) 4500K
M (s) = = 2
1 + G(s) s + 361.2s + 4500K
s2 + 361.2s + 4500K = 0
s2 + 2ζωn s + ωn2 = 0
2ζωn = 361.2
ωn2 = 4500K
Further simplifying,
√ √
ωn = 4500K = 64.082 K rad/s
361.2 361.2 2.692
ζ= = √ = √
2ωn 2 × 64.082 K K
107
(b)
The characteristic equation of the closed-loop second-order system is
obtained as
s2 + 361.2s + 4500K = 0
s2 1 4500K
s1 361.2 0
0
s 4500K
K ∈ (0, ∞)
s3 1 1, 204, 000
s2 3408.3 1.5 × 107
1.5×107
s1 1, 204, 000 − 3408.3 0
s0 1.5 × 107 K
All elements in the first column of the Routh array should be positive,
i.e.,
1.5 × 107
1, 204, 000 − > 0 ⇒ 273.573 > K; 1.5 × 107 K > 0 ⇒ K > 0
3408.3
7.10 The equations of motion for the system are obtained as follows:
System: β1
n
L2 L2
β100 + Mp1 cos(β1 − β2 )β200 + Mp1 β20 (2 + β20 )sin(β1 − β2 )
L1 L1
o
+ 3sinβ1 cosβ2 + 3sinβ1 cosβ1 = 0
(7.135)
System: β2
n
L1 L1
β200 + Mp2 cos(β2 − β1 )β100 + Mp2 β10 (2 + β10 )sin(β2 − β1 )
L2 L2
o
+ 3sinβ2 cosβ1 + 3sinβ2 cosβ2 = 0
(7.136)
where
m3 m1
Mp1 = , Mp2 = (7.137)
m2 + m3 m1 + m2
Solving β100 and β200 using Eqs. (7.135) and (7.136), we obtain
n
[1 − Mp1 Mp2 cos2 (β1 − β2 )]β100 − Mp1 Mp2 cos(β1 − β2 ) β10 (2 + β10 )sin(β2 − β1 )
n
o L2 o
+ 3sinβ2 cosβ1 + Mp1 β20 (2 + β20 )sin(β1 − β2 ) + 3sinβ1 cosβ2
L1
L2
− 3Mp1 cos(β1 − β2 )sinβ2 cosβ2 + 3sinβ1 cosβ1 = 0 (7.138)
L1
n
[1 − Mp1 Mp2 cos2 (β2 − β1 )]β200 − Mp1 Mp2 cos(β2 − β1 ) β20 (2 + β20 )sin(β1 − β2 )
n
o L1 o
+ 3sinβ1 cosβ2 + Mp2 β10 (2 + β10 )sin(β2 − β1 ) + 3sinβ2 cosβ1
L2
L1
− 3Mp2 cos(β2 − β1 )sinβ1 cosβ1 + 3sinβ2 cosβ2 = 0 (7.139)
L2
Thus,
ω1 = ω2 = 1.5, ζ1 = ζ2 = 1 (7.148)
Next we apply the control laws in the nonlinear system defined by Eqs.
(7.138) and (7.139) as follows:
n
[1 − Mp1 Mp2 cos2 (β1 − β2 )]β100 − Mp1 Mp2 cos(β1 − β2 ) β10 (2 + β10 )sin(β2 − β1 )
n
o L2 o
+ 3sinβ2 cosβ1 + Mp1 β20 (2 + β20 )sin(β1 − β2 ) + 3sinβ1 cosβ2
L1
L2
− 3Mp1 cos(β1 − β2 )sinβ2 cosβ2 + 3sinβ1 cosβ1 = u1 (7.149)
L1
n
[1 − Mp1 Mp2 cos2 (β2 − β1 )]β200 − Mp1 Mp2 cos(β2 − β1 ) β20 (2 + β20 )sin(β1 − β2 )
n
o L1 o
+ 3sinβ1 cosβ2 + Mp2 β10 (2 + β10 )sin(β2 − β1 ) + 3sinβ2 cosβ1
L2
L1
− 3Mp2 cos(β2 − β1 )sinβ1 cosβ1 + 3sinβ2 cosβ1 = u2 (7.150)
L2
6 1
4 0.5
β1 (deg)
β2 (deg)
2 0
0 −0.5
−2 −1
0 1 2 0 1 2
Orbits Orbits
Control Input u1
Control Input u2
0.3 0.5
0.2
0
0.1
−0.5
0
−0.1 −1
0 1 2 0 1 2
Orbits Orbits
1 6
0.5 4
β1 (deg)
β2 (deg)
0 2
−0.5 0
−1 −2
0 1 2 0 1 2
Orbits Orbits
Control Input u1
Control Input u2
0.2 1
0.1
0.5
0
0
−0.1
−0.2 −0.5
0 1 2 0 1 2
Orbits Orbits
6 6
4 4
β1 (deg)
β2 (deg)
2 2
0 0
−2 −2
0 1 2 0 1 2
Orbits Orbits
Control Input u1
Control Input u2
0.1 0.1
0.05 0.05
0 0
−0.05 −0.05
0 1 2 0 1 2
Orbits Orbits
6000 6000
β1 (deg)
β2 (deg)
4000 4000
2000 2000
0 0
0 1 2 0 1 2
Orbits Orbits
Control Input u1
Control Input u2
2 2
1 1
0 0
−1 −1
−2 −2
0 1 2 0 1 2
Orbits Orbits
X 0 = AX (7.156)
δφ
δφ0
X= (7.157)
δγ
0
δγ
and matrix A is
0 1 0 0
−4k1 − kpφ −kdφ 0 k1 − 1
A= (7.158)
0 0 0 1
0 1 − k3 −k3 − kpγ −kdγ
114 CHAPTER 7. CONTROL SYSTEM
Formation Flying
Problem Set 8
s4 1 θ̇2 − kp 3θ̇2 kp
s3 0 0 0
We can not proceed further as all elements in the s3 -row are zero. So,
we construct auxiliary function A1 (s) using the elements in the s4 -row
as
dA(s)
= 4s3 + 2(θ̇2 − kp )s (8.3)
ds
The elements of the s3 -row of the above Routh array are taken from
the coefficients in Eq. (8.3) and thus, the Routh array is
s4 1 θ̇2 − kp 3θ̇2 kp
s3 4 2(θ̇2 − kp ) 0
θ̇2 − kp
2 3θ̇2 kp 0 (8.4)
2[(θ̇ − kp )2 − 12θ̇2 kp ]
2
s1 0
θ̇2 − kp
s0 3θ̇2 kp
(b) All elements in the first column of the Routh array should be
positive, i.e.,
θ̇2 − kp > 0 ⇒ kp < θ̇2 ,
and
(θ̇2 − kp )2 − 12θ̇2 kp > 0 ⇒ kp2 − 14θ̇2 kp + θ̇2 > 0
s4 1 θ̇2 − kp 3θ̇2 kp
s3 −kd 3θ2 kd 0
2 2 2
s 4θ̇ − kp 3θ̇ kp 0 (8.7)
s 1 12θ̇4 kd 0 0
4θ̇2 − kp
s0 3θ̇2 kp
−kd > 0 ⇒ −kd > 0; θ2 −kp > 0 ⇒ kp < θ̇2 ; (3θ̇2 kd ) > 0 ⇒ kd > 0
and
3θ̇2 kp > 0 ⇒ kp > 0
(b) All elements in the first column of the Routh array should be
positive, i.e.,
−kd > 0 ⇒ kd < 0; 4θ̇2 − kp > 0 ⇒ kp < 4θ̇2 ; 12θ̇4 kd > 0 ⇒ kd > 0
and
3θ̇2 kp > 0 ⇒ kp > 0
s4 − kd2 s3 + (θ̇2 − kp2 − 2θ̇kd1 )s2 + (3θ̇2 kd2 − 2θ̇kp1 )s + 3θ̇2 kp2 = 0
(8.9)
s0 3θ̇2 kp2
(8.10)
θ̇2 − kp2
θ̇2 − kp2 − 2θ̇kd1 > 0 ⇒ kd1 < ;
2θ̇
−3θ̇2 kd3
−3θ̇2 kd3 − 2θ̇kp1 > 0 ⇒ kp1 <
2θ̇
and
3θ̇2 kp2 > 0 ⇒ kp2 > 0
(b) All elements in the first column of the Routh array should be
positive, i.e.,
kd3 > 0;
2θ̇kp1 kd3
4θ̇2 −kp2 −2θ̇kd1 + > 0 ⇒ kp1 > −4θ̇2 + kp2 + 2θ̇kd1 ;
kd3 2θ̇
3θ̇kp2 kd3
−3θ̇2 kd3 − 2θ̇kp1 − >0
2 2θ̇kp1
4θ̇ − kp2 − 2θ̇kd1 +
kd3
119
!
1 2θ̇kp1 3θ̇2 kp2 kd3
⇒ kd1 < 4θ̇2 − kp2 + +
θ̇ kd3 3θ̇2 kd3 + 2θ̇kp1
and
3θ̇2 kp2 > 0 ⇒ kp2 > 0
We also have
!
1 2θ̇kp1 3θ̇2 kp2 kd3 θ̇2 − kp2
kd1 < 4θ̇2 − kp2 + + and kd1 <
dsθ̇ kd3 3θ̇2 kd3 + 2θ̇kp1 2θ̇
Virtual work, 49
121