Beruflich Dokumente
Kultur Dokumente
Modes of motion
Longitudinal
Lateral-directional
Copyright 2010 by Robert Stengel. All rights reserved. For educational use only.
http://www.princeton.edu/~stengel/MAE331.html
http://www.princeton.edu/~stengel/FlightDynamics.html
for t in [t o ,t f ]
x : dynamic state
u : control input
w : disturbance input
Differences in initial
condition and forcing ...
'%
( in *+t o ,t f ,)%
Approximate Neighboring
Trajectory as a Linear Perturbation
to the Nominal Trajectory
x! N (t) = f[x N (t), u N (t), w N (t),t]
x! (t) = x! N (t) + !!x(t) = f[x N (t) + !x(t), u N (t) + !u(t), w N (t) + !w(t),t]
#f
#f
#f
!x(t) +
!u(t) +
!w(t)
#x
#u
#w
F(t) =
!f
!x
x = x N (t )
u= u N (t )
w = w N (t )
" ! f1
! f1
$
! x1 !
! xn
$
=$ !
!
!
$ ! fn
! fn
$
! x1 !
! xn
#
%
'
'
'
'
' x = x (t )
& u= uNN (t )
!f
! u xu== xuNN (t(t )) dim(G) = n ! m
w = w N (t )
L(t) =
!f
!w
dim(F) = n ! n
w = w N (t )
x = x N (t )
u= u N (t )
w = w N (t )
!!x(t) "
dim(x) = n ! 1
dim(u) = m ! 1
dim(w) = s ! 1
dim(!x) = n " 1
dim(!u) = m " 1
dim(!w) = s " 1
!f
!x
x = x N (t )
u= u N (t )
w = w N (t )
; G(t) =
!f
! u xu== xuNN (t(t ))
; L(t) =
w = w N (t )
!f
!w
x = x N (t )
u= u N (t )
w = w N (t )
to < t < t f
How Is System
Response Calculated?
Linear and nonlinear, time-varying and timeinvariant dynamic models
dim(L) = n ! s
Given
Integration Algorithms
x(t 0 )
u(t), w(t) for t in [t o ,t f ]
Path is approximated by executing a numerical algorithm
# x(t k!1 ) + f [ x(t k!1 ),u(t k!1 ),w(t k!1 )] "t , "t = t k ! t k!1
where
1
[#x1 + #x 2 ]
2
Linear Approximation of
Perturbation Dynamics
$
& dt '
&
%
! x1 (t) $
& in ! 0,t f $
# N
"
%
# x2 N (t) &
%
"
! x1 = 0;
! f1
! f1
! x2 = 1
! f2
! x2 = "1
! f2
! u = 0;
! u = 0;
! f1
! f2
!w = 0
!w = 0
NTI
! x1 (0) $ !
$
& = # 0 &;
# N
# x2 N (0) & " 9 %
%
"
x N (t)
!x(t)
x N (t) + !x(t)
x(t)
Initial Conditions
x2 N (0) = 9
! 'x1 (0) $ ! 0 $
&=#
#
&
#" 'x2 (0) &% " 1 %
LTV
Initial
Conditions
!x2 (0) = 1
x2 (t) = 10
x! N (t)
!!x(t)
x! N (t) + !!x(t)
x! (t)
Suppose xN (0) = 0
Nominal solution remains at equilibrium
x! N (t) = f[x N (t)], x N (0) = 0, x N (t) = 0 in [ 0, ! ]
%
'
'&
Separation of the
Equations of Motion into
Longitudinal and LateralDirectional Sets
Grumman F9F
Rigid-Body Equations of
Motion (Scalar Notation)
State Vector
{ (
)
)
) r + "# I
})
q! = "# M ! ( I xx ! I zz ) pr ! I xz p 2 ! r 2 $% I yy
{ (
r! = I xz L + I xx N ! I xz I yy ! I xx ! I zz
2
xz
})
+ I xx I xx ! I yy $% p q I xx I zz ! I xz2
)
)
!
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
"
x1 $
& !
x2 & #
x3 & #
& #
x4 & #
& #
x5 & #
x6 & #
&=#
x7 & #
& #
x8 & #
x9 & #
& #
x10 & #
x11 & #
& #
x12 & "
%
u
v
w
x
y
z
p
q
r
'
(
)
$
&
&
&
&
&
&
&
&
&
&
&
&
&
&
&
&
%
Longitudinal, Lateral-Directional
State Vector
Longitudinal
Equations of Motion
= x!1 = f1
= x!2 = f2
x! I = ( cos" cos$ ) u + ( ! cos # sin $ + sin # sin " cos$ ) v + ( sin # sin $ + cos # sin " cos$ ) w = x! 3 = f3
q! = %& M ! ( I xx ! I zz ) pr ! I xz p 2 ! r 2 '( I yy
"! = q cos # ! r sin #
x1 $
&
x2 &
x3 &
&
x4 &
&
x5 &
! x Lon
x6 &
& =#
x7 &
#" x Lat ' Dir
&
x8 &
x9 &
&
x10 &
x11 &
&
x12 &
% new
!
#
#
#
#
#
#
$ #
&=#
&% #
#
#
#
#
#
#
#
"
u
w
x
z
q
(
v
y
p
r
)
*
$
&
&
&
&
&
&
&
&
&
&
&
&
&
&
&
&
%
Lateral-Directional
Equations of Motion
!
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
"
= x! 4 = f4
= x!5 = f5
= x!6 = f6
y! I = ( cos" sin $ ) u + ( cos ! cos$ + sin ! sin " sin $ ) v + ( # sin ! cos$ + cos ! sin " sin $ ) w
(
r! = ( I L + I
{ (
N # {I ( I
)
) r + %& I
(
(I
) }) (
)'( p} q ) ( I
xx
xz
yy
# I xx # I zz
2
xz
+ I xx
xx
# I yy
I # I xz2
xx zz
)
)
= x! 7 = f7
= x!8 = f8
= x!9 = f9
= x!10 = f10
= x!11 = f11
= x!12 = f12
Sensitivity to
Control Inputs
% " ! f1
! f1
! x12 ' $
!u
!w
' $
! f2
!
f
!
f2
' $
2
...
! x12 ' = $
!u
!w
' $
...
...
...
...
' $
! f12
! fn
' $ ! f12
...
!u
!w
! x12 ' $
& #
...
! f1
%
!( '
'
! f2
'
...
!( '
'
...
...
'
! f12
'
...
!( '
&
...
! f1
" F
Lon
F = $ Lat ! Dir
$ FLon
#
Effects of longitudinal perturbations
on lateral-directional motion
! E(t)
! T (t)
! F(t)
! A(t)
! R(t)
! SF(t)
%
'
'
'
'
'
'
'
'&
#
%
%
%
!u(t) = %
%
%
%
%$
!" E(t)
!" T (t)
!" F(t)
!" A(t)
!" R(t)
!" SF(t)
&
(
(
(
(
(
(
(
('
Effects of lateral-directional
perturbations on longitudinal motion
Lon
%
FLat
! Dir
'
FLat ! Dir '
&
%
G Lon
Lat ! Dir
'
G Lat ! Dir '
&
" G
Lon
G = $ Lat ! Dir
$ G Lon
#
x! Lat ! DirN = 0
Decoupling
Approximation for
Small Perturbations
x Lat ! DirN = 0
M
I yy
"!N = qN
!
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
#
"
x1 $
&
x2 &
x3 &
&
x4 &
&
x5 &
! x Lon
x6 &
& =#
x7 &
#" x Lat ' Dir
&
x8 &
x9 &
&
x10 &
x11 &
&
x12 &
%N
$
&
&%
N
!
#
#
#
#
#
#
#
=#
#
#
#
#
#
#
#
#
"
uN $
&
wN &
xN &
&
zN &
&
qN &
(N &
&
0 &
0 &
&
0 &
0 &
0 &
&
0 %
0 = Z / m + g cos" N + qN u N
"
$
$
$
$
$
$
$
#
M
I yy
0 = qN
" uTrim
%
$
'
$ wTrim
'
$ V (t
'
$ N
=
'
$ zN
'
$
'
$ 0
! '&Trim $ !Trim
#
u
w
x
z
q
!x Lon
!u Lon
# !" T &
= %% !" E ((
%$ !" F ('
!w Lon
" !uwind
$
= $ !wwind
$ !q
wind
#
block diagonal
constant, i.e., linear, time-invariant (LTI)
decoupled into two separate (6 x 6) systems
" FLon
F=$
$# 0
%
0
'
FLat ! Dir '
&
" G Lon
G=$
$# 0
%
0
'
G Lat ! Dir '
&
" L Lon
L=$
$# 0
%
0
'
L Lat ! Dir '
&
!!x Lat " Dir (t) = FLat " Dir !x Lat " Dir (t) + G Lat " Dir !u Lat " Dir (t) + L Lat " Dir !w Lat " Dir (t)
!!x Lon (t) = FLon !x Lon (t) + G Lon !u Lon (t) + L Lon !w Lon (t)
!x1 %
" !u %
'
'
$
!x2 '
$ !w '
'
!x3
' = $ !x '
$ !z '
!x4 '
'
$
'
$ !q '
!x5 '
$ !( '
&
#
!x6 '
& Lon
%
'
'
'
'
'
'
'
'
&
(6 x 6) LTI Lateral-Directional
Perturbation Model
(6 x 6) LTI Longitudinal
Perturbation Model
"
$
$
$
=$
$
$
$
$
#
0 = X / m ! g sin " N ! qN wN
%
'
'
'
&
#
%
%
%
=%
%
%
%
%
$
!x1 &
# !v
(
%
!x2 (
% !y
(
% !p
!x3
(
=%
!x4 (
% !r
(
% !)
!x5 (
%
!*
(
!x6
' Lat " Dir %$
&
(
(
(
(
(
(
(
('
$ !# A '
!u Lat " Dir = && !# R ))
&% !# SF )(
" !vwind
$
!w Lon = $ !pwind
$ !r
wind
#
%
'
'
'
&
Fourier Transform of
a Scalar Variable
Frequency Domain
Description of LTI
System Dynamics
% !x(t)e
# j" t
#$
!x(t)
A : amplitude
! : phase angle
Laplace Transform of
a Scalar Variable
s = ! + j"
= Laplace (complex) operator, rad/s
Laplace Transforms of
Vectors and Matrices
Laplace transform of a vector variable
" !x1 (s) %
'
$
L [ !x(t)] = !x(s) = $ !x2 (s) '
$
... '&
#
Laplace Transform of
a Dynamic System
Laplace Transform of
a Dynamic System
System equation
dim(!x) = (n " 1)
dim(!u) = (m " 1)
dim(!w) = (s " 1)
"1
Characteristic Polynomial
of a LTI Dynamic System
!x(s) = [ sI " F ]
"1
Modes of Motion
[ sI ! F ]!1 =
Adj ( sI ! F )
(n x n)
sI ! F
Longitudinal
Modes of Motion
!!x Lon (t) = FLon !x Lon (t) + G Lon !u Lon (t) + L Lon !w Lon (t)
!i = " i + j# i
)(
)(
Complex conjugate
)(
)(
)(
s Plane
Longitudinal
Modes of Motion
)(
! Lon (s) = ( s " #ran ) s " #hgt s 2 + 2$ P% nP s + % n2P s 2 + 2$ SP% nSP s + % n2SP = 0
! *i = " i # j$ i
)(
= s " #range s " #height s " # phugoid s " # *phugoid s " #short period s " # *short period
(# ,$ ) : phugoid mode
(# ,$ ) : short - period mode
P
SP
nP
Lateral-Directional
Modes of Motion
!!x Lat " Dir (t) = FLat " Dir !x Lat " Dir (t) + G Lat " Dir !u Lat " Dir (t) + L Lat " Dir !w Lat " Dir (t)
! LD (s) = ( s " #1 ) ( s " #2 ) (...) ( s " #6 ) = 0
)(
)(
)(
= s " #crossrange s " #heading s " #spiral ( s " #roll ) s " # Dutch roll s " # *Dutch roll
nSP
! LD (s) = ( s " #cr ) ( s " #head ) ( s " #S ) ( s " # R ) s 2 + 2$ DR% nDR s + % n2DR = 0
Lateral-Directional
Modes of Motion
Lateral-directional characteristic
equation has 6 eigenvalues
2 eigenvalues normally appear as a
complex pair
Crossrange and heading modes
usually inconsequential
(#
DR
Next Time:
Longitudinal Dynamics
Supplemental
Material
G(t) =
!f
!x
x = x N (t )
u= u N (t )
w = w N (t )
; G(t) =
w = w N (t )
Control-effect matrix
!f
! u xu== xuNN (t(t ))
w = w N (t )
" ! f1
! f1
$
! u1
! u2
$
! f2
$ ! f2
! u1
! u2
=$
$
...
...
$
! fn
$ ! fn
! u1
! u2
$#
%
! um '
'
! f2
'
...
! um '
'
...
...
'
! fn
'
...
! um ' x = x N (t )
& u= uN (t )
...
!f
! u xu== xuNN (t(t ))
!f
!w
x = x N (t )
u= u N (t )
w = w N (t )
Disturbance-effect matrix
! f1
w = w N (t )
; L(t) =
L(t) =
!f
!w
x = x N (t )
u= u N (t )
w = w N (t )
" ! f1
! f1
$
! w1
! w2
$
! f2
$ ! f2
! w1
! w2
=$
$
...
...
$
! fn
$ ! fn
! w1
! w2
$#
%
! ws '
'
! f2
'
...
! ws '
'
...
...
'
! fn
'
...
! ws ' x = x N (t )
& u= uN (t )
...
! f1
w = w N (t )
!f
!f
G(t) =
x = x N (t )
! u xu== xuNN (t(t ))
! x u= uN (t )
L(t) =
w = w N (t )
w = w N (t )
!f
!w
x = x N (t )
u= u N (t )
w = w N (t )
Numerically
First differences in f(x,u,w)
Analytically
Symbolic evaluation of analytical
models of F, G, and L
&
# ( x ) "x )
1
(
% 1
(
%
x2
)
f
( 1%
!
(
%
(
%
xn
'
$
2"x1
&
(
(
(
(
(
'
#
x1
%
% ( x + "x2 )
f1 % 2
!
%
%
xn
$
&
#
x1
(
%
(
% ( x2 + "x2 )
)
f
( 1%
!
(
%
(
%
xn
'
$
2"x2
&
(
(
(
(
(
'
&
# ( x ) "x )
1
(
% 1
(
%
x2
)
f
2
(
%
!
(
%
(
%
xn
'
$
2"x1
&
(
(
(
(
(
'
#
x1
%
% ( x + "x2 )
f2 % 2
!
%
%
xn
$
&
#
x1
(
%
(
% ( x2 + "x2 )
)
f
2
(
%
!
(
%
(
%
xn
'
$
2"x2
&
(
(
(
(
(
' !
!
&
# ( x ) "x )
1
(
% 1
(
%
x2
( ) fn %
!
(
%
(
%
xn
'
$
2"x1
!
&
(
(
(
(
(
'
#
x1
%
x2
%
f1 %
!
%
% ( xn + "xn )
$
&
(
(
(
(
(
'
&
#
x1
(
%
x2
(
%
)
f
( 1%
!
(
%
(
% ( xn + "xn )
'
$
2"xn
#
x1
%
x2
%
fn %
!
%
% ( xn + "xn )
$
!
&
#
x1
(
%
x2
(
%
( ) fn %
!
(
%
(
% ( x + "xn )
'
$ n
2"xn
&
(
(
(
(
(
'
&
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(
(x=x N (t)
'u=uN (t)
w=w N (t)
Matrix Inverse
Matrix Inverse
A = a; A !1 =
dim(A) = (1 ! 1)
y = Ax; x = A !1y
[A]
!1
Adj( A ) Adj( A )
=
=
A
det A
(n " n)
(1 " 1)
CT
=
; C = matrix of cofactors
det A
dim(x) = dim(y) = (n ! 1)
dim(A) = (n ! n)
1
a
dim(A) = (2 ! 2)
! a11 a12
A=#
#" a21 a22
! a22 'a21 $
! a22 'a12 $
&
&
#
#
$
# 'a12 a11 &%
# 'a21 a11 &%
& ; A '1 = "
="
a11a22 ' a12 a21
a11a22 ' a12 a21
&%
T
! a11 a12
#
A = # a21 a22
# a
a32
" 31
a13
a23
a33
dim(A) = (3 ! 3)
Sensitivity to
Disturbance Inputs
uw (t) $
&
ww (t) &
qw (t) &
&
vw (t) &
&
pw (t) &
rw (t) &
%
Axial wind, m / s
Normal wind, m / s
Pitching wind shear, deg / s or rad / s
Lateral wind, m / s
Rolling wind shear, deg / s or rad / s
Yawing wind shear, deg / s or rad / s
"
$
$
$
!w(t) = $
$
$
$
$
#
!uw (t) %
'
!ww (t) '
!qw (t) '
'
!vw (t) '
'
!pw (t) '
!rw (t) '
&
" L
Lon
L = $ Lat ! Dir
$ L Lon
#
Effects of longitudinal disturbances
on lateral-directional motion
Effects of lateral-directional
disturbances on longitudinal motion
%
LLon
Lat ! Dir
'
L Lat ! Dir '
&
Effects of lateral-directional disturbances
on lateral-directional motion