Escolar Documentos
Profissional Documentos
Cultura Documentos
1 ⎛ mV 2 ⎞
γ = ⎜ T sin α + L − mg cos γ + ⎟
mV ⎜ R ⎟
⎝ ⎠
z Thrust
z Side force
z Rolling
Y
z Pitching
z Yawing
X
Z
ADVANCED CONTROL SYSTEM DESIGN Dr. 14
Radhakant Padhi, AE Dept., IISc-Bangalore
Control Action: Aileron Roll
dm
Assumptions: dS
• Flat earth (spherical and dV
rotational effects are negligible)
• Rigid body (no relative motion Body axis:
rotating and
of particles, no spinning rotors) moving
• Constant mass and mass
distribution (no fuel burning,
no fuel slosh, no passenger
movement etc.) Inertial axis:
non-rotating and
• Uniform mass density non-moving
• Constant gravity
ADVANCED CONTROL SYSTEM DESIGN 18
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Six-DOF Model
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
G G G dm
From Geometry: r ′ = r p′ + r dS
dV
P is center of mass/gravity. Hence:
G
∫
V
r ρ AdV = 0
G G
∫ ( r ′ − r p′ ) ρ A d V = 0 CG
V
G G G
∫
V
r ′ ρ A d V = r p′ ∫ ρ A d V = r p′ m
V
G 1 G
rp′ = ∫ r ′ρ A dV
mV
ADVANCED CONTROL SYSTEM DESIGN 19
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Dynamic Equations
G
d ⎡ ⎛ d r′ ⎞ ⎤ G G
⎢∫ ρ A ⎜ ⎟ dV ⎥ = ∫ ρ A g dV + ∫S F ds
dt ⎣V ⎝ dt ⎠ ⎦
V
N
Linear momentum Gravity Force Aerodynamic/Thrust Force
G
d ⎡ G ⎛ d r′ ⎞ ⎤ G G G G
⎢∫ r × ρ A ⎜
′ ⎟ dV ⎥ = ∫ r × ρ A g dV +
′ ∫S r ′ × F ds
dt ⎣V ⎝ dt ⎠ ⎦ V
⎢ ⎜
⎟⎥
V
dm
⎣ ⎝ m
=0 ⎠⎦
G G
d⎛d G ⎞ d ⎛ d rp′ ⎞
= ⎜ ( mrp′ ) ⎟ = m ⎜
dVp
⎟=m
dt ⎝ dt ⎠ dt ⎝ dt ⎠ dt
G
Vp
Moreover dm
G G G dS
∫V ρ A g dV = g V∫ ρ AdV = mg dV
m
G G G
∫ F dS = Aerodynamic
S
NX + XT
N
Thrust force
force
Hence G
dVp G G G
m = mg + X + X T
dt
A Standard Result :
G G
dA ∂A G G
= + ω ×A
dt Equivalent
in inertial
∂t As seen
in rotating
frame frame
G
where ω : Angular velocity of rotating frame wrt. inertial frame.
G
A : Any vector
Hence the force equation in body frame becomes :
G
⎛ ∂Vp ⎞ G G G G G
m⎜ ⎟ + ω × Vp = mg (
+ X + XT
)
⎝ ∂t ⎠ B Forced applied in
rotating (body) frame
ADVANCED CONTROL SYSTEM DESIGN 25
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Force Equation (body frame)
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
G G
ω = [ P Q R] ,
T
( )
Vp = [U V W ]
B
T
G G
X = [X Y Z] , X T = [ X T YT ZT ]
T T
G
g = [ g X gY g Z ]
T
Y
i j k
G G
( )
ω × Vp = P Q R
U V W X
Z
= i ( QW − VR ) − j ( PW − UR ) + k ( PV − UQ )
ADVANCED CONTROL SYSTEM DESIGN 26
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Force Equation (body frame)
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
m (U − VR + WQ ) = mg X + ( X + X T )
m (V + UR − WP ) = mgY + (Y + YT )
m (W − UQ + VP ) = mg Z + ( Z + ZT )
where g X = − g sin Θ
mg cos Θ
gY = g cos Θ sin Φ
g Z = g cos Θ cos Φ
Note: The gravity components can also be
Formally derived from Euler angle definitions.
ADVANCED CONTROL SYSTEM DESIGN 27
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Moment Equation
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
G
d ⎡ G ⎛ dr ⎞ ⎤ G G
⎢∫ r × ⎜ ⎟ ρ A dV ⎥ = ∫ r × F ds
dt ⎣V ⎝ dt ⎠
⎦ S
G G
d G ⎛ dr ⎞ d ⎛ G ⎛ dr ⎞⎞
∫ r ×⎜
dt V ⎝ dt ⎠
⎟ ρ A dV = ∫ ⎜ r × ⎜
V
⎟ ⎟ ρ A dV
dt ⎝ ⎝ dt ⎠ ⎠
⎛ G G G ⎞
⎜⎛ dr ⎞ ⎛ dr ⎞ G d ⎛ dr ⎞⎟
= ∫⎜⎜ ⎟×⎜ ⎟+ r× ⎜ ⎟ ⎟ ρ A dV
V ⎜⎝ ⎠ ⎝ ⎠ ⎝ ⎠⎟
dt
dt
dt dt
⎝ =0 ⎠
G d ⎛ G G G ⎞
= ∫ r × ⎜ rN + ω × r ⎟ ρ A dV
V
dt ⎝ =0 ⎠
G
d G ⎛ dr ⎞ G ⎛∂ G G G G G ⎞
∫ r ×⎜ ⎟ ρ A dV = ∫ r × ⎜ (ω × r ) + ω × (ω × r ) ⎟ ρ A dV
dt V ⎝ dt ⎠ V ⎝ ∂t ⎠
G ⎛ ⎛ G G G G ⎞ G G G ⎞
= ∫ r × ⎜ ⎜ ω × r + ω × rN ⎟ + ω × (ω × r ) ⎟ ρ A dV
V ⎝⎝ =0 ⎠ ⎠
∫
V
G
((
G G G G G
)
= r × ω × r + ω × (ω × r ) ρ dV ) A
Standard Results :
G G G G G G G G G ⎤
( )
∫V r × ω × r ρ A dV = V∫ ⎣ω ( r ⋅ r ) − r r ⋅ ω ⎦ ρ A dV
⎡ ( )
G G G G G G G G G G G
V
∫ r × (ω × (ω × r ) ) ρ A dV = ∫ r × ⎡⎣ω (ω ⋅ r ) − r (ω ⋅ ω )⎤⎦ ρ A dV
V
G G G G
= ∫ r × ω (ω ⋅ r ) ρ A dV
V
However,
G
r = [ x y z ] (in body frame)
T
G
ω = [ P Q R]
T
G G G G G G G G G ⎤
( )
∫ r × ω × r ρ A dV = ∫ ⎣ω ( r ⋅ r ) − r r ⋅ ω ⎦
⎡ ρ A dV
( )
V V dm
G 2 G G G
= ω ∫ r dm − ∫ r r ⋅ ω dm ( )
V V
= ⎡⎣ P Q R ⎤⎦ ∫(x + y + z ) dm
T
2 2 2
−[x y z]
T
∫ ( + yQ + zR ) dm
xP
V
⎡ ⎤
⎢ ⎥
⎢ P ∫ ( y 2 + z 2 ) dm − Q ∫ xy dm − R ∫ xz dm ⎥
⎢ V ⎥
⎢
V
V
⎥
I xx I xy I xz
G G G ⎢ ⎥
∫V r (
× ω × r )
ρ A dV = Q ( x 2 + z 2 ) dm − P yx dm − R yz dm ⎥
⎢ V∫
⎢ ∫V ∫V ⎥
⎢
I yy
I yx
I yz
⎥
⎢ ⎥
⎢ R ( x 2 + y 2 ) dm − P zx dm − Q zy dm ⎥
⎢ V∫ ∫V ∫V ⎥
⎢
⎥
⎣ I zz I zx I zy ⎦
ADVANCED CONTROL SYSTEM DESIGN 33
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Moment Equation
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
⎡ I xx P − I xy Q − I xz R ⎤
G G G ⎢ ⎥
( )
∫V r × ω × r ρ A dV = ⎢ I yyQ − I yx P − I yz R ⎥
⎢ I zz R − I zx P − I zy Q ⎥
⎣ ⎦
Similarly
G G G G G G G G
∫ (
V
r × ω × ( ω × r ) ) A
ρ dV = ∫ × ω (ω ⋅ r ) ρ A dV
r
V
⎡ I xx PR + I yz ( R 2 − Q 2 ) − I xz PQ + ( I zz − I yy ) RQ ⎤
⎢ ⎥
= ⎢ ( I xx − I zz ) PR + I xz ( P 2 − R 2 ) − I xy QR + I yz PQ ⎥
⎢ ⎥
⎢( I yy − I xx ) PQ + I xy ( Q 2 − P 2 ) + I xz QR − I yz PR ⎥
⎣ ⎦
I xy = I yz = 0
z Note: Missiles and launch vehicles are
typically symmetric about both XZ-plane as
well as XY-plane
I xy = I yz = I zx = 0
ADVANCED CONTROL SYSTEM DESIGN 35
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Moment Equation
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
G
Aero Moment: M A = [ L M N ]
T
G
Thrust Moment: M T = [ LT M T NT ]
T Q
I xx P − I xz R − I xz PQ + ( I zz − I yy ) RQ = L + LT
I yy Q + ( I xx − I zz ) PR + I xz ( P 2 − R 2 ) = M + M T
I zz R − I xz P + ( I yy − I xx ) PQ + I xz QR = N + NT
ADVANCED CONTROL SYSTEM DESIGN 36
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Force and Moment Equations
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
I xx P − I xz R − I xz PQ + ( I zz − I yy ) RQ = L + LT
I yy Q + ( I xx − I zz ) PR + I xz ( P 2 − R 2 ) = M + M T
I zz R − I xz P + ( I yy − I xx ) PQ + I xz QR = N + NT
ADVANCED CONTROL SYSTEM DESIGN 37
Dr. Radhakant Padhi, AE Dept., IISc-Bangalore
Force and Moment Equations
Ref: Roskam J., Airplane Flight Dynamics and Automatic Controls, 1995
1
U = VR − WQ − g sin Θ + ( X + X T )
m V
1
V = WP − UR + g sin Φ cos Θ + (Y + YT )
Q
m
1
W = UQ − VP + g cos Φ cos Θ + ( Z + ZT )
U R
m P W
P = c1QR + c2 PQ + c3 ( L + LT ) + c4 ( N + NT )
Q = c5 PR − c6 ( P 2 − R 2 ) + c7 ( M + M T )
R = c8 PQ − c2QR + c4 ( L + LT ) + c9 ( N + NT )
where
⎡ ⎤
c 1 ⎡ Izz ( Iyy − Izz ) − Ixz
2
⎤ c5 = I zz − I xx ) / I yy
⎢c 2 ⎥ ⎢ ⎥
xz ( Izz + Ixx − Iyy )
⎢ ⎥ ⎢ I ⎥ c6 = I xz / I yy
⎢c 3 ⎥ ⎢ Izz ⎥
1 c7 = 1/ I yy
⎢ ⎥= ⎢ ⎥
⎢c 4 ⎥ ( IxxIzz − Ixz ) ⎢ Iyz
2
⎥
⎢c8 ⎥ ⎢ Ixx ( Ixx − Iyy ) + Ixz 2 ⎥
⎢ ⎥ ⎢ ⎥
⎣c 9 ⎦ ⎢⎣ Ixx ⎥⎦
( ) ( )
N N N
X T = ∑ Ti cos ΦTi cos Ψ Ti LT = − ∑ Ti cos ΦTi sin Ψ Ti zTi − ∑ Ti sin ΦTi yTi
i =1 i =1 i =1 Ti = Timax ⋅ σ Ti
( ) ( )
N N N
YT = ∑ Ti cos ΦTi sin ΨTi M T = ∑ Ti cos ΦTi cos Ψ Ti zTi + ∑ Ti sin ΦTi xTi
i =1 i =1 i =1
( ) ( )
N N N
ZT = − ∑ Ti sin ΦTi NT = − ∑ Ti cos ΦTi cos Ψ Ti yTi + ∑ Ti cos ΦTi sin Ψ Ti xTi
i =1 i =1 i =1
⎛ CDi ⎤ ⎡ 1 ⎤ ⎡CDδ ⎤ ⎟⎞
⎡X ⎤ ⎡Xs ⎤ ⎜ ⎡CDO CDα
⎢ Z ⎥ = T (α ) ⎢ Z ⎥ = T (α )( − qS ) ⎜ ⎢ C ⎥ ⎢⎢α ⎥⎥ + ⎢ ⎥δE ⎟
h E
⎣ ⎦ ⎣ s⎦ ⎜ ⎢⎣ LO CLα CLi ⎥ ⎢ Lδ ⎥ ⎟
C
⎝
h ⎦ ⎢
⎣ ih ⎥⎦ ⎣ E ⎦ ⎠
⎣ ⎦ ⎢⎣ nδ A Cnδ ⎥ ⎣δ R ⎦ ⎟
⎣ s⎦ ⎝ ⎢⎣ nβ ⎥⎦ R ⎦ ⎠
⎛ ⎡δ ⎤ ⎞
Y = qS CY = qS ⎜ CYβ β + ⎡CYδ CYδ ⎤ ⎢ A ⎥ ⎟
⎣ A R ⎦
⎣δ R ⎦ ⎠
⎝
⎡cos α − sin α ⎤
Cmi ⎤ [1 α ih ] + Cm δ δ E T (α ) ⎢
M = qSc Cm = qSc ⎡Cmo cos α ⎥⎦
T
⎣ sin α
Cmα
⎣ h ⎦ E