Second Dynamic
Second Dynamic
ISSN: 1546-9239
© 2013 M.H. Tanveer et al., This open access article is distributed under a Creative Commons Attribution
(CC-BY) 3.0 license
doi:10.3844/ajassp.2013.819.831 Published Online 10 (8) 2013 ([Link]
Stabilized Controller
Design for Attitude and Altitude
Controlling of Quad-Rotor Under
Disturbance and Noisy Conditions
M. Hassan Tanveer, S. Faiz Ahmed,
D. Hazry, Faizan A. Warsi and M. Kamran Joyo
Centre of Excellence for Unmanned Aerial Systems (COEUAS), School of Mechatronics,
University Malaysia Perlis, Jalan Kangar Alor-setar 01000, Kangar Perlis, Malaysia
1.1. Related Work by changing the combination and speed of the quad-
rotor motors described in following section.
Generally quad-rotor carries several uncertainties,
To perform hovering, take-off or landing all four
such as air disturbances and mainly due to nonlinearity
propellers rotate with same speed. For take-off the
of the system may remarkably disturb the flight and
rotation of the propellers must be higher to produce a
lead to undesired movement. To avoid these types of
lifting force greater than the total quad-rotor weight,
movements a suitable control algorithm is required for
while for landing, the rotation of the propeller speed
attitude and altitude control for hover. However In the
gradually decreased to let the quad-rotor getting
recent years, altitude and attitude controlling of quad-
landed on the ground. The hovering can be achieved
rotor has remained an issue due to the constraints and
by producing the lifting force that equal to the total
unstable kinematics and dynamics. Some of the
quad-rotor weight. The relation of the movement can
techniques already have been developed for these
be written as:
controls mentioned.
Gotbolt et al. (2013) used Model based PID control
U1 = ±ω1 2 ± ω2 2 ± ω3 2 ± ω4 2
for Autopilot design for Helicopter, this article only
focused on software framework optimization. The PD
control technique was used for tilt rotor UAV where, ω12 , ω22 ω32 , ω42are angular velocity or propeller
stabilization in year 2012 (Chowdhury et al., 2012). In speed produced by motor 1, 2, 3 and 4 respectively.
the year 2011 active disturbance rejection controller For pitch movement, the speeds of motor 1 and 3 are
was proposed by Hua et al. (2011) only for attitude changed conversely to perform forward and backward
controlling of quad-rotor. H-inf control technique was movement while other two motors speed must maintain
introduced by Jiao et al. (2010) for trajectory tracking constant to stabilize the quad-rotor. To move forward,
of quad-rotor. Lee et al. (2011) used Dynamic Surface the speed of motor M3 must be greater than the speed of
Control (DSC) method for altitude control. This study motor 1 and vice versa for backward move. The relation
presents the modeling of a quad-rotor and a technique of the movement can be written as:
based on PID controller for altitude and attitude
stabilization. Simulation is done on (MATLAB). In a U2 = ±ω1 2 m ω32
real-time system, sensors and measurement devices
provide a noisy data. A filter must be introduced into The method to perform roll movement is same as pith
the system in order to reject noise. Kalman filter except that in roll movement the speeds of the motor 2
might be a decent filter for this system. Since the
and 4 are changed for right and left movement. The
quad-rotor system is non-linear in nature, an ordinary
relation of the movement can be written as:
KF cannot be used. The extended version of the
Kalman filter is extended kalman filter that is
U3 = ±ω2 2 m ω4 2
specially designed for non-linear systems.
2. MATERIALS AND METHODS To perform the yaw movement, the speeds of the
motors in pairs (motor 1 and 3) and (motor 2 and can be
2.1. Modeling of Quad-Rotor written as:
2.1.1. Quad-Rotor Kinematics U4 = ±ω1 2 ± ω32 m ω2 2 m ω4 2
UAV quad-rotor comprises of four motor out of
which two moves clockwise and remaining two moves To perform the yaw movement, the speeds of the
anticlockwise as shown in (Fig. 1). Different pairs of motors in pairs (motor 1 and 3) and (motor 2 and 4) are
propellers attach on the tip of each motor. The rotation changed conversely. To rotate the quad-rotor body to the
of these propellers generate vertical upward lifting right, the speeds of motors 2 and 4 must be greater than
force that lifts the quad-rotor body in the air and it can the speeds of motors 1 and 3 while to rotate it to left, the
moves in pitch, roll, yaw, hover, take-off and landing speed configuration is inverted. The relation of the
positions. These different movements can be achieved movement can be written as:
ζ = Γ& E ωB = X
& Y & φ θ ψ T
& Z (7)
where, ‘l’, b and d are the arm length, thrust constant and
drag constant respectively.
By contributing the effect of gyroscope, gravitational
vector and quad-rotor movement vector (Becker et al., 2.4. Proposed Controller Design
2012) we can calculate the quad-rotor system dynamic as In this study PID controller technique is proposed
define in Equation 8: for appropriate altitude and attitude controlling of
quad-rotor under the disturbance condition. Besides
&& = ( sin ψ sin φ + cos ψ sin θ cos φ ) U1 that EKF is also proposed to filter out the noises
X
m caused by sensor and system.
Figure 3 shows the overall block diagram of
Y&& = ( − cos ψ sin φ + sin ψ sin θ cos φ ) U1 Proposed Control Algorithm and the plant dynamics are
m presented in Equation (10) for altitude and attitude
U controlling of quad-rotor. For smooth controlling of
Z = −g + ( cos θ cos φ ) 1
&&
m quad-rotor Altitude, z-axis equation will be used and for
&& I − I J U attitude controlling all three angles which are roll, pitch
φ = YY ZZ θψ − TP θ ω + 2 and yaw will be used in controller designing:
IXX I XX IXX
&& I −I J U U
θ = ZZ XX θ ψ − TP θ ω + 3 Z = −g + (cos θ cos φ) 1
&&
IYY IYY IYY m
IXX − I YY U && I I J U
φ = YY ZZ θψ − TP θΩ + 1 2
ψ
&& = θψ − 4 (8)
I ZZ I ZZ I XX l XX l XX
&& l l J U
θ = ZZ XX θψ − TP θΩ + 1 3
where, U1, U2, U3 and U4 are the movement vector lYY lYY I YY
components define in Equation (9). Their relation with
lXX lYY U
the propellers’ speeds comes from aerodynamic ψ
&& = θψ − 1 4 (10)
calculus (Lee et al., 2011): l ZZ lZZ
where, ‘xk’ is a state vector in Equation (11), ‘ y k ’ is a 2.6. Attitude Stabilization Controller
measured process output in Equation (12), ‘wk' and ‘vk’ The EKF filtered feedback signal combined with
are the process and measurement noises respectively. reference signal and produces error signal which goes to
F(.) and h(.) are generic nonlinear functions. PID control block as shown in (Fig. 3). For Quad-rotor
The extended Kalman filter is used to estimate attitude controlling only orientation angles i.e., pith, roll
unmeasured states and the actual process outputs. and yaw are controlled. The Block diagram of PID
Likewise the standard kalman filter, the EKF also controller based Attitude controller for quad-rotor is
uses two step prediction and correction algorithm. The illustrated in (Fig. 4). The quad-rotor dynamics must be
time update equations of EKF are: simplified while hovering. There are some of the terms
that can be neglected which are gyroscopic torque and
xˆ k +1 = f (xˆ k , u k ) (13) Coriolis-centripetal as mentioned in (Ryll et al., 2012).
After neglecting the terms in Equation (10), the
Pk +1 = A k Pk A k T + Q (14) equation becomes simpler as Equation (21):
L
where, ‘ x̂ k +1 ’ is prior state estimate in Equation (13). u2
I
The time update equations project the state and covariance φ xx
&&
estimate ‘Pk+1’ from previous time step ‘k’ to the current && L
θ = u 3 (21)
ψ I yy
time step ‘k+1’ Equation (14) (Zhang et al., 2011). &&
The measurement update equations of EKF are 1
u
Equation (15-17): I ZZ
4
So for its controller designing, the error signals eφ, eθ, (0.9362 )l
φ(s) = U (24)
eψ will be: 1XX s2 (1.78S + 1)2
Ka ez = Zref − Z
φ(s) = U (25)
S (1.78S + 1)2
2
φ = e(s) K1 = 0.3K d = 1
S2 K d K a + SK P K a + K i K a (27) K 2 = (3.5K d + 0.3K P ) = (2b + 2a)
U
3.16S + 3.5S + S + S K d K a + SK p K a + K i K a
5 4 3 2
K 3 = (0.3K p + 0.3K i + 4.46K d ) = (b 2 + 4ab + a 2 )
K 4 = (0.3K i + 4.46K p ) = (2ab 2 + 2a 2 b)
Similarly for other angles of attitude (i.e., pitch K 5 = 4.46 K i = a 2 b 2
and yaw), can obtain by same above mentioned
proposed method. Therefore close loop transfer function for the
2.7. For Altitude Stabilization complete system will become:
2
0.936 1 Solving Equation 30 in stipulations of above equation
&&z = 9.86 − × 4
0.178S + 1 0.65 for proving stability, we get:
Solving Equation (32) as state space representation it The derivative of Lyapunov will become:
can be written as Equation (33):
& = eK
V e + eK Ce& + ∈ K A e& 2 + ∈ eK A&&
& A&& e (39)
e&
d e
= (33)
dt e& − C e − B e&
K K
K
Solving Equation 39 now Equation 40:
A KA
& = (−K + ∈ K )e& 2 + ∈ (−K e 2 − K ee)
V & (40)
Define x = (e, e)
& as the state of the system. Since this B A C B
1 1 0 0 x1 (44)
V(x, t) = K A e& 2 + K C e2 (36) − x1 T x 2 T ≤ 0
2 2 0 K B x 2
The function − V& is quadratic but not locally positive 3. RESULTS AND DISCUSSION
definite because it depends upon e., so for that here
For simulation quad-rotor system parameters are
slightly skew being made so that the flow of system
crosses the level surface transversely. chosen as given in (Table 1). The simulation result
∈ Introduces here showing small positive constant presented exposes the effectiveness of controller to
and shows that V is still positive definite Equation 38: stabilize the quad-rotor attitude and altitude under
disturbance conditions. The closed loop system
1 1 behaviors are analyzed while hovering in the presence of
V(x, t) = & A e& + eK C e + ∈ eK
eK & Ae (38)
2 2 unknown disturbance injected on attitude of quad-rotor.
During simulation in proposed PID controller, 0 set Chowdhury, A.B., A. Kulhare and G. Raina, 2012. A
points is set for each attitude angle (Yaw, Pitch and Roll) generalized control method for a Tilt-rotor UAV
for maintaining Quad-rotor attitude under disturbance stabilization. Proceedings of the IEEE International
and noisy conditions. Figure 5 shows, the simulation Conference on Cyber Technology in Automation,
results of quad-rotor while hovering in Z position with Control and Intelligent Systems, May 27-31, IEEE
amplitude of 10. The altitude controller quickly stabilize Xplore Press, Bangkok, pp: 309-314. DOI:
the quad-rotor and only takes settling time of 3.8 second 10.1109/CYBER.2012.6392571
when PID controller is auto-tuned with parameter of Kp Gotbolt, B., N.I. Vitzilaios and A.F. Lynch, 2013.
= 0.738 , Ki = 0.0078, Kd = 0.0086. Experimental Validation of a Helicopter Autopilot
Figure 6, 8 and 10 demonstrates that the disturbance Design using Model-Based PID Control. J. Intell.
is added with different interval of time and its effect on Robot. Syst., 70: 385-399. DOI: 10.1007/s10846-
Roll angle, Pitch Angle and Yaw angle respectively. 012-9720-7
Figure 7, 9 and 11 shows the simulation results of Hua, X., Y. Ruyi, Y. Jianqiang, F. Guoliang and J.
complete attitude stabilization of quad-rotor. These Fengshui, 2011. Disturbance rejection in UAV's
results proved that, the proposed PID controller work velocity and attitude control: Problems and
very well and easily handled the disturbance condition solutions. Proceedings of the30th Chinese Control
and quickly stabilized the quad-rotor attitude. The auto- Conference, Jul. 22-24, IEEE Xplore Press, Yantai,
tuned chosen PID Parameters for attitude controller are pp: 6293-6298.
Kp = 0.1198, Ki = 0.0009, Kd = 0.1382. Jiao, Y., J. Du, X. Wang and R. Xie, 2010. H∞ state
Figure 12 shows the effect of Gaussian noise (with feedback control for UAV maneuver trajectory
variance of approximately 0.4 m/s) when added in actual tracking. Proceedings of the International
trajectory path and to evaluate the performance of EKF Conference on Intelligent Control and Information
(Fig. 13) shows the actual and measured path of the Processing, Aug. 13-15, IEEE Xplore Press, Dalian,
particular system with the rejection of noise. pp: 253-257. DOI: 10.1109/ICICIP.2010.5564257
Lee, K.U., Y.H. Yun, W. Chang, J.B. Park and Y.H.
4. CONCLUSION Choi, 2011. Modeling and altitude control of quad-
rotor UAV. Proceedings of the 11th International
This study presents the successful simulation Conference on Control, Automation and Systems,
validation of proposed controller for altitude and attitude Oct. 26-29, IEEE Xplore Press, Gyeonggi-do, pp:
stabilization of Quad-rotor UAV system under 1897-1902.
disturbance condition. With Lyapunov stability theorem Ryll, M., H.H. Bulthoff and P.R. Giordano, 2012.
it is proved that system altitude parameters are globally Modeling and control of a quadrotor UAV with
stable. The parameters of proposed PID controller are tilting propellers. Proceedings of the IEEE
selected by PID auto-tune method. Finally EKF is International Conference on Robotics and
introduced by which the estimates of parameters could Automation, May 14-18, IEEE Xplore press, Saint
converge successfully with their right value at the time Paul, MN., pp. 4606-4613. DOI:
of the desired exit is deductible under the terms of the 10.1109/ICRA.2012.6225129
difficulties due to the noise. According to simulations, Wang, Z., A. Behal, B. Xian and J. Chen, 2011.
there is evidence that the effectiveness of the control Lyapunov-based adaptive control design for a class
method is verified that the controller has offered to of uncertain MIMO nonlinear systems. Proceedings
return the entire system to stabilize the situation where of the IEEE International Symposium on Intelligent
there is any kind of disturbance and noise imposed on Control, Sep. 28-30, IEEE Xplore Press, Denver,
quad-rotor. From the simulations it is proved that the CO., pp. 1510-1515. DOI:
effectiveness of control method is verified. 10.1109/ISIC.2011.6045409
Zhang, J., G. Welch and G. Bishop, 2011. Power system
5. REFERENCES state estimation with dynamic optimal measurement
selection. Proceeding of the IEEE Symposium
Becker, M., R.C.B. Sampaio, S. Bouabdallah, V.D. Computational Intelligence Applications in Smart
Perrot and R. Siegwart, 2012. In flight collision Grid, Apr. 11-15, IEEE Xplore Press, Paris, pp: 1-6.
avoidance for a Mini-UAV robot based on onboard DOI: 10.1109/CIASG.2011.5953339
sensors. Mechatronics Lab.