Professional Documents
Culture Documents
PID Parameter Optimization of An UAV Longitudinal Flight Control System
PID Parameter Optimization of An UAV Longitudinal Flight Control System
PID Parameter Optimization of An UAV Longitudinal Flight Control System
net/publication/259801570
CITATIONS READS
24 638
4 authors, including:
Elbrous M Jafarov
Istanbul Technical University
73 PUBLICATIONS 595 CITATIONS
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
Turbulence And The Aerodynamic Optimisation Of Nonplanar Lifting Systems View project
All content following this page was uploaded by Melike Nikbay on 23 December 2014.
optimality, optimum PID parameters have been obtained and transmission system for stability analysis [5], least squared
implemented in control system dynamics. error FIR filter design [6], optimal gain scheduling controller
for a diesel engine [7], limitations on maximal tracking
Keywords—Optimum Design, KKT Conditions, UAV, accuracy [8], mapping error of linear dynamic systems caused
Longitudinal Flight Dynamics, ISE Parameter Optimization.
by reduced-order model [9]; besides, there are very limited
amount of applications in literature related with ISE
I. INTRODUCTION
parametric optimization on aircrafts / UAVs. As a matter of
N recent years, development of feasible techniques for on-
I board mission management systems for Unmanned Aerial
Vehicles (UAVs) has been seriously taken into account. From
fact, in many control applications in order to find an optimal
solution for a given problem, optimal control theory is widely
used, but in this case specifically parameter optimization is
that point, existing UAV systems are generally guided necessary and will be conducted through ISE parameter
remotely, which helps to control the flight trajectory of UAV optimization technique.
by an integrated on-board auto pilot. Existing areas of use of In the first part of the paper, longitudinal dynamic modeling
UAVs are mainly concentrated on reconnaissance missions, of an UAV will be presented. In the second part, mathematical
observation, border security, combat missions etc. Moreover, background behind the ISE parameter optimization technique
there are some existing research projects dealing with a will be given. In the third section, closed-loop time domain
variety of possible applications of UAVs such as uninhabited results will be presented to complete the work.
combat aircraft, intervention rotorcraft, road traffic
surveillance, pursuit, search and rescue helicopters, power II. LONGITUDINAL DYNAMICS OF AN UAV
cable inspection UAVs or forest fire surveillance aircraft [1].
Before getting into the control system design, longitudinal
During all of these missions UAVs are expected to be fault
flight characteristics should be analyzed. For this purpose,
tolerant, to work in high precision, to be able to coordinate the
Equations of Motion (EoMs) governing the longitudinal
coupling effects within the system dynamics and to have high
flight, taken from [10], have been used for analysis as given in
maneuverability, and in order to be able to accomplish all of
(1), where the first two are force equations in x and z
the desired performance characteristics, high fidelity in
directions, respectively, while M is the moment equation in y
dynamic modeling should be achieved, where efficient control
direction.
system design providing optimum performance limits should
be accomplished. mu
x: ( s C X u ) ' u ( s ) C X D 'D ( s ) C W (cos 4)T ( s ) 0
In that sense, in this paper, an automatic control system Sq
design for longitudinal flight dynamics based on Integral
ª mu c . C ZD º
Squared Error (ISE) parameter optimization technique has z: C ZU ' u ( s) «( ) s C zD » 'D ( s ) (1)
¬ Sq 2u ¼
K. Turkoglu was with Istanbul Technical University, Istanbul, TURKEY. ª mu c . C Zq º
(Phone:1-646-301-6137; fax:1-612-626-1558; e-mail: kamran@aem.umn.edu) «( ) s CW sin 4» T ( s ) 0
U. Ozdemir is with Istanbul Technical University, Istanbul, TURKEY. ¬ Sq 2 u ¼
(e-mail: ugur.ozdemir@itu.edu.tr).
M. Nikbay is with Istanbul Technical University, Istanbul, TURKEY. (e- c . C mD I y 2 c .C M q
mail: nikbay@itu.edu.tr).
M: ( s C M D )'D ( s ) ( s s )T ( s ) 0
2u Sqc 2u
E. M. Jafarov is with Istanbul Technical University, Istanbul, TURKEY.
(e-mail: cafer@itu.edu.tr)..
m mass 5 [kg]
U0 steady state velocity 12 [m/sec]
g gravitational force 9.807 [m/sec2]
S wing area 0.4205 [m2]
Svertical tail vertical tail wing area 0.1323 [m2]
ȡ air density 1.226 [kg/m3]
Iyy moment of inertia 0.1204 [m4]
Lt/c chord length 0.235 [m]
TABLE II
STABILITY DERIVATIVES AND INPUTS OF UAV.
ª1 2.4649 2.3250 0.4097 º where G(s) is the nominal plant (including the actuator
« »
« 0 1 2 . 4649 2.3250 » dynamics), PID(s) is the transfer function of the PID
Ct Rank (Ct ) 4 n (5)
«0 0 1 2.4649» controller. As it is likely to see from (8), given system
« »
¬«0 0 0 1 ¼» dynamics is not extremely complicated and an explicit error
function can be easily calculated. Steady state error
With such controllability analysis, it has been proved that incorporated performance indices are relatively easier to work
the longitudinal UAV system is controllable, which enables with and they usually supply analytic solutions. Therefore, in
the opportunity to implement the parameter optimized control order to make some simplifications in the performance index,
system design method. in the following section Parseval’s Theorem will be used.
A. Parseval’s Theorem
IV. INTEGRAL SQUARED ERROR PARAMETER OPTIMIZATION
Optimization is a process which simply searches for any Previously presented performance index, portrayed from
existing feasible and optimum solutions under specific [13-15], was defined as
circumstances. Here, the main goal is to minimize the f f
performance index (PI), which is usually denoted by J, under 2
0
(15b)
function
equality inequality
As it could be seen from (10) and (11), given integral constra int s constra int s
provides the translation from time domain to s-domain.
Generally, in linear dynamical systems F(s) is obtained as where L is Lagrange function, Și and Ȗi are Lagrange
multipliers [16]. The optimum of a constrained optimization
c( s ) cn 1s n 1 cn 2 s n 2 ... c1s c0 problem is characterized by the saddle point of the Lagrange
F (s) (12)
d (s) d n s n d n 1s n 1 ...d1s d 0 function in the primal and dual solution space. Thus
where n is the degree of the system dynamics. Using (12) and 1) min L( x,K , J ) in the primal space
x
(11), it is possible to obtain transfer function of system 2) max L( x,K , J ) in the dual space
dynamics in integral form such as x
2Si d ( s) d ( s)
if condition ensured that optimum point lies on tangent planes
with respect to all primal and dual variables. Therefore
where the value of the integral could be obtained in terms of
ci’s and di’s. In literature, there are several calculated integral wL wL wL
L 0 where
tables which obtain a solution to the integral given in (13) and wx j wK j wJ j
some of them are given for information in (14). nh ng
wL
J1
c0 2 wx j
0 holds for z ¦ j
K j h j ¦J
j
j g j 0
2d 0 d1 (16)
wL
c12 d 0 c0 2 d 2
0 holds for h j 0
J2 wK j
2d 0 d1d 2 wL
0 holds for J j g j 0 and Jj t0
c2 2 d 0 d1 (c12 2c0 c2 )d 0 d 3 c0 2 d 2 d 3 (14) wJ j
J3
2d 0 d 3 ( d 0 d 3 d1d 2 )
KKT conditions are necessary but not sufficient for a saddle
°c 2 ( d 2 d d d d ) (c 2 2c c ) d d d ½°
1 0 3 0 1 2 2 1 3 0 1 4 point. Additionally, we need that the Lagrange function is
® 2 2 2
¾
°̄(c1 2c0 c2 ) d 0 d 3 d 4 c 0 ( d 4 d1 d 2 d 3 d 4 ) °¿ convex with respect to the optimization variables in the primal
J4 solution space which is the sufficient condition for optimality.
2d 0 d 4 ( d 0 d 3 2 d 4 d12 d1d 2 d 3 )
According to given UAV dynamics ( ș / įe ), given problem
B. PID Parameter Optimization
is an unconstrained optimization problem. Objective function
As it could be seen from Fig.3, in the control system block that is going to be minimized in this study is the error
diagram, we have three PID controller gains which are Kp, Ti function, E(s), and corresponding optimization variables are
and Td. In order to find the optimal values of gains, ISE Kp, Ti and Td. Consequently, the optimization procedure can
parameter optimization method will be applied as follows. be summarized as :
A generic optimization problem associated with a given i. Obtain the corresponding error function (8) from
system can be formulated as the suggested block diagram (Fig.3)
ii. Obtain the performance index representation in
min z ( x) terms of ci’s and di’s.
xX
iii. Calculate the optimum solution by applying the
h( x ) 0 , h( x) R nh KKT conditions ( wJ n / wx 0 ) and verify the
(15a)
ng
g ( x) d 0 , g ( x) R convexity (Hessian) of the point ( w 2 J n / wx 2 ! 0 )
X {x R ns | x L x xu }
First of all, the error function should be obtained for
where x is a set of nx abstract parameters restricted by lower minimization purposes. Previously a general form of error
and upper bounds xL and xU, z is a cost function of interest, h function E(s) has been obtained in (8) which leads to
denotes a set of nh equality constraints, g is a set of ng
inequality constraints.
E (s) (s 5)(s 2
1.03156 s 2.99349) Using calculated ( Kp*, Ti* and Td* ) optimal parameters,
R(s) s 4 6.03156 4.2793 Td s 3 ½ time domain results of longitudinal flight control system are
°
°
°
° (17) obtained as shown in Fig.4.
® 8.15129 4.2793 K p 10.1351Td s
2
¾
° °
°¯ 14 .9675 10 . 1351 K p 4 . 2793 Ti s
10 .1351T °¿
¾
°
(1. 04691 T ) (18.0737 T ) T ( 202 .391 51. 3597 T )}
° As it is possible to see from Fig.4, the settling time is nearly
°¯ i i d i °
¿
J4 5.5 seconds, which is a considerable value and the maximum
Ti {K 2p (158.876 185.599 Td ) Td (1437.06 112.324 Ti ) ½ (18) control effort reached is 1 Newton. Maximum overshoot is
° °
°° 649.156 T 2 18.3126 (1.6194 T ) (17.2599 T ) °° only 5%, which is also remarkable.
d i i
® ¾
° Kp [581.223 439.569 Td2 23.7112 Ti Td (1247.18 °
° °
¯° 78.3655 Ti )]} ¿° V. CONCLUSION
In this paper, an optimized control system design based on
After deriving the objective function. J4, using KKT and
Integral Squarred Error parameter optimization method has
convexity conditions, it is possible to find optimum design
been aimed. In the first part of the paper, longitudinal dynamic
parameters of the desired control system by solving equations
modeling has been given and open loop time domain
given in (16), simultaneously as follows
responses have been investigated. Objective function has been
min ( J 4 ) where X {x R 3 | x L x xU } obtained, next KKT necessary and convexity sufficient
(19)
xX optimality conditions have been applied into the system
dynamics. Obtained optimal parameters have been used to
Since the problem is an unconstrained optimization
obtain the closed time domain results. It has been observed
problem, KKT necessary conditions reduce to
that, optimal parameters are able to shape system dynamics
wJ 4 wJ 4 wJ 4 relatively good so that the settling time is nearly 5.5 seconds
0 , 0 and 0 (20)
wK p wTd wTi and the maximum control effort is 1 Newton, while the
maximum overshoot is only 5%.
By solving (20) it is possible to obtain optimum PID
parameters as Kp* = 1.155415, Ti* = 1.954899, Td* = 0.728157 REFERENCES
and if the necessary conditions are verified, they are obtained [1] P. Fabiani, V. Fuertes, A. Piquereau, R. Mampey and F. Teichteil-
as follows Konigsbuch, “Autonomous flight and navigation of VTOL UAVs: from
autonomy demonstrations to out-of-sight flights” in Aerospace Science
K J4 0.0606 10 8 # 0 , T J 4 0.0904 10 8 # 0 and Technology, Vol. 11, Issues 2-3, p:183-193, March-April 2007
p i [2] E. Layer, “Theoretical principles for establishing a hierarchy of dynamic
(21) accuracy with the integral-square-error as an example” IEEE
T J 4 0.0924 10 8 # 0
d Transactions in Instrumentation and Measurement , Volume 46, Issue
5, Oct. 1997 pp:1178 – 1182
If the sufficient condition of optimality-(Hessian) of the given [3] I.W. Selesnick, M. Lang, C.S. Burrus, “Constrained least square design
solution parameters is checked, obtained results are as follows of FIR filters without specified transition bands” in IEEE Transactions
on Signal Processing, Volume 44, Issue 8, Aug. 1996 pp:1879 – 1892.
[4] J. Lin and J. G. Proakis, “An enhanced optimal windowed RLS
2K J 4 0.054591 ! 0 , T2 J 4 0.114831 ! 0 algorithm for fading multipath channel estimation” in MILCOM '93.
p i
(22) `Communications on the Move'. Conference Record (Cat.
T2 J 4 0.210070 ! 0 No.93CH3260-7), 1993, p 1003-7 vol.3.
d
[5] P.K. Kalra, “ An approach for handling the nonlinearities of HVDC
where it is possible to see that both necessary–sufficient system for stability analysis” in IEEE Transactions on Power
Electronics, v 5, n 3, July 1990, p 371-7.
optimality conditions are satisfied, which leads us to optimum
parameters.