research article design of attitude control system for uav...

9
Research Article Design of Attitude Control System for UAV Based on Feedback Linearization and Adaptive Control Wenya Zhou, 1,2 Kuilong Yin, 2 Rui Wang, 1,2 and Yue-E Wang 3 1 State Key Laboratory of Structural Analysis for Industrial Equipment, Dalian University of Technology, Dalian 116023, China 2 School of Aeronautics and Astronautics, Dalian University of Technology, Dalian 116023, China 3 College of Mathematics and Information Science, Shanxi Normal University, Xi’an 710062, China Correspondence should be addressed to Wenya Zhou; [email protected] Received 6 January 2014; Accepted 9 February 2014; Published 20 March 2014 Academic Editor: Huaicheng Yan Copyright © 2014 Wenya Zhou et al. is is an open access article distributed under the Creative Commons Attribution License, which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited. Attitude dynamic model of unmanned aerial vehicles (UAVs) is multi-input multioutput (MIMO), strong coupling, and nonlinear. Model uncertainties and external gust disturbances should be considered during designing the attitude control system for UAVs. In this paper, feedback linearization and model reference adaptive control (MRAC) are integrated to design the attitude control system for a fixed wing UAV. First of all, the complicated attitude dynamic model is decoupled into three single-input single-output (SISO) channels by input-output feedback linearization. Secondly, the reference models are determined, respectively, according to the performance indexes of each channel. Subsequently, the adaptive control law is obtained using MRAC theory. In order to demonstrate the performance of attitude control system, the adaptive control law and the proportional-integral-derivative (PID) control law are, respectively, used in the coupling nonlinear simulation model. Simulation results indicate that the system performance indexes including maximum overshoot, settling time (2% error range), and rise time obtained by MRAC are better than those by PID. Moreover, MRAC system has stronger robustness with respect to the model uncertainties and gust disturbance. 1. Introduction e applications of unmanned aerial vehicles (UAVs) have dramatically extended in both military and civilian fields around the world in the last twenty years. UAVs are used currently in all branches of military ranging from inves- tigation, monitoring, intelligence gathering, and battlefield damage assessment to force support. Civilian applications include remote sensing, transport, exploration, and scientific research. Because of the diversified mission in the aviation field, UAVs play a more and more important role. e attitude dynamic model of UAVs is nonlinear and three attitude channels are coupled. Nonlinearity and cou- pling dynamic characteristics will become more disturbing under flight condition with big angle of attack so that more obstacles will be brought during the design of attitude control system for UAVs. In recent years, some advanced control theories are grad- ually introduced into the design of attitude control system for UAVs with the development of computer technology [117]. In [1], the output feedback control method was used to design the attitude control system for UAV. An observer was designed to estimate the states online. In [2], in order to provide a basis for comparison with more sophisticated nonlinear designs, a PID controller with feedforward gravity compensation was derived using a small helicopter model and tested experimentally. In [3], a roll-channel fractional order proportional integral (PI ) flight controller for a small fixed-wing UAV was designed and time domain system identification methods are used to obtain the roll-channel model. In [4], a second-order sliding structure with a second- order sliding mode including a high-order sliding mode observer for the estimation of the uncertain sliding surfaces was selected to develop an integrated guidance and autopilot scheme. In [5], the fuzzy sliding mode control based on the multiobjective genetic algorithm was proposed to design the altitude autopilot of UAV. In [6], the attitude tracking system was designed for a small quad rotor UAV through model Hindawi Publishing Corporation Mathematical Problems in Engineering Volume 2014, Article ID 492680, 8 pages http://dx.doi.org/10.1155/2014/492680

Upload: vandien

Post on 24-Mar-2018

214 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

Research ArticleDesign of Attitude Control System for UAV Based on FeedbackLinearization and Adaptive Control

Wenya Zhou,1,2 Kuilong Yin,2 Rui Wang,1,2 and Yue-E Wang3

1 State Key Laboratory of Structural Analysis for Industrial Equipment, Dalian University of Technology, Dalian 116023, China2 School of Aeronautics and Astronautics, Dalian University of Technology, Dalian 116023, China3 College of Mathematics and Information Science, Shanxi Normal University, Xi’an 710062, China

Correspondence should be addressed to Wenya Zhou; [email protected]

Received 6 January 2014; Accepted 9 February 2014; Published 20 March 2014

Academic Editor: Huaicheng Yan

Copyright © 2014 Wenya Zhou et al. This is an open access article distributed under the Creative Commons Attribution License,which permits unrestricted use, distribution, and reproduction in any medium, provided the original work is properly cited.

Attitude dynamic model of unmanned aerial vehicles (UAVs) is multi-input multioutput (MIMO), strong coupling, and nonlinear.Model uncertainties and external gust disturbances should be considered during designing the attitude control system for UAVs.In this paper, feedback linearization and model reference adaptive control (MRAC) are integrated to design the attitude controlsystem for a fixed wing UAV. First of all, the complicated attitude dynamic model is decoupled into three single-input single-output(SISO) channels by input-output feedback linearization. Secondly, the reference models are determined, respectively, accordingto the performance indexes of each channel. Subsequently, the adaptive control law is obtained using MRAC theory. In orderto demonstrate the performance of attitude control system, the adaptive control law and the proportional-integral-derivative(PID) control law are, respectively, used in the coupling nonlinear simulation model. Simulation results indicate that the systemperformance indexes including maximum overshoot, settling time (2% error range), and rise time obtained by MRAC are betterthan those by PID. Moreover, MRAC system has stronger robustness with respect to the model uncertainties and gust disturbance.

1. Introduction

The applications of unmanned aerial vehicles (UAVs) havedramatically extended in both military and civilian fieldsaround the world in the last twenty years. UAVs are usedcurrently in all branches of military ranging from inves-tigation, monitoring, intelligence gathering, and battlefielddamage assessment to force support. Civilian applicationsinclude remote sensing, transport, exploration, and scientificresearch. Because of the diversified mission in the aviationfield, UAVs play a more and more important role.

The attitude dynamic model of UAVs is nonlinear andthree attitude channels are coupled. Nonlinearity and cou-pling dynamic characteristics will become more disturbingunder flight condition with big angle of attack so that moreobstacles will be brought during the design of attitude controlsystem for UAVs.

In recent years, some advanced control theories are grad-ually introduced into the design of attitude control system

for UAVs with the development of computer technology [1–17]. In [1], the output feedback control method was usedto design the attitude control system for UAV. An observerwas designed to estimate the states online. In [2], in orderto provide a basis for comparison with more sophisticatednonlinear designs, a PID controller with feedforward gravitycompensation was derived using a small helicopter modeland tested experimentally. In [3], a roll-channel fractionalorder proportional integral (PI𝜆) flight controller for a smallfixed-wing UAV was designed and time domain systemidentification methods are used to obtain the roll-channelmodel. In [4], a second-order sliding structure with a second-order sliding mode including a high-order sliding modeobserver for the estimation of the uncertain sliding surfaceswas selected to develop an integrated guidance and autopilotscheme. In [5], the fuzzy sliding mode control based on themultiobjective genetic algorithm was proposed to design thealtitude autopilot of UAV. In [6], the attitude tracking systemwas designed for a small quad rotor UAV through model

Hindawi Publishing CorporationMathematical Problems in EngineeringVolume 2014, Article ID 492680, 8 pageshttp://dx.doi.org/10.1155/2014/492680

Page 2: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

2 Mathematical Problems in Engineering

reference adaptive control method. In [7], to control theposition of UAV in three dimensions, altitude and longitude-latitude location, an adaptive neurofuzzy inference systemwas developed by adjusting the pitch angle, the roll angle,and the throttle position. In [8], an 𝐿1 adaptive controller asautopilot inner loop controller candidate was designed andtested based on piecewise constant adaptive laws. Navigationouter loop parameters are regulated via PID control. Themain contribution of this study is to demonstrate that theproposed control design can stabilize the nonlinear system.In [9], an altitude hold mode autopilot for UAV which isnonminimum phase was designed by combination of classiccontroller as the principal section of autopilot and the fuzzylogic controller to increase the robustness.Themultiobjectivegenetic algorithm is used to mechanize the optimal deter-mination of fuzzy logic controller parameters based on anefficient cost function that comprises undershoot, overshoot,rise time, settling time, steady state error, and stability.In [10, 11], a novel intelligent control strategy based on abrain emotional learning (BEL) algorithm was investigatedin the application of attitude control of UAV. Time-delayphenomenon and sensor saturation are very common inpractical engineering control and is frequently a source ofinstability and performance deterioration [18–20]. Takingtime delay into consideration, the influence of time delayon the stability of the low-altitude and low-speed smallUnmanned Aircraft Systems (UAS) flight control system hadbeen analyzed [21]. There are still some other methods [22,23]; no details will be listed here.

The design method based on characteristic points canobtain multiple control gains. To realize the gain scheduling,look-up table is one common way applied in practice.Actually, the gains between characteristic points do not existbut can be obtained only by interpolationmethod. It is hard toensure the control satisfaction between characteristic points[24]. As for sliding control method, it is difficult to selectthe intermediate control variables for partial derivatives of asliding surface. As for the intelligent control method, thoughthe stability of control system can be verified, the algorithmis too complicated and it is unable to guarantee the controltimeliness in application. In a word, the attitude controlsystem design of UAVs is an annoying task. Multi-inputmultioutput (MIMO), nonlinearity, and coupling dynamiccharacteristics will cause more difficulties during the designof attitude control system. In addition, model uncertaintiesand external disturbances should be taken into account also.

Feedback linearization method can be used to realizelinearization and decoupling of a complicated model. Modelreference adaptive control (MRAC) system can suppressmodel uncertainties and has stronger robustness with respectto gust disturbances. With these considerations, feedbacklinearization method and MRAC method are integratedto design the attitude control system for a fixed wingUAV. As far as we know, there is only few research inwhich the above two methods are integrated. Moreover,this design principle is simple and the control performanceis superior. The maximum overshoot, settling time, andrise time of the system can satisfy the desired indexes,and the system has strong robustness with respect to the

uncertainties of aerodynamic parameters variation and gustdisturbance.

This paper is organized as follows. firstly, the complicatedattitude dynamic model is decoupled into three indepen-dent channels by feedback linearization method; secondly,according to the control performance indexes of each attitudechannel, such as maximum overshoot, settling time, andrise time, reference model is established and MRAC isused to design the adaptive control law; thirdly, the controlperformance comparison betweenMRAC and PID control isgiven; finally, conclusions are presented.

2. Attitude Dynamic Model of UAV

The origin 𝑂 of UAV body coordinate system 𝑂𝑥𝑏𝑦𝑏𝑧𝑏 islocated at mass center. Axis 𝑥𝑏 coincides with aircraft longi-tudinal axis and points to the nose. Axis 𝑦𝑏 is perpendicularto aircraft longitudinal symmetric plane and points to theright side. Axis 𝑧𝑏 is defined following the right-hand rule.The dynamicmodels of three attitude channels including roll,pitch, and yaw are given as follows:

𝜙 = 𝑝 + tan 𝜃 (𝑟 cos𝜙 + 𝑞 sin𝜙) , (1)

𝜃 = 𝑞 cos𝜙 − 𝑟 sin𝜙, (2)

�� =𝑟 cos𝜙 + 𝑞 sin𝜙

cos 𝜃, (3)

�� = [𝐼𝑧𝐿 + 𝐼𝑥𝑧 (𝑁 + (𝐼𝑥 + 𝐼𝑧 − 𝐼𝑦) 𝑝𝑞)

−𝑞𝑟 (𝐼2

𝑧+ 𝐼2

𝑥𝑧− 𝐼𝑦𝐼𝑧)] × (𝐼𝑥𝐼𝑧 − 𝐼

2

𝑥𝑧)−1

,

(4)

𝑞 =

𝑀 − 𝑝𝑟 (𝐼𝑥 − 𝐼𝑧) − 𝐼𝑥𝑧 (𝑝2− 𝑟2)

𝐼𝑦

, (5)

𝑟=

[𝐼𝑥𝑧𝐿 +𝐼𝑥𝑁+𝑝𝑞 (𝐼2

𝑥+𝐼2

𝑥𝑧− 𝐼𝑦𝐼𝑥) + 𝑞𝑟𝐼𝑥𝑧 (𝐼𝑦 − 𝐼𝑥 − 𝐼𝑧)]

(𝐼𝑥𝐼𝑧 − 𝐼2𝑥𝑧)

.

(6)

Themodels describe the behavior of aircraft following controlinput, where 𝜙, 𝜃, and 𝜓 represent roll angle, pitch angle,and yaw angle, respectively; 𝑝, 𝑞, and 𝑟 represent the anglevelocity components on body axis 𝑥𝑏, 𝑦𝑏, and 𝑧𝑏; 𝐼𝑥, 𝐼𝑦, and𝐼𝑧 represent the inertia moment of body axis; 𝐼𝑥𝑧 denotesthe inertia product against axis 𝑂𝑥𝑏 and 𝑂𝑧𝑏; 𝐿, 𝑀, and 𝑁

represent the resultant moment components on body axis 𝑥𝑏,𝑦𝑏, and 𝑧𝑏, and

𝐿 =1

2𝜌𝑉2𝑆𝑤𝑏 (𝐶𝑙𝛽𝛽 + 𝐶

𝑙 𝛽𝛽 + 𝐶𝑙𝛿𝑎𝛿𝑎

+ 𝐶𝑙𝛿𝑟𝛿𝑟 + 𝐶𝑙𝑟𝑟 + 𝐶𝑙𝑝𝑝) ,

𝑀 =1

2𝜌𝑉2𝑆𝑤𝑐 (𝐶𝑚0 + 𝐶𝑚𝛼𝛼 + 𝐶𝑚𝛿𝑒𝛿𝑒

+ 𝐶�� + 𝐶𝑚𝑞𝑞) ,

Page 3: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

Mathematical Problems in Engineering 3

𝑁 =1

2𝜌𝑉2𝑆𝑤𝑏 (𝐶𝑛𝛽𝛽 + 𝐶

𝑛 𝛽𝛽 + 𝐶𝑛𝛿𝑎𝛿𝑎

+ 𝐶𝑛𝛿𝑟𝛿𝑟 + 𝐶𝑛𝑟𝑟 + 𝐶𝑛𝑝𝑝) ,

(7)where 𝜌 is the atmosphere density relative to height; 𝑉 isairspeed of UAV; 𝑆𝑤, 𝑏, and 𝑐 represent wing area, span, andmean aerodynamic chord, respectively; 𝛽 and 𝛼 representsideslip angle and attack angle, respectively. 𝛿𝑎, 𝛿𝑒, and𝛿𝑟 represent the deflection angle of aileron, elevator, andrudder, respectively; 𝐶 represents the aerodynamic momentcoefficient and its subscript is composed of correspondingmoments and variables, where 𝐶𝑚0 represents the aerody-namic moment coefficient at 0∘ attack angle.

It is obvious that attitude dynamic model of UAV isnonlinear and there are strong coupling among three chan-nels. Substitute the aerodynamic moment equations (7) intoattitude dynamic model equations (4)∼(6) and rewrite themas follows:

x = f (x) + gu,

y = h (x) ,(8)

wherex = [𝑝 𝑞 𝑟 𝜙 𝜃 𝜓]

𝑇,

u = [𝛿𝑎 𝛿𝑒 𝛿𝑟]𝑇,

h (x) = [𝜙 𝜃 𝜓]𝑇,

f (x) = [𝑓1 𝑓2 𝑓3 𝑓4 𝑓5 𝑓6]𝑇,

𝑓1 = [2𝑝𝑞𝐼𝑧𝑥 (𝐼𝑧 + 𝐼𝑥 − 𝐼𝑦) + 2𝑞𝑟 (𝐼𝑦𝐼𝑧 − 𝐼2

𝑧− 𝐼2

𝑧𝑥)

+ 𝐼𝑧𝜌𝑉2𝑆𝑤𝑏 (𝐶𝑙𝛽𝛽 + 𝐶

𝑙 𝛽𝛽 + 𝐶𝑙𝑟𝑟 + 𝐶𝑙𝑝𝑝)

+ 𝐼𝑧𝑥𝜌V2𝑆𝑤𝑏 (𝐶𝑛𝛽𝛽 + 𝐶

𝑛 𝛽𝛽 + 𝐶𝑛𝑟𝑟 + 𝐶𝑛𝑝𝑝) ]

× (2𝐼𝑥𝐼𝑧 − 2𝐼2

𝑧𝑥)−1

,

𝑓2 = [ − 2𝑝𝑟 (𝐼𝑥 − 𝐼𝑧) − 2 (𝑝2− 𝑟2) 𝐼𝑧𝑥

+𝜌𝑉2𝑆𝑤𝑐 (𝐶𝑚0 + 𝐶𝑚𝛼𝛼 + 𝐶𝑚���� + 𝐶𝑚𝑞𝑞) ]×(2𝐼𝑦)

−1

,

𝑓3 = [2𝑝𝑞 (𝐼2

𝑧𝑥+ 𝐼2

𝑥− 𝐼𝑦𝐼𝑥) + 2𝑞𝑟 (𝐼𝑦 − 𝐼𝑧 − 𝐼𝑥)

+ 𝐼𝑧𝑥𝜌𝑉2𝑆𝑤𝑏 (𝐶𝑙𝛽𝛽 + 𝐶

𝑙 𝛽𝛽 + 𝐶𝑙𝑟𝑟 + 𝐶𝑙𝑝𝑝)

+𝐼𝑥𝜌𝑉2𝑆𝑤𝑏 (𝐶𝑛𝛽𝛽 + 𝐶

𝑛 𝛽𝛽 + 𝐶𝑛𝑟𝑟 + 𝐶𝑛𝑝𝑝) ]

× (2𝐼𝑥𝐼𝑧 − 2𝐼2

𝑧𝑥)−1

,

𝑓4 = 𝑝 + 𝑞 sin𝜙 tan 𝜃 + 𝑟 cos𝜙 tan 𝜃,

𝑓5 = 𝑞 cos𝜙 − 𝑟 sin𝜙,

𝑓6 = 𝑞 sin𝜙sec𝜃 + 𝑟 cos𝜙sec𝜃,

g =𝜌𝑉2𝑆𝑤

2𝐼𝑦 (𝐼𝑥𝐼𝑧 − 𝐼2𝑧𝑥)

[[[[[[[

[

𝑔11 0 𝑔13

0 𝑔22 0

𝑔31 0 𝑔33

0 0 0

0 0 0

0 0 0

]]]]]]]

]

,

𝑔11 = 𝐼𝑦𝑏 (𝐼𝑧𝐶𝑙𝛿𝑎

+ 𝐼𝑧𝑥𝐶𝑛𝛿𝑎

) ,

𝑔13 = 𝐼𝑦𝑏 (𝐼𝑧𝐶𝑙𝛿𝑟

+ 𝐼𝑧𝑥𝐶𝑛𝛿𝑟

) ,

𝑔22 = 𝐶𝑚𝛿𝑒

(𝐼𝑥𝐼𝑧 − 𝐼𝑧𝑥) ,

𝑔31 = 𝐼𝑦𝑏 (𝐼𝑧𝑥𝐶𝑙𝛿𝑎

+ 𝐼𝑥𝐶𝑛𝛿𝑎

) ,

𝑔33 = 𝐼𝑦𝑏 (𝐼𝑧𝑥𝐶𝑙𝛿𝑟

+ 𝐼𝑥𝐶𝑛𝛿𝑟

) .

(9)

3. Linearization and Decoupling of Model

In order to obtain the SISO form of the three attitudechannels, feedback linearizationmethod is used in this paper.As for nonlinear equations (8), we can obtain the followingequation according to Lie derivative:

u =1

𝐿𝑔𝐿𝑛

𝑓h(−𝐿𝑛

𝑓h + k) , (10)

where 𝐿𝑓ℎ and 𝐿𝑔𝐿𝑓ℎ represent Lie derivative of h withrespect to f and g. Superscript 𝑛 represents the derivativeorder. The new input k is k = [V1 V2 V3]

𝑇.Let

Q = 𝐿𝑔𝐿𝑛

𝑓h = [𝑄1 𝑄2 𝑄3]

𝑇,

P = 𝐿𝑛

𝑓h = [𝑃1 𝑃2 𝑃3]

𝑇.

(11)

We can get

Q𝑇1

=1

2𝜌𝑉2𝑆𝑤𝑏

[[[[[[[[[[

[

cos𝜙 tan 𝜃 (𝐼𝑥𝑧𝐶𝑙𝛿𝑎 + 𝐼𝑥𝐶𝑛𝛿𝑎) + 𝐼𝑧𝐶𝑙𝛿𝑎 + 𝐼𝑥𝑧𝐶𝑛𝛿𝑎

𝐼𝑥𝐼𝑧 − 𝐼2𝑥𝑧

𝑐 sin𝜙 tan 𝜃𝐶𝑚𝛿𝑒𝑏𝐼𝑦

cos𝜙 tan 𝜃 (𝐼𝑥𝑧𝐶𝑙𝛿𝑟 + 𝐼𝑥𝐶𝑛𝛿𝑟) + 𝐼𝑧𝐶𝑙𝛿𝑟 + 𝐼𝑥𝑧𝐶𝑛𝛿𝑟

𝐼𝑥𝐼𝑧 − 𝐼2𝑥𝑧

]]]]]]]]]]

]

,

Q𝑇2=1

2𝜌𝑉2𝑆𝑤𝑏

[[[[[[[[[[

[

−sin𝜙 (𝐼𝑥𝑧𝐶𝑙𝛿𝑎 + 𝐼𝑥𝐶𝑛𝛿𝑎)

𝐼𝑥𝐼𝑧 − 𝐼2𝑥𝑧

𝑐 cos𝜙𝐶𝑚𝛿𝑒𝑏𝐼𝑦

−sin𝜙 (𝐼𝑥𝑧𝐶𝑙𝛿𝑟 + 𝐼𝑥𝐶𝑛𝛿𝑟)

𝐼𝑥𝐼𝑧 − 𝐼2𝑥𝑧

]]]]]]]]]]

]

,

Page 4: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

4 Mathematical Problems in Engineering

Q𝑇3=1

2𝜌𝑉2𝑆𝑤𝑏

[[[[[[[[[[

[

cos𝜙 (𝐼𝑥𝑧𝐶𝑙𝛿𝑎 + 𝐼𝑥𝐶𝑛𝛿𝑎)

cos 𝜃 (𝐼𝑥𝐼𝑧 − 𝐼2𝑥𝑧)

𝑐 sin𝜙𝐶𝑚𝛿𝑒𝑏 cos 𝜃𝐼𝑦

cos𝜙 (𝐼𝑥𝑧𝐶𝑙𝛿𝑟 + 𝐼𝑥𝐶𝑛𝛿𝑟)

cos 𝜃 (𝐼𝑥𝐼𝑧 − 𝐼2𝑥𝑧)

]]]]]]]]]]

]

.

(12)

Expressions of 𝑃1, 𝑃2, and 𝑃3 are more complicated andcan be obtained by referring to the literature [17].

The system relative order is 𝑛1 + 𝑛2 + 𝑛3 = 6 according toLie derivative. The input and output linearization of MIMOnonlinear system is realized by the above derivation. Thereis no internal dynamic state in new system that asymptoticstability and tracking control can be realized. The feedbacklinearization diagram is shown as Figure 1.

It is visible that the nonlinear dynamic model is trans-formed into one equivalent linear model with state variablesas follows:

x = [𝜙 𝜙 𝜃 𝜃 𝜓 ��]𝑇

. (13)

State equations are rewritten in matrix form:

[[[[[[[

[

𝜙

𝜙

𝜃

𝜃

��

��

]]]]]]]

]

=

[[[[[[[

[

0 1 0 0 0 0

0 0 0 0 0 0

0 0 0 1 0 0

0 0 0 0 0 0

0 0 0 0 0 1

0 0 0 0 0 0

]]]]]]]

]

[[[[[[[

[

𝜙

𝜙

𝜃

𝜃

𝜓

��

]]]]]]]

]

+

[[[[[[[

[

0

1

0

0

0

0

0

0

0

1

0

0

0

0

0

0

0

1

]]]]]]]

]

× [

[

V1V2V3

]

]

.

(14)

Remark 1. Although new errors are not produced in theprocess of decoupling the dynamic equations by feedbacklinearization, it is impossible to describe all dynamic char-acteristics of attitude moment precisely, the reason for thisis modeling errors and model uncertainties cannot be elimi-nated in dynamic model.

4. Control Laws Design

Aiming at the above three independent two-order sys-tems and according to the performance indexes of attituderesponse, MRAC is used in this paper to design the attitudecontrol law.

4.1. MRAC Law Design. The differential equation for eachchannel in (14) can be written as

𝑦𝑝 = 𝑢1. (15)

The adaptive control law is designed by taking the pitchchannel as an example. Suppose the form of control law is

𝑢1 = 𝑘𝑟 + 𝑓0𝑦𝑝 + 𝑓1 𝑦𝑝, (16)

x

yu = Q−1(−P + ) ^ ^

Figure 1: Feedback linearization diagram.

where 𝑘 is the feedforward gain, 𝑟 is the reference input, 𝑓0and𝑓1 are feedback gains.The approach ofMRAC is to adjustparameters 𝑘, 𝑓0, and 𝑓1 so that the system output can trackthe output of the reference model.

Select the same order of reference model as that of pitchchannel model and the differential equation is

𝑦𝑚 + 𝑎1 𝑦𝑚 + 𝑎0𝑦𝑚 = 𝑏𝑟. (17)

Coefficients 𝑎0, 𝑎1, and 𝑏 should be determined accordingto control performance indexes of pitch channel.

Consider the standard form of two-order system:

𝜙 (𝑠) =𝜔2

𝑛

𝑠2 + 2𝜉𝜔𝑛𝑠 + 𝜔2𝑛

. (18)

We can get

𝑡𝑠 =3.5

𝜉𝜔𝑛

,

𝜎% =𝑒−𝜋𝜉

√1 − 𝜉2× 100%,

𝑡𝑟 =𝜋 − 𝛽

𝑤𝑑

,

𝑤𝑑 = 𝑤𝑛√1 − 𝜉2,

𝜉 = cos𝛽,

(19)

where 𝜉 denote damping ratio; 𝜔𝑛 and 𝜔𝑑 denote naturaloscillation angular frequency and damping oscillation angu-lar frequency, respectively; 𝑡𝑠 and 𝑡𝑟 denote settling time andrise time, respectively; 𝜎% denotes overshoot; set 𝑡𝑝 = 5 s,𝜎 = 2%; it is easy to get 𝜉 = 0.7797, 𝑤𝑛 = 1.0035 rad/s.

Substitute (16) into (15);the adjustable differential equa-tion can be obtained:

𝑦𝑝 − 𝑓1 𝑦𝑝 − 𝑓0𝑦𝑝 = 𝑘𝑟. (20)

Define 𝑒 = 𝑦𝑚−𝑦𝑝 as the generalized error and accordingto (17) and (20), the generalized error equation is

𝑒 + 𝑎1 𝑒 + 𝑎0𝑒 = − (𝑎1 + 𝑓1) 𝑦𝑝

− (𝑎0 + 𝑓0) 𝑦𝑝 + (𝑏 − 𝑘) 𝑟.

(21)

Let

𝛿1 = −𝑎1 − 𝑓1, 𝛿0 = −𝑎0 − 𝑓0, 𝜎 = 𝑏 − 𝑘. (22)

Page 5: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

Mathematical Problems in Engineering 5

Equation (21) can be rewritten as

𝑒 + 𝑎1 𝑒 + 𝑎0𝑒 = 𝛿1 𝑦𝑝 + 𝛿0𝑦𝑝 + 𝜎𝑟. (23)

Define parameter error vector 𝜃 and generalized errorvector 𝜀, respectively, as

𝜃 = [𝛿0 𝛿1 𝜎]𝑇, 𝜀 = [𝑒 𝑒]

𝑇. (24)

Then error expression equation (23) can be written inmatrix-vector form:

�� = A𝜀 + Δ𝑎 + Δ𝑏, (25)

where

A = [0 1

−𝑎0 −𝑎1] , Δ𝑎 = [

0

𝛿0𝑦𝑝 + 𝛿1 𝑦𝑝] ,

Δ𝑏 = [0

𝜎𝑟] .

(26)

Select the Lyapunov function:

𝑉 =1

2(𝜀𝑇P𝜀 + 𝜃𝑇Γ𝜃) , (27)

where P is 2 × 2 positive definite symmetric matrix, Γ is 3-dimensional positive definite diagonal matrix:

Γ = diag (𝜆0 𝜆1 𝜇) . (28)

Let P = [𝑝11𝑝12

𝑝21𝑝22

] and 𝑝12 = 𝑝21; we can get the derivativeof 𝑉 with respect to time:

𝑉 =

1

2𝜀𝑇(PA + A𝑇P) 𝜀 + 𝛿0 [𝜆0

𝛿0 + (𝑒𝑝12 + 𝑒𝑝22) 𝑦𝑝]

+ 𝛿1 [𝜆1𝛿1 + (𝑒𝑝12 + 𝑒𝑝22) 𝑦𝑝]

+ 𝜎 [𝜇�� + (𝑒𝑝12 + 𝑒𝑝22) 𝑟] .

(29)

Select positive definite symmetric matrixQ and make

PA + A𝑇P = −Q. (30)

Select the adaptive laws:

𝛿0 = −

(𝑒𝑝12 + 𝑒𝑝22) 𝑦𝑝

𝜆0

,

𝛿1 = −

(𝑒𝑝12 + 𝑒𝑝22) 𝑦𝑝

𝜆1

,

�� = −(𝑒𝑝12 + 𝑒𝑝22) 𝑟

𝜇.

(31)

Obviously, 𝑉 is negative definite; therefore the closed-

loop system is asymptotically stable. Calculate the derivativeof each equation in (24) with respect to timewith considering

e

ym

yp

−−

+r u = Q−1(−P + ) ^

Referencemodel

Feedforwardgain

Feedback gain

Adaptive system

Modelof UAV

Figure 2: MRAC system diagram.

(31), the adaptive laws of feedback gains 𝑓0, 𝑓1 and feedfor-ward gain 𝑘 can be obtained:

𝑓0 = ∫

𝑡

0

(𝑒𝑝12 + 𝑒𝑝22) 𝑦𝑝

𝜆0

𝑑𝜏 + 𝑓0 (0) ,

𝑓1 = ∫

𝑡

0

(𝑒𝑝12 + 𝑒𝑝22) 𝑦𝑝

𝜆1

𝑑𝜏 + 𝑓1 (0) ,

𝑘 = ∫

𝑡

0

(𝑒𝑝12 + 𝑒𝑝22) 𝑟

𝜇𝑑𝜏 + 𝑘 (0) .

(32)

TheMRAC laws of roll and yaw channels can be designedin the same way. However, different reference model foreach channel is selected based on the performance index ofrespective channel. The MRAC system diagram of attitudecontrol system is shown as Figure 2.

Remark 2. The control performance indexes of each channeldetermine the form of the reference model. Although modeluncertainties and gust disturbances exist in the actual system,only if the output of system can track the output of refer-ence model, the performance can be guaranteed. Therefore,MRAC system has strong robustness with respect to themodel uncertainties and external disturbances.

4.2. PID Control Law Design. For the simplified modelof pitch channel, PID control law can be obtained. Theexpression of control law is

𝑢2 = 𝑘1𝑒 + 𝑘2 ∫

𝑡

0

𝑒 𝑑𝑡 + 𝑘3𝑒, (33)

where 𝑒 is the error between reference input and systemoutput; Gains 𝑘1, 𝑘2, and 𝑘3 can be determined by rootlocus according to the control performance indexes of pitchchannel.

In the same way, the control laws of roll and yaw channelscan be designed by PID method and the control diagram ofattitude control system for UAV is shown as Figure 3.

Page 6: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

6 Mathematical Problems in Engineering

r

x

yu = Q−1(−P + ) ^

Figure 3: PID control system diagram.

5. Mathematics Simulations

In order to verify the performance of attitude control systemforUAV, the PID control law and theMRAC law are applied tothe coupling and nonlinear attitude dynamic model of UAV,respectively.

The reference motion states are as follows:

𝑉 = 1360m/s, 𝐻 = 30Km. (34)

The initial conditions of simulation are

𝜙 = 𝜃 = 𝜓 = 0∘, 𝑝 = 𝑞 = 𝑟 = 0 rad/s. (35)

The allowed maximum deflection angles of three actua-tors in simulation are:

−5∘≤ 𝛿𝑎 ≤ 5

∘, −15

∘≤ 𝛿𝑒 ≤ 15

∘,

−10∘≤ 𝛿𝑟 ≤ 10

∘.

(36)

The reference inputs of three attitude channels are 10∘ stepsignals. The control performance of attitude control systemwill be verified through below three cases: Case 1, there is nouncertainty in the system; Case 2, aerodynamic parametersvary within the range of 0∼30%; Case 3, gust disturbance isconsidered as the external disturbance.

Figures 4, 5, and 6 show the output responses of roll,pitch, and yaw channels for the above three cases, respectively,wWhere solid line represents the attitude angle underMRAClaw and dashed line represents the attitude angle under PIDcontrol law.

Theperformance indexes of attitude control systemunderall cases are listed in Table 1.

We can see from above that there is almost no differencefor attitude angle response under MRAC laws for all casesshown in Figures 4 to 6. In other words, the control per-formance indexes still can be satisfied even with parameterperturbation and external disturbance. Adjust PID controllaw parameters and make the control performance underCase 1 to satisfy the design index. However, the maximumovershoot and settling time of output response will increasewhile the samePIDparameters are applied toCase 2 andCase3. The control performance becomes worse.

6. Conclusions

The design of attitude control system for UAV is presentedby integrating feedback linearization and MRAC methods.The complicated coupling nonlinear dynamic model was

0 5 10 15 20 25 30 35 400

2

4

6

8

10

12

Roll

(deg

)

t

Case 1 PIDCase 1 adaptiveCase 2 PID

Case 2 adaptiveCase 3 PIDCase 3 adaptive

Figure 4: Output response of roll channel.

0 5 10 15 20 25 30 35 400

2

4

6

8

10

12

Pitc

h (d

eg)

t (s)

Case 1 PIDCase 1 adaptiveCase 2 PID

Case 2 adaptiveCase 3 PIDCase 3 adaptive

Figure 5: Output response of pitch channel.

decoupled into three independent SISO systems by feedbacklinearization. Then, the control law of each channel wasdesigned using MRAC method and PID method, respec-tively. The mathematics simulation results indicate that theattitude control system can achieve better control perfor-mance including maximum overshoot, settling time, and risetime under MRAC law than that under PID control law.In addition, a stronger robustness with respect to aerody-namic parameter perturbation and gust disturbance has beenobtained in MRAC system.

Page 7: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

Mathematical Problems in Engineering 7

0 5 10 15 20 25 30 35 400

2

4

6

8

10

12

Yaw

(deg

)

t

Case 1 PIDCase 1 adaptiveCase 2 PID

Case 2 adaptiveCase 3 PIDCase 3 adaptive

Figure 6: Output response of yaw channel.

Table 1: Comparison of control performance indexes betweenMRAC and PID control.

Indexes Case 1 Case 2 Case 3Roll channel

PID𝛿max 7.4% 11.8% 19.2%𝑡𝑠 (s) 7.21 7.77 12.71𝑡𝑟(s) 3.13 3.14 3.34

Adaptive𝛿max 5.2% 5.3% 5.3%𝑡𝑠 (s) 4.86 4.87 4.88𝑡𝑟 (s) 2.58 2.58 2.59

Pitch channel

PID𝛿max 5.9% 7.0% 7.2%𝑡𝑠 (s) 4.62 5.35 7.46𝑡𝑟 (s) 2.27 2.45 3.33

Adaptive𝛿max 5.9% 6.0% 6.7%𝑡𝑠 (s) 3.57 3.58 3.66𝑡𝑟 (s) 1.85 1.85 1.87

Yaw channel

PID𝛿max 2.8% 3.7% 5.4%𝑡𝑠 (s) 6.26 8.18 10.74𝑡𝑟 (s) 4.17 4.61 5.04

Adaptive𝛿max 2.1% 2.1% 2.1%𝑡𝑠 (s) 5.27 5.32 5.35𝑡𝑟 (s) 3.90 3.89 3.88

Conflict of Interests

The authors declare that there is no conflict of interestsregarding the publication of this paper.

References

[1] M. Lorenzo, N. Roberto, and I. Alberto, “High-gain outputfeedback for a miniature UAV,” Journal of Robust and NonlinearControl, 2013.

[2] B. Godbolt, N. I. Vitzilaios, and A. F. Lynch, “Experimentalvalidation of a helicopter autopilot design using model-basedPID control,” Journal of Intelligent and Robotic Systems, vol. 70,pp. 385–399, 2013.

[3] H. Chao, Y. Luo, L. Di, and Y. Q. Chen, “Roll-channel fractionalorder controller design for a small fixed-wing unmanned aerialvehicle,” Control Engineering Practice, vol. 18, no. 7, pp. 761–772,2010.

[4] T. Yamasaki, S. N. Balakrishnan, and H. Takano, “Integratedguidance and autopilot design for a chasingUAV via high-ordersliding modes,” Journal of the Franklin Institute, vol. 349, no. 2,pp. 531–558, 2012.

[5] A. R. Babaei, M. Mortazavi, and M. H. Moradi, “Classical andfuzzy-genetic autopilot design for unmanned aerial vehicles,”Applied Soft Computing Journal, vol. 11, no. 1, pp. 365–372, 2011.

[6] B. T.Whitehead and S. R. Bieniawski, “Model reference adaptivecontrol of a quadrotor UAV,” in Proceedings of the AIAA Guid-ance, Navigation, and Control Conference, Toronto, Canada,2010.

[7] S. Kurnaz, O. Cetin, and O. Kaynak, “Adaptive neuro-fuzzyinference systembased autonomous flight control of unmannedair vehicles,” Expert Systems with Applications, vol. 37, no. 2, pp.1229–1234, 2010.

[8] E. Capello, G. Guglieri, F. Quagliotti, and D. Sartori, “Designand validation of an L1 adaptive controller for mini-UAVautopilot,” Journal of Intelligent and Robotic Systems, vol. 69, pp.109–118, 2013.

[9] A. R. Babaei, M. Mortazavi, and M. H. Moradi, “Fuzzy slidingmode autopilot design for nonminimum phase and nonlinearUAV,” Journal of Intelligent and Fuzzy Systems, vol. 24, pp. 499–509, 2013.

[10] H. Pu, Z. Zhen, and D. Wang, “Modified shuffled frog leapingalgorithm for optimization of UAV flight controller,” Interna-tional Journal of Intelligent Computing and Cybernetics, vol. 4,no. 1, pp. 25–39, 2011.

[11] H. Z. Pu, Z. Y. Zhen, J. Jiang, and D. B. Wang, “UAV flightcontrol system based on an intelligent BEL algorithm,” Journalof Advanced Robotic Systems, vol. 10, no. 121, pp. 1–8, 2013.

[12] C. X. Lu andQ. Huang, “Design of the platform for a UAV flightcontrol system based on STM32,” Journal of Digital ContentTechnology and Its Applications, vol. 7, no. 5, pp. 1033–1041, 2013.

[13] I. Yavrucuk and V. Kargin, “Autolanding controller strategiesfor a fixed wing UAV in adverse atmospheric conditions,” inProceedings of the AIAA Guidance, Navigation and ControlConference and Exhibit, Portland, Ore, USA, August 2008.

[14] Y. C. Paw and G. J. Balas, “Development and application ofan integrated framework for small UAV flight control develop-ment,”Mechatronics, vol. 21, no. 5, pp. 789–802, 2011.

[15] A. B. Milhim and Y. M. Zhang, “Quad-rotor UAV: high-fidelity modeling and nonlinear PID control,” in Proceedingsof the AIAA Modeling and Simulation Technologies Conference,Toronto, 2010.

[16] M. Lungu and R. Lungu, “Adaptive backstepping flight controlfor a mini-UAV,” International Journal of Adaptive Control andSignal Processing, vol. 27, no. 8, pp. 635–650, 2013.

Page 8: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

8 Mathematical Problems in Engineering

[17] J. Shin, H. Jin Kim, and Y. Kim, “Adaptive support vectorregression for UAV flight control,” Neural Networks, vol. 24, no.1, pp. 109–120, 2011.

[18] H. Gao, T. Chen, and J. Lam, “A new delay system approach tonetwork-based control,” Automatica, vol. 44, no. 1, pp. 39–52,2008.

[19] H. Yan, Z. Su, H. Zhang, and F. Yang, “Observer-based 𝐻∞

control for discrete-time stochastic systems with quantisationand random communication delays,” IET Control Theory &Applications, vol. 7, no. 3, pp. 372–379, 2013.

[20] H. Zhang, H. Yan, F. Yang, and Q. Chen, “Distributed averagefiltering for sensor networks with sensor saturation,” IETControl Theory & Applications, vol. 7, no. 6, pp. 887–893, 2013.

[21] S. Y. Yang, S. J. Tang, C. Liu, and J. Guo, “Design and verificationthe simulation system of UAS flight control considering theeffects of time delay,”AppliedMechanics andMaterials, vol. 278–280, pp. 1746–1753, 2013.

[22] H. Zhang, H. Yan, F. Yang, and Q. Chen, “Quantized controldesign for impulsive fuzzy networked systems,” IEEE Transac-tions on Fuzzy Systems, vol. 19, no. 6, pp. 1153–1162, 2011.

[23] L. X. Zhang, H. J. Gao, and O. Kaynak, “Network-inducedconstraints in networked control systems-a survey,” IEEETrans-actions on Industrial Informatics, vol. 9, no. 1, pp. 403–416, 2013.

[24] J.-P. Gao and Z.-J. Chen, “Study on gain-scheduling problem inflight control,” Chinese Journal of Aeronautics, vol. 12, no. 4, pp.217–221, 1999.

Page 9: Research Article Design of Attitude Control System for UAV ...downloads.hindawi.com/journals/mpe/2014/492680.pdf · Design of Attitude Control System for UAV Based on Feedback Linearization

Submit your manuscripts athttp://www.hindawi.com

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

MathematicsJournal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Mathematical Problems in Engineering

Hindawi Publishing Corporationhttp://www.hindawi.com

Differential EquationsInternational Journal of

Volume 2014

Applied MathematicsJournal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Probability and StatisticsHindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Journal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Mathematical PhysicsAdvances in

Complex AnalysisJournal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

OptimizationJournal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

CombinatoricsHindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

International Journal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Operations ResearchAdvances in

Journal of

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Function Spaces

Abstract and Applied AnalysisHindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

International Journal of Mathematics and Mathematical Sciences

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

The Scientific World JournalHindawi Publishing Corporation http://www.hindawi.com Volume 2014

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Algebra

Discrete Dynamics in Nature and Society

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Decision SciencesAdvances in

Discrete MathematicsJournal of

Hindawi Publishing Corporationhttp://www.hindawi.com

Volume 2014 Hindawi Publishing Corporationhttp://www.hindawi.com Volume 2014

Stochastic AnalysisInternational Journal of