- Open Access
- Total Downloads : 249
- Authors : Mahmoud Ashry
- Paper ID : IJERTV3IS10341
- Volume & Issue : Volume 03, Issue 01 (January 2014)
- Published (First Online): 13-01-2014
- ISSN (Online) : 2278-0181
- Publisher Name : IJERT
- License: This work is licensed under a Creative Commons Attribution 4.0 International License
Comparative Study for Different Quad-Rotor Helicopter Feedback Controllers
Mahmoud Ashry
M.T.C., Cairo, Egypt
Abstract
In this paper, Adaptive Neuro Fuzzy Inference System (ANFIS) is developed for an unmanned quadrotor air vehicle. This controller is compared with conventional fuzzy controller and genetically tuned PID controller from robustness point of view when the plant is subjected to model uncertainty. The robustness with respect to environmental disturbances, especially wind, is also compared since the wind speed magnitude is comparable to the quadrotor speed. Finally; the comparison between the controllers includes the effect of noise measured on the quadrotor output sensors such as gyroscopes and altitude sensor. The simulation results based on the quadrotor model show the superiorities and the drawbacks of each controller.
-
Introduction
Controller design for Unmanned Air Vehicles (UAV), especially a four rotors Vertical Take-Off and Landing (VTOL) aircraft known as the quadrotor, has drawn great attention in recent years.
The controller has to guarantee the accuracy of the tracking path, and the robustness with respect to model uncertainties and environmental disturbances. The controllers also should mitigate the effect of measured noise on plants outputs [1-4].
A control system is robust if it is insensitive to differences between the actual system and the model of the system, which has been used to design the controller. These differences are referred to as model/plant mismatch or model uncertainty [1]. In the robustness study of a system, the uncertainty set must be determined first then robust stability and robust performance can be examined.
The controller must be robust against external environmental disturbances and especially wind. Small UAVs are significantly sensitive to wind disturbance since its magnitude may be comparable to the UAVs speed [5].
The controller is also affected by the noise measured using sensors on the planet output such as gyroscopes and altitude sensor. This effect should be attenuated by the controllers.
In this paper; genetically tuned PID, ANFIS, and fuzzy logic controllers are designed for quadrotor. The three controllers are compared based on robustness to model uncertainties, environmental disturbance rejection, and noise effect attenuation.
PID controller is designed first for the nonlinear system model of the quadrotor. Simplex algorithm is used as a fast optimal tuning technique for the PID controller parameters. Genetic Algorithm (GA) is then used as a fine tuning technique for PID parameters.
Input-output data of the PID controlled system are collected along the whole range of operation. These data are used as learning and checking data for the ANFIS design.
Finally, conventional PID-like fuzzy controller is designed for the quadrotor. The relations between the membership functions of the inputs and the membership functions of the output are developed using if-then rules.
The simulation results obtained using ANFIS, as a nonlinear controller, are compared with those obtained using genetically tuned PID and conventional fuzzy controllers. Following desired trajectory, robustness to model uncertainty, disturbance rejection, and noise effect mitigation are considered as the comparison criteria. These results show the superiorities and the drawbacks of each controller.
-
Quadrotor model and assembly
As mentioned in [6], a quadrotor consists of two fixed pitch clockwise spinning rotors and two counter- clockwise spinning rotors which diagonally oppose each other as shown in Figure 1. This results in the reactive force of each propeller being effectively cancelled out by the diagonally opposite rotors reactive component. This eliminates the need for a helicopter tail rotor.
rotational transformations are not made in the same order to go from the earth to body axes. Indeed, the most practical way is to carry out the final rotation of the earth to body transformation along the thrust direction [8]. Thus, for the body to earth transformation, the following direction cosine matrix is considered as given in (5), where:
, , : roll, pitch, and yaw angles respectively; S=Sin,
C=Cos.
s ss c c
ssc c s
sc
R cs
c c
s
(5)
zxy
c s s sc c sc s s cc
Figure 1: Free body diagram of a quadrotor helicopter.
The quadrotor is an under-actuated system with four inputs (roll, pitch, yaw and throttle). The parameters that determine the characteristics of a flying machine are the flying principle and propulsion mode [7].
The basic quadrotor has a symmetrical design. It consists of four complete rotors attached at equal distance from the central hub. All the rotors are located
within the same plane and oriented to generate thrust
The development of a suitable attitude controller for the quadrotor prototype required an accurate dynamic model to be developed. A Newtonian modelling method was chosen to define the quadrotor dynamics for control purposes. The Newtonian method is the most popular choice for modelling rigid bodies in six degrees of freedom and has been used extensively for the modelling of traditional helicopters [9,10]. As a result, the Newtonian based equations used to represent a rigid body in six degrees of freedom are well defined and can be found in many texts [10-12]. The dynamics of a rigid body under external forces applied to the centre of mass and expressed in the body fixed frame are in Newton-Euler formalism given in (6) [13]:
mvb b mvb F b
and torque. Each rotor of the quad-rotor helicopter produces both thrust and torque. Given that the front
I b b Ib b
(6)
and rear motors both rotate counter-clockwise (make clockwise torque) and the other two rotate clockwise to balance the total torque of the system. The quad-rotor is controlled by separately adjusting the speed of the four
Let us consider an earth-fixed frame E and a body-
fixed frame B as seen in Figure 2. Using Euler angles parameterization, the airframe orientation in space is given by a rotation R from B to E, where RSO3 is the
rotors. Let i
and i
be the thrust and torque for
ith
rotation matrix. The frame system shown in Figure 2 is
rotor respectively, where i = 1,2,3,4. These values are normalized with the moment of inertia and the mass, respectively. Denoting the distance of the rotor from
in conformity with the N, E, D (North, East, Down) standard.
the centre of mass by l, a set of four control inputs ui
can be introduced as function of normalized individual thrusts and torques as in the following equations. The total thrust, the rolling moment, the pitching moment, and the yawing moment are given in (1), (2), (3), and
(4) respectively.
u1 1 2 3 4
u2 l(3 4 )
u3 l(1 2 )
u4 1 2 3 4
(1)
(2)
(3)
(4)
Figure 2: Quadrotor configuration, frame system with a body fixed frame B and the inertial frame E.
The equations can be summarised in (7) where:
The way of modelling the quadrotor differs from the one used for fixed wing vehicle in the fact that the
, , : roll, pitch, and yaw angles respectively;
Ixx , I yy , Izz : body moment of inertia;
r : rotor speed;
Jr : rotor moment of inertia.
I xx I yy I zz J r r l T2 T4 h H yi 1
i 1
4
Rmxi
source of measurement noise to the feedback control system. DC power cables are running from a power distribution board to each one of the four speed controllers that attached to the four brushless motors. A control signal cable from Arduino Mega 2560 is
assigned to each one of the speed controllers. A
i 1
4
i 1 4
i 1
lithium polymer high discharge rate battery is acting as
I yy I zz I xx J rr l T1 T3 h H xi 1
Rmyi
a DC power supply to the craft. Flight control
i 1
i 4
i 1
directions and commands coming from handheld
I zz I xx I yy J r r 1 Qi l H x 2 H x 4 l H y 1 H y 3
i 1
4
remote control transmitter are bypassed to the flight controller via a directly attached receiver module.
mz mg cc Ti
i 1
4 4
The speed controllers utilized were constructed
based upon a fan controller circuit [14]. An op-amp
mx c sc s s Ti H xi 1 C x Ac x x
i 1
2
i 1
based triangular oscillator is set to produce a wave
between 0 and 5V. This wave is compared with the
2
i yi y c
4 4
my s sc c s T H 1 C A y y
i 1 i 1
(7)
output of the Arduino Mega 2560 to produce a Pulse Width Modulated (PWM) signal of controllable duty cycle. This PWM signal is then used to drive the motor.
As described in [6], the actual prototype is assembled as shown in Figure 3. It consists of two sets of counter-rotating blades driven by Brushless DC motors. Arduino Mega 2560 module was chosen as the hardware controller. Arduino IDE was used to program the Arduino Mega 2560 module with the control laws. Directional cosine matrix is implemented in this environment to observe the craft attitude. Arduino IDE software was also able to configure the required inputs and outputs of the system.
Figure 3: The complete quadrotor assembly.
To reduce system wiring and sensor alignments a custom designed Arduino Mega 2560 module is fixed at the centre of the craft. Arduino Mega 2560 module contains nine degree of freedom IMU chip with tri- axial accelerometer, tri-axial gyroscopes, and tri-axial magnetometer. These sensors can be considered as the
The IMU system is an Ienvensense MPU 6000 chip containing a digital motion processor and uses I2C serial bus.
As discussed in [6] the major challenge of the current quadrotor prototype is the motor control system. The motor controllers are not linear across the entire range of operation and caused erroneous motor speeds. The dynamic response of the motors also has a large impact on the controllability of the system. This has been proven by dealing as in system identification to identify experimentally the relation between the input and the output of the black box system. The motor driving circuit (electronic speed controller), the motor, and the rotors are considered as a black box in this case. The input to this black box is voltage to the motor driving circuit and the output is the thrust produced out of the rotor. It was found experimentally that the relation between the input voltage to the motor driving circuit and the motor output speed measured in Revolution Per Minute (RPM) is linear with time delay involved. The relation between the motor speed and the thrust is deduced through a flight test. The procedure of flight test in this paper is typically started by taking the remote controller to a hovering condition after taking- off gradually and measure experimentally the relation between the thrust force and the motor speed in RPM. The experimental set up can be seen in Figure 4. From the experiment, the relation between the thrust and the motor speed in RPM is obtained as in Figure 5. The quadratic approximation used is shown also in the same figure. These approximations can be considered as a source of model uncertainty.
The total thrust force imparted on the body attached frame can be defined mathematically from the experimental results to be as in (8), where:
T: is the total thrust of the quadrotor,
Fi: is the force produced by rotor i, d
i: is the motor speed in RPM.
Gd(s)
T 4 F b4 2
(8)
i1 i
i1 i
K(s)
G(s)
+
+ u +
r y
ym –
+
+
n
Figure 6: The simple one degree of freedom negative feedback structure
Figure 4: Motor test setup for thrust calculation.
Experimental data Approximate quadratic |
16
14
12
Thrust [N]
10
8
6
4
2
0
The objective of controller design is to manipulate u such that the control error e remains small in spite of disturbances d . The control error is given in (10).
e y r (10)
The output y can be written as in (11).
y G(s)u Gd (s)d (11) Substituting from (9) in (11) the following equation can be obtained.
y G(s)K(s)(r y n) Gd (s)d (12) Hence the closed loop response is given in (13).
d
y (I GK)1 GKr (I GK)1 G (s)d (I GK)1GKn
(13)
Defining the loop transfer function L , sensitivity function S , and the complementary sensitivity function T as in (14).
2000 3000 4000 5000 6000 7000 8000
RPM
Figure 5: Experimental and approximate relations between thrust and motor speed.
L GK
S (I GK )1 (I L)1
T (I GK )1 GK (I L)1 L
(14)
-
Controller design
Controller design for quadrotor has drawn great attention in recent years. The controller has to guarantee the accuracy of the tracking path, and the robustness with respect to model uncertainties, and environmental disturbances. The controller also should mitigate the effect of measured noise on plants outputs [1-4].
Figure 6 shows the simple one degree of freedom negative feedback structure. The input to the controller K (s) is r ym , where ym is the measured output, and r is the reference value (set point) for the output. The measured output can be defined as: ym y n , where n is the measured noise and y is the actual output.
Thus the input to the plant can be described as in (9).
As a result equation (13) can be simplified to be as in (15).
y Tr SGd d Tn (15)
The most important design objectives of a controller, which necessitate trade-offs in feedback control, are summarized as below [1]:
-
Good disturbance rejection which needs large controller gains, i.e. L large.
-
Good command following: L large.
-
Mitigation of measurement noise on plant output:
L small.
-
Robust stability of model uncertainty: L small. Fortunately, the conflicts in design objectives are generally at different frequency ranges. Most of objectives can be met by using large loop gain at low frequencies below crossover, and small loop gain at
u K(s)(r y n)
(9)
high frequencies above crossover [1,2].
In this paper, ANFIS is developed for an unmanned
eRoll (t) set point- measured roll
quadrotor air vehicle. This controller is compared with
ePitch
(t) set point- measured Pitch
(17)
conventional fuzz logic controller and genetically
tuned PID.
eYaw
-
set point- measured yaw
In this section; genetically tuned PID, ANFIS, and fuzzy controllers are designed for quadrotor. The three controllers are compared in the following sections. The comparison criteria considered are; following desired trajectory, robustness to model uncertainty, disturbance rejection, and noise mitigation.
-
Genetically tuned PID controller
A PID controller is designed for each channel of the system as described in [6]. As the four channels are coupled, the tuning of the four PID controller
The proportional component of the controller can be implemented once e(t) is defined. The integral and derivative components are normally need more computations. By utilizing the craft angular velocity estimate the derivative control component can be simply and efficiently calculated. The craft angular velocity can be considered to be the derivative of the attitude angle measurement and the control set point can be considered as a constant value. This can be described in (18).
de(t) d (set point-Attitude angle)
dt dt
parameters need to be optimized. The optimization algorithm should minimize the coupling effect and the error signal between the desired and actual measured values in each channel.
d (Const.) craft angular velocity
dt
craft angular velocity
(18)
Simplex algorithm is used at extreme condition of flight as a fast optimizer. PID control parameters obtained from simplex fast algorithm is used as initial acceptable parameters for genetic algorithm. Fine tuning of PID parameters is obtained using genetic algorithm. The PID parameters obtained, using genetic algorithm, are used to study the robustness of the PID controller at different operating points [6].
The implementation of the controller deviated from normal PID controller implementation due to the feedback information available.
Proportional compensation was provided for the Euler based attitude estimate with a derivative term being used to provide compensation for the angular velocities. The use of the actual angles of roll, pitch and yaw as feedback into the controller allowed for attitude set points to be used to enable the craft to be manoeuvred.
As the angular velocity of the craft is calculated using on-board gyroscopes the derivative term of the controller is available in real-time and does not have to be calculated based on previous attitude samples.
For the traditional implementation the output of the controller y(t) can be defined as in (16).
The Quadrotor Prototype was able to achieve stable flight under the influence of the Arduino Mega 2560 controller. The prototype was also able to maintain desired angles of pitch and roll under different conditions. The results obtained from the flight experiments show that the designed PID controller is capable of controlling the prototype quadrotor aircraft both for level and attitude set-points [6].
-
Adaptive neuro-fuzzy inference system based controller
The architecture and learning procedure underlying ANFIS implemented in the framework of adaptive networks. By using a hybrid learning procedure, the proposed ANFIS can construct an input-output mapping based on both human knowledge in the form of fuzzy if-then rules, and input-output data pairs. In the simulation, the ANFIS architecture is employed to model nonlinear functions, identify nonlinear components on-line in a control system, and predict a chaotic time series, all yielding remarkable results [15].
In this paper, as the system is nonlinear ANFIS can be used as a nonlinear controller. The inputoutput data
t
y(t) KPe(t) KI e( )d KD
0
de(t)
dt
(16)
of the PID controlled system at different operating
points are used as training and checking data sets for ANFIS. Half of these data are used as a training data
where
KP is proportional gain, KI
is integral gain,
and the other half as a checking data. Training the FIS
KD is derivative gain, and e(t) is the difference between the desired value and the actual controlled variable value. The quadrotor controller will be targeted at forcing the attitude angles to desired set points. As a result e(t) can be defined as in (17).
is started using hybrid optimization method after generating the initial FIS structure. In the case studied, a sixty training Epochs with zero tolerance error are used in the system training. Validation of the model obtained is performed then the generated FIS is
successfully used as a controller of the system in the Simulink model [6].
-
Fuzzy logic controller
Fuzzy Logic Controller (FLC) is designed as a controller to be compared with ANFIS and genetically tuned PID controllers. FLC is one of the artificial intelligence methods for control that has a nonlinear and rule-based nature. The FLC provides an algorithm, which converts the linguistic control based on expert
0.35
PID
ANFIS
Fuzzy
0.3
0.25
0.2
Roll [rad]
0.15
0.1
0.05
0
-0.05
-0.1
0 2 4 6 8 10 12 14 16 18 20
Time [s]
0.5
knowledge into an automatic control strategy. PID
Therefore, the fuzzy logic algorithm is much closer in spirit to human thinking than traditional logical systems [16].
In this subsection, the PD-like fuzzy controller is designed for each channel (roll, pitch, yaw, and altitude). It is required to reduce the coupling effect between the channels and to achieve the desired
0.4
0.3
Pitch [rad]
0.2
0.1
0
-0.1
-0.2
ANFIS
Fuzzy
trajectory tracking with acceptable performance speed and quality. Seven triangular membership functions for the altitude channel inputs (the error, and rate of error), and the altitude channel output are used. Forty nine if- then rules relating the inputs and the output are established based on expert knowledge. For the remaining channels (roll, pitch, and yaw), five triangular membership functions are used for the inputs (the error, and rate of error) and the output. Twenty five if-then rules relating the inputs and the output are established based on expert knowledge.
0 5 10 15 20 25 30 35 40
Time [s]
PID ANFIS
Fuzzy
0.3
0.25
0.2
Yaw [rad]
0.15
0.1
0.05
0
-0.05
-0.1
0 5 10 15 20 25 30 35 40
Time [s]
2.08
PID
ANFIS
-
-
-
Comparison between controllers based on desired trajectory tracking
In this section, the desired trajectory tracking is considered as the comparison criterion between the three controllers. Figure 7 shows the output responses
2.06
Altitude [m]
2.04
2.02
2
1.98
Fuzzy
for the four channels (roll, pitch, yaw, and altitude). The quadrotor initially started at 2m altitude; and at 0.3 rad for roll, pitch, and yaw angles. It is required for the controlled system to maintain the same altitude and to reach zero rad for roll, pitch, and yaw angles.
It can be seen that the output responses for roll, pitch, and yaw obtained by ANFIS and genetically tuned PID are identical. They are better than the output responses obtained by FLC. The output response obtained by ANFIS controller is the best response for the altitude channel. There is a steady state error for the FLC. There is also a small steady state error for the genetically tuned PID in addition to the overshoot obtained.
As a result the ANFIS controller is the best controller for desired trajectory tracking from performance speed and performance quality points of view.
0 2 4 6 8 10 12 14 16 18 20
Time [s]
Figure 7: Output responses of the desired trajectory tracking
-
Comparison between controllers based on robustness to model uncertainty
Uncertainty in the plant model may have several origins [1]:
-
There are always parameters in the linear model, which are only known approximately or incorrectly.
-
The parameters in the linear model may vary due to nonlinearities or changes in the operating conditions.
-
Measurement devices have imperfections.
-
At high frequencies, the uncertainty will always exceed 100% at some frequencies.
-
Even when a very detailed model is available, a simpler (reduced order) model may be chosen to represent the system and the neglected dynamics are considered as uncertainty.
-
Finally, the controller implemented may differ from the one obtained by solving the integrated problem. In this case, uncertainty may be included to represent the effect of controller order reduction and implementation inaccuracies.
These various sources of model uncertainty may be grouped into two main classes:
-
Parametric uncertainty: in which the structure of the model, including the model order, is known, but some of the parameters (such as: gain, time constant, etc.) are uncertain.
-
Neglected and unmodelled dynamics uncertainty: in which the model is incorrect because of missing dynamics, usually at high frequencies, either through deliberate neglect or because of a lack of understanding of the physical process. Any model of a real system will contain this source of uncertainty.
A combination of the previous two main classes can be represented in what is called lumped uncertainty. In most cases it is preferable to lump the uncertainty into a multiplicative uncertainty as shown in Figure 8.
be uncertain. The efficiency of these motors is considered to be less than one. Simulation results are used to examine the robust stability and performance of each controller. Figure 9 shows the output responses of the controlled system using the three types of controllers when the system is subjected to model uncertainty. The efficiency of the considered motors in this figure is 70%.
PID
ANFIS
Fuzzy
0.35
0.3
0.25
Roll [rad]
0.2
0.15
0.1
0.05
0
-0.05
-0.1
0 2 4 6 8 10 12 14 16 18 20
Time [s]
PID
ANFIS
Fuzzy
0.5
0.4
0.3
Pitch [rad]
0.2
I
I
0.1
0
G
+ -0.1
+
-0.2
0 2 4 6 8 10 12 14 16 18 20
Time [s]
Figure 8: Plant with multiplicative uncertainty
The multiplicative uncertainty shown can be represented as in (19).
2
1.5
Yaw [rad]
1
Gp (s) G(s)(1 I (s)I (s)); I ( 1
where:
(19)
0.5
0
PID ANFIS
Fuzzy
G(s)
is the nominal plant model (without uncertainty),
0 2 4 6 8 10 12 14 16 18 20
Time [s]
Gp (s) is a particular perturbed plant model,
(s) is a scalar weight,
2.2
PID
ANFIS
2
1.8
Altitude [m]
1.6
I (s) is the normalized perturbation which can be
1.4
represented by any stable transfer function which at any frequency is less than or equal to one in magnitude.
In this section, a comparison between the different types of controllers designed section 4 is performed
1.2
1
0.8
Fuzzy
from robust stability and robust performance points of view, when the plant is subjected to model uncertainty.
Th model uncertainty in this paper is concerned with the four motors of the quadrotor. Three cases can be considered according to the chosen motor/motors to be uncertain.
-
The first case
In this case, the model of two opposite motors such as motor 1, and motor 3 in Figure 1 are considered to
0 2 4 6 8 10 12 14 16 18 20
Time [s]
Figure 9: The output performance when the system is subjected to model uncertainty (Efficiency of motor 1, 3 is 70%)
From robust performance point of view, it can be seen from this figure that the required altitude is achieved using ANFIS and FLC. The system controlled using genetically tuned PID couldnt reach the desired altitude in this case of model uncertainty. It can be seen also that the performance of the system controlled
using ANFIS controller is better than the system controlled using FLC in roll and pitch channels, whereas the system controlled using FLC is better than that controlled using ANFIS in yaw channel.
From robust stability point of view in this case, it was found that the system controlled using ANFIS or FLC is stable to model uncertainty limit of 48%. The system controlled using genetically tuned PID is stable to model uncertainty limit of only 59%.
As a result of this study, we can say that the quadrotor controlled using ANFIS or FLC is better than that controlled using genetically tuned PID.
-
The second case
In this case, the model of two adjacent motors such as motor 1, and motor 2 in Figure 1 are considered to be uncertain. The efficiency of these motors is considered to be less than one. Simulation results are used to examine the robust stability and performance of each controller. Figure 10 shows the output responses of the controlled system using the three types of controllers when the system is subjected to model uncertainty. The efficiency of the considered motors in this figure is 84%.
From robust performance point of view, it can be seen from this figure that the required altitude is achieved using ANFIS and FLC. The performance of the altitude channel of the system controlled using ANFIS is better than that controlled using FLC. The system controlled using genetically tuned PID couldnt reach the required altitude in this case of model uncertainty. It can be seen also that the performance of the system controlled using ANFIS controller is better than the system controlled using FLC in pitch channels. From robust stability point of view based on the simulation results, it was found that the system controlled using ANFIS is stable to model uncertainty limit of 68% whereas the system controlled using FLC is stable to model uncertainty limit of only 84%. The system controlled using genetically tuned PID is stable to model uncertainty limit of 59% but with
unacceptable performance.
Based on the simulation results obtained in this case of model uncertainty, the ANFIS controller can be considered as the best controller for the quadrotor.
-
The third case
In this case, the models of the four motors are considered to be uncertain. The efficiency of these motors is considered to be less than one.
0.3
PID ANFIS
Fuzzy
0.2
0.1
Roll [rad]
0
-0.1
-0.2
-0.3
-0.4
0 1 2 3 4 5 6 7 8 9 10
Time [s]
PID
ANFIS
Fuzzy
0.3
0.2
Pitch [rad]
0.1
0
-0.1
-0.2
0 1 2 3 4 5 6 7 8 9 10
Time [s]
PID ANFIS
Fuzzy
0.35
0.3
0.25
Yaw [rad]
0.2
0.15
0.1
0.05
0
-0.05
-0.1
0 1 2 3 4 5 6 7 8 9 10
PID
ANFIS
Fuzzy
Time [s]
2.2
2.1
Altitude [m]
2
1.9
1.8
1.7
1.6
1.5
1.4
0 1 2 3 4 5 6 7 8 9 10
Time [s]
Figure 10: The output performance when the system is subjected to model uncertainty (Efficiency of motor 1, 2 is 84%)
Simulation results are used to examine the robust stability and the robust performance of each controller. Figure 11 shows the output responses of the controlled system using the three types of controllers when the system is subjected to model uncertainty. The efficiency of the considered motors in this figure is 80%.
From robust performance point of view, it can be seen from this figure that the required altitude is achieved with the same performance quality using ANFIS and FLC. The system controlled using genetically tuned PID couldnt reach the desired altitude in this case of model uncertaint. It can be seen also that the performance of the system controlled using FLC controller is better than the system
controlled using ANFIS in roll, pitch, and yaw channels.
From robust stability point of view based on the simulation results, it was found that the system controlled using ANFIS is stable to model uncertainty limit of 34% and the system controlled using FLC is stable to model uncertainty limit of 30%. The system controlled using genetically tuned PID is stable to model uncertainty limit of only 75%.
Based on the simulation results obtained in this case of model uncertainty, the FLC controller can be considered as the best controller for the quadrotor. The ANFIS can be considered also as an acceptable controller for the quadrotor in this case.
PID
ANFIS
Fuzzy
0.35
0.3
0.25
Roll [rad]
0.2
0.15
0.1
0.05
0
-0.05
-0.1
0 2 4 6 8 10 12 14 16 18 20
PID
ANFIS
Fuzzy
Time [s]
0.4
Pitch [rad]
0.2
0
-0.2
-0.4
-0.6
0 2 4 6 8 10 12 14 16 18 20
Time [s]
-
-
Comparison between controllers based on disturbance rejection
The effect of cross wind disturbance in X-Y plane is studied in this section. The quadrotor is subjected to crosswind disturbance in the X-Y plane. The X and Y components of the wind speed are identical and can be seen in Figure 12. A desired altitude of 1m and zero rad for roll, pitch, and yaw angles are to be maintained in presence of wind disturbance. Figure 13 shows the output responses of the fuzzy controlled system. It can be seen from the altitude curve that the quadrotor fall down causing crash. This means that the disturbance rejection couldnt be achieved using FLC for this wind speed.
The ANFIS and the genetically tuned PID are compared when the system is subjected to cross wind disturbance of higher amplitude. The X and Y components of the wind speed are identical and can be seen in Figure 14. The output responses of the controlled system when subjected to this cross wind disturbance are shown in Figure 15. It can be seen that the altitude response of the system controlled by ANFIS is better than that of the system controlled by genetically tuned PID.
It is clear from this section that the ANFIS controlled system is the best when dealing with external wind disturbance.
-
Comparison between controllers based on measurement noise effect attenuation
The output sensors such as gyroscopes and altitude sensor are the sources of measurement noise. They are
0.5
0
Yaw [rad]
-0.5
-1
-1.5
-2
PID ANFIS
Fuzzy
used for the feedback control to be compared with the desired inputs. A drawback with feedback is that the controller feeds measurement noise into the system. It is important that the control actions generated by measurement noise are not too large. Since measurement noise typically has high frequencies, the controller should achieve small loop transfer function
for high frequencies. This property is called high
2.5
2
Altitude [m]
1.5
1
0.5
0
0 2 4 6 8 10 12 14 16 18 20
Time [s]
frequency roll off [2].
For the case studied, the three gyroscopes and the altitude sensor are considered as the source of measurement noise. In simulation, these noise are considered to be white noise.
Figure 16 shows the output responses of the controlled system when the measurement noise is considered. For roll and pitch angles, the output
0 2 4 6 8 10 12 14 16 18 20
Time [s]
Figure 11: The output performance when the system is subjected to model uncertainty (Efficiency of all motors is 80%)
responses of the three controllers are similar. For the output responses of yaw angle and altitude, it is clear that the FLC and the genetically tuned PID are better than the ANFIS.
1
Disturbance Wind [m/s]
0.5
0
-0.5
-1
0 10 20 30 40 50 60 70
Time [s]
Figure 12: The X and Y components of the wind disturbance
1.5
Disturbance wind [m/s]
1
0.5
-0.5
-1
-1.5
0 10 20 30 40 50 60 70
Time [s]
Figure 14: The X and Y components of the wind disturbance
0.25
0.2
0.15
Roll [rad]
0.1
0.05
0
-0.05
0.06
0.04
0.02
Roll [rad]
0
-0.02
-0.04
-0.06
PID ANFIS
-0.1
0 2 4 6 8 10 12
Time [s]
3.5
3
2.5
Pitch [rad]
2
1.5
1
0.5
0
0 2 4 6 8 10 12
Time [s]
1.2
1
0.8
Yaw [rad]
0.6
0.4
0.2
0
-0.2
0 2 4 6 8 10 12
Time [s]
1.5
-0.08
0 10 20 30 40 50 60 70
Time [s]
PID ANFIS
0.03
0.02
Pitch [rad]
0.01
0
-0.01
-0.02
-0.03
0 10 20 30 40 50 60 70
Time [s]
PID
ANFIS
x 10-3
0
-2
Yaw [rad]
-4
-6
-8
-10
-12
0 10 20 30 40 50 60 70
Time [s]
1.8
1
0.5
Altitude [m]
0
-0.5
-1
-1.5
1.6
1.4
Altitude [m]
1.2
1
0.8
0.6
0.4
PID ANFIS
-2
0 2 4 6 8 10 12
Time [s]
Figure 13: The output responses of the fuzzy controlled system when the system is subjected to external wind disturbance
0.2
0 10 20 30 40 50 60 70
Time [s]
Figure 15: The output responses of the ANFIS and genetically tuned PID controlled system when the system is subjected to external wind disturbance
0.3
0.25
0.2
Roll [rad]
0.15
0.1
0.05
0
-0.05
-0.1
PID ANFIS
Fuzzy
performance speed and quality over the system controlled using the other two controllers.
From robust stability and robust performance points of view when the system is subjected to model uncertainty, it was found that the best controller performance is the ANFIS followed by the FLC. The worst performance was the genetically tuned PID.
From robustness to environmental disturbances
0 5 10 15 20 25 30 35 40 45 50
Time [s]
PID ANFIS
Fuzzy
0.3
0.25
0.2
Pitch [rad]
0.15
0.1
0.05
0
-0.05
-0.1
0 5 10 15 20 25 30 35 40 45 50
Time [s]
PID ANFIS
Fuzzy
0.3
0.2
0.1
Yaw [rad]
0
-0.1
-0.2
-0.3
-0.4
0 5 10 15 20 25 30 35 40 45 50
Time [s]
point of view, it was found that the best controller was the ANFIS controller. The performance of the genetically tuned PID was unacceptable. The worst controller in this case is the FLC which considered robustly unstable in this case.
With respect to the measurement noise on the quadrotor output sensors, the best performance achieved using FLC followed by genetically tuned PID. The worst performance in this case is the ANFIS but it is still acceptable.
Considering the superiorities and the drawbacks of each controller in this case studied, ANFIS can be chosen as the best controller for the quadrotor.
10. References
-
S. Skogestad and I. Postlethwaite, Multivariable Feedback Control Analysis and Design, John Wiley & Sons, Ltd, 2005.
PID ANFIS
Fuzzy
2.2
2.15
Altitude [m]
2.1
2.05
2
1.95
0
5 10 15 20 25 30 35 40 45 50
Time [s]
Figure 16: The output responses of the
-
K. Astrom and R. Murray, Feedback systems: An Introduction for Scientists and Engineers, Princeton University Press, 2008.
-
T. Glad and L. Ljung, Control Theory: Multivariable and Nonlinear Methods, Taylor & Francis, 2000.
-
P. Albertos and A. Sala, Multivariable Control Systems: An Engineering Approach, Springer, 2004.
-
A. Brezoescu, T. Espinoza, P. Castillo, and R. Lozano, Adaptive Trajectory Following for a Fixed-Wing UAV in Presence of Crosswind, Journal of intelligent and robotic
controlled system when the measurement noise is considered.
-
-
Conclusions
Three types of controllers have been designed for an unmanned quadrotor aerial vehicle. The designed controllers are ANFIS, genetically tuned PID, and conventional FLC. These controllers are compared based on accuracy of tracking path, and robustness with respect to model uncertainty and environmental disturbances. The controllers also compared with respect to measurement noise on the quadrotor output sensors. The comparison is achieved using simulation results obtained from controlled quadrotor model.
From accuracy of tracking path point of view, it was found that the output responses of the quadrotor controlled using ANFIS controller have the best
systems, Vol 69, Issue1-4, pp. 257-271, January 2013.
-
M. Mahfouz, M. Ashry, and G. Elnashar, Design and Control of Quad-Rotor Helicopters Based on Adaptive Neuro-Fuzzy Inference System, International Journal of Engineering Research & Technology (IJERT), Vol. 2 Issue 12, pp. 479-485, December 2013.
-
M. Achtelik, A. Bachrach, R. He, S. Prentice and N. Roy, Autonomous Navigation and Exploration of a Quadrotor Helicopter in GPS-denied Indoor Environments, first symposium on indoor flight issues, Puerto Rico, July 2009.
-
C. Eck, Navigation Algorithms with Applications to Unmanned Helicopters, Doctor of technical science thesis, Swiss federal institute of technology, Zurich 2001.
-
H. Bang, J. Lee, and Y. Eun, Nonlinear Attitude Control for a Rigid Spacecraft by Feedback Linearization, KSME International Journal, Vol, 18, no. 2, pp. 203-210, 2004.
-
T. Hamel, R. Mahony, R. Lozano, and J. Ostrowski, Dynamic Modelling and Configuration Stabilization for an X4-Flyer, 15th triennial world congress of the IFAC, Barcelona, Spain, July 2002
-
S. McGilvray, Attitude Stabilization of a Quadrotor Aircraft, Master's Thesis, Lakehead University, Canada, 2004.
-
A. Tayebi, and S. McGilvray, Attitude Stabilization of a VTOL Quadrotor Aircraft, IEEE transaction on control systems technology, Vol 14, no 3, pp. 562-571, May 2006.
-
R. M. Murray, Z. Li, and S. Shankar, A Mathematical Introduction to Robotic Manipulation, CRC press, March 1994.
-
Cook, F 1999, PWM DC Motor Speed Controlle, http://www.technick.net/public/code/cp_dpage.php?aiocp_dp
=cir_solorb_pwm1, 2007.
-
H. T. Nguyen, N. R. Prasad, C. L. Walker, and E. A. Walker, A First course in Fuzzy and Neural Control, CRC press, 2003.
-
Jan Jantzen, Foundations of fuzzy Control, John Wiley and Sons ltd., England, 2007.