Design of Non Linear Dynamic Inversion Controller For Trajectory Following
Design of Non Linear Dynamic Inversion Controller For Trajectory Following
Ramakalyan Ayyagari
Narasimhan Sundararajan
Prof. (retd), School of Electrical & Electronic Engineering
Nanyang Technological University, Singapore 639798
[email protected]
AbstractThis paper presents the design of a robust linear
controller that can be used for trajectory following and
maneuvering of fixed-wing aircraft using Nonlinear Dynamic
Inversion (NDI) principles. The design addresses control
coupling to exploit multiple redundant controls. It can also be
easily extended to state decoupling. The design procedure
exploits the nature of the equations of motion written in the wind
axis resulting in a cascaded linear controller structure with inner
and outer loops. A systematic methodology is evolved which uses
only the relevant stability and control derivatives in the control
synthesis, as opposed to the inversion of the complete nonlinear
equations used in conventional NDI designs. The tuning of the
control gains is based on the requirements of adequate trajectory
following and robustness to control surface failures. Finally, it is
shown how a series of controllers can be derived depending on
the sensor complement available on the aircraft. The proposed
approach is ideal for fixed-wing Unmanned Aerial Vehicles
(UAVs).
KeywordsNonlinear Dynamic Inversion, , fixed-wing aircraft,
trajectory following, unmanned ariel vehicle
I.
INTRODUCTION
B. Equations of Motion
Under the rigid body assumption, the equations of motion
have been taken from [16]. The roll rate and yaw rate have
been transformed into stability axes for the purpose of
developing the control laws based on dynamic inversion.
AIRCRAFT CHARACTERISTICS
A. Aircraft Dynamics
The aircraft model used in this study is that of a high
performance fighter aircraft. Details of the model can be found
in [14]. For the purpose of this study, the elevator and aileron
control surface aerodynamic data has been split into two parts
corresponding to left and right surface using CFD
computations [15]. The aerodynamic model also contains a
ground effect model. The aircraft has two elevators (-25 to +25
deg deflections), which can be moved together or in differential
mode. It also has a pair of ailerons (-20 to +20 deg deflection),
and a rudder (-30 to +30 deg deflection). The engine model
(without dynamics) completes the six-degree of freedom
simulation model.
The aircraft has hydraulic actuators, which drive the
primary control surfaces that are modeled as first order lags
with a time constant of 50 msec. The rate limits for the
Rotational Equations:
0 r q p l a lT
p
q = I 1 r 0 p I q + m + m
a T
q p 0 r n n
r
a T
(1)
= rs +
(L mg cos cos )
mVcos
g
Q
sin cos
V
mV
(2)
(3)
(4)
(5)
(6)
L sin
T (cos sin cos + sin sin )
+
mV cos
mVcos
Q cos
mV cos
(7)
=
=
Navigational Equations:
x = V cos cos
(8)
y = V cos sin
(9)
h = V sin
(10)
where,
p s cos
r =
s sin
sin p
p
=T
cos r
r
(11)
(12)
where,
y = [ q p r ]T
(13)
]T
(14)
(18)
y = [ q ps rs ]T
(19)
(20)
I
y = 33
0 2 3
(21)
03 2
y = T2 y
T 1
1 - K aei
1 K
aei
u= 0
-1
0
1
0 K ari
- K rei
K rei
0 u = Su
0
1
(22)
0.0029
0.8145 0.6491 0.0066 0
A= 0
0.0003 14.1548 1.7533 0.8792
0
0.0025
1.8847 0.0482 0.2424
(15)
(16)
T1x = T2 y + BSu
(23)
(24)
(25)
(26)
(27)
q
(34)
ps
(35)
(28)
q =
Kq
16.7
(qcmd q)
(29)
16.7
= 0.16 s
105
(30)
pitch K q (qcmd q)
(31)
roll K ps ( p scmd p s )
(32)
yaw K rs (rscmd rs )
(33)
rs +
(36)
(37)
p scmd = K mu ( cmd )
(38)
(39)
( L mg ) q SC L
( trim )
mV
mV
(41)
L g
mV V
(42)
bvthr =
V
thr
(43)
thr =
cmd
1
bvthr
[K vel (Vcmd V ) + g ]
mV
=
K gam ( cmd ) + trim
q SC L
cmd =
V
K chi ( cmd )
g
(44)
(45)
(46)
(51)
n y = n
(52)
y V ( cmd )
(47)
h V
(48)
( cmd ) =
cmd
1
K y ( ycmd y )
V
1
= K h (hcmd h)
V
(49)
(50)
[1]
[2]
[4]
[5]
[6]
[7]
[8]
[9]
Z (Km)
[3]
0.5
0
0
-2
-4
-6
-8
X (Km)
-10
1
0
2
Y (Km)
50
100
10
150
100
50
100
-10
150
50
100
50
100
80
70
150
50
100
150
2
az (g's)
20
0
-20
0
50
100
Time (sec)
150
200
0
0
50
100
150
50
100
150
50
100
150
50
100
Time (sec)
20
60
40
20
0
0.4
400
150
Throttle (percent)
-20
40
90
1 2 3 4 5
600
150
VT (m/s)
el (deg)
50
Thrust (KN)
20
er (deg)
10
(deg)
(deg)
20
-20
ax (g's)
-10
20 1 2 3 4 5 6
(deg)
Q (deg/s)
10 1 2 3 4 5 6
Altitude (Km)
50
100
Time (sec)
150
0.2
150
50
100
0
-10
150
50
100
-500
150
r (deg)
al (deg)
50
100
ar (deg)
d/dt (deg/s)
0
50
100
Time (sec)
ay (g's)
0
150
50
100
150
50
100
50
100
150
0
-0.5
150
0
-20
-5
-10
0.5
20
150
20
-20
-0.5
150
20
-20
100
X (Km)
0
-50
50
500
, (deg)
(deg)
50
50
100
150
-5
0
5
Y (Km)
10
10
Z (Km)
-50
0.5 1 2 3 4 5 6
(deg)
10 1 2 3 4 5 6
R (deg/s)
P (deg/s)
50 1 2 3 4 5 6
0
-10
50
100
Time (sec)
0.6
0.4
0.2
0
20
0
X (Km) -20 -5
150
0
Y (Km)
0
-50
-100
50
100
-50
-50
50
100
0
-50
-100
150
100
50
50
0
-50
0
800
800
600
600
600
200
0
-1
0
ug (m/s)
400
200
0
-1
0
vg (m/s)
50
100
150
50
100
150
Time (sec)
-50
800
400
-100
50
100
150
Time (sec)
50
100
-100
50
100
150
Time (sec)
Altitude (m)
Altitude (m)
dal/dt (deg/s)
Altitude (m)
del/dt (deg/s)
50
-100
150
100
-100
50
dt/dt (%/s)
50
100 1 2 3 4 5 6
dr /dt (deg/s)
100 1 2 3 4 5 6
dar/dt (deg/s)
der/dt (deg/s)
100 1 2 3 4 5 6
400
200
0
-1
0
wg (m/s)
Fig. 6 Actuator rates as function of time and wind profile as function of altitude