Beruflich Dokumente
Kultur Dokumente
CITATIONS READS
0 72
2 authors:
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Oussama Gherouat on 14 January 2017.
Regular paper
Abstract- In this article the sliding mode controller is applied for a small unmanned helicopter
called quadrotor. The dynamic model is established considering various physical phenomena that
can influence its dynamic behavior. Subsequently, backstepping controller is designed. Its job is to
generate commands to the four rotors. The objective is to drive the quadrotor to track desired
Cartesians positions and desired orientation. The proposed controller is based on the Lyapunov
stability. This control technique was checked in simulation and has given good performance.
Keywords: Quadrotor UAV, Newton-Euler Formalism, Sliding Mode Controller, Tracking
Trajectory.
1. INTRODUCTION
Nowadays, the use and development of unmanned aerial vehicles (UAVs) have been
grown strongly. UAVs are becoming very popular and commercial military and academic
platform. As an UAV, quadrotors are very attractive because they have excellent
characteristics, such as the vertical take-off and landing ability, hovering, small size, higher
manoeuvrability, low cost, etc. They flight with low speed and less distance, but they
have the aptitude to hover near a specific object, and are suitable for missions that
do not require high speed.
The selection of the suitable control technique for a quadrotor UAV is challenging for both
indoor and outdoor environment; because of its under-actuated property, coupling
between translational and rotational dynamics and its inherent nonlinearity. Authors in
literature have proposed many control techniques for this class of systems. J. C. V. Junior et
al in [1] have used PID controller to stabilize roll and pitch movements. However they
came up with a conclusion that linear control cannot fulfil the requirements under some
conditions. Other attempts for the quadrotor control were made based on feedback
linearization (FL) [2, 3]. This technique is restricted for some applications because of its
lack of precision. In [4], authors tackled the robustness against uncertainties. They
concluded that FL is not a robust technique and sensitive to sensor noise. Hence, sliding
mode control (SMC) performed well in presence of sensor noise.
This paper deals with the control of the quadrotor system based on SMC. The rest of the
paper is organized as follows: In section II, the dynamic model of the quadrotor is
developed according to Newton-Euler formalism. Based on this nonlinear model, we design
in section III, the inputs lows of the SMC. Some simulation results are demonstrated in
section IV, allowing the analysis of the proposed controller performance. Finally, we
give a conclusion in section V.
2. DYNAC MODEL
The quadrotor, like it is shown in the Figure 1 is a helicopter configuration with four rotors
in cross form. Reason for which, X4-flyer is a simple strongly significant name. We
consider that the structure is rigid. Only the propellers speeds are changeable [5].
The dynamic model of X4-flyer is a system of equations describing its attitude and
position in space, which are primarily those of a rigid body in rotation with six
degrees of freedom at four inputs. The inputs represent the angular velocities of the four
rotors. The motion study of such a body (position, orientation, speed and angular
velocity) is reduced to study the movement of its center of gravity and its orientation with
respect to an inertial reference frame. From where the need of associating a mobile
frame with the solid to be studied, i.e. it follows instantaneously its movements (Figure 1).
The transformation between the two frames is given by the matrix (1):
cosθ cosψ sinφ sinθ cosψ − cosφ sinψ cosφ sinθ cosψ + sinφ sinψ
I sinφ sinθ sinψ + cosφ cosψ cosφ sinθ sinψ − sinφ cosψ
B R = cosθ sinψ
151
O. Gherouat et al.: Sliding Mode Control for a Quadrotor Unmanned Aerial Vehicle
vector. Ω=[ Ωx Ωy Ωz ]T contains the angular speeds. m is the X4-flyer mass while
I=diag[Ix Iy Iz] is its inertia matrix.
mξɺɺ = FT − FD − FG
ɺ
I Ω = τ φ ,θ,ψ − τ a − τ g (2)
where FT and τϕ,θ,ψ are the force and the torque generated by the propellers. FD and τa are the
aerodynamic effects acting on the vehicle. FG and τg are the gravity force and the
gyroscopic effect, respectively, they can be expressed according to ωi (refer to previous
works for more details). 2l is the distance between two rotors of the same branch.
Frome (1) we have:
1 0 − sθ φɺ
Ω = 0 cφ cθ sφ θɺ
0 − sφ cφ cθ ψɺ
(3)
Suppose that it is about small angles, thus we can assimilate the vector Ω to
T
φɺ θɺ ψɺ .
The dynamic model of the X4-flyer is then given by the system (4):
.. k F
x = m ( cφ sθ cψ + sφ sψ ) (ω1 + ω 2 + ω 3 + ω 4 ) − k dx xɺ
2 2 2 2
..
y = k F ( cφ sθ sψ − sφ cψ ) (ω 2 + ω 2 + ω 2 + ω 2 ) − k yɺ
m
1 2 3 4 dy
..
z = k F cφ cθ (ω12 + ω 22 + ω 32 + ω 42 ) − k dz zɺ − mg
m
.. 1
φ = ( I y − I z ) θψɺ ɺ + l .k (ω 2 − ω 2 ) − k φɺ 2 − I Ω θɺ
Ix F 4 2 dφ r
.. 1
θ = ( I z − I x ) φψ
ɺ ɺ + l .k (ω 2 − ω 2 ) − k θɺ 2 + I Ω φɺ
F 3 1 dθ r
Iy
.. 1
ψ = ( I x − I y ) φψ
ɺ ɺ + k ( −ω 2 + ω 2 − ω 2 + ω 2 ) − k ψɺ 2
Iz M 1 2 3 4 dψ
(4)
where kF, kM are the lift and moment coefficients. [kdx kdy kdz] T and [kdϕ kdθ kdψ]T are the
translational and rotational drag coefficients, and Ω = −Ω1 + Ω 2 − Ω3 + Ω 4
152
J. Automation & Systems Engineering 10-3 (2016): 150-157
3. CONTROL DESIGN
The X4-flyer is an under actuated system with four inputs vs six outputs, and strongly
coupled. So, it is important to introduce virtual inputs based like in (6), to get the desired ϕ
and θ angles.
U x = ( cφ sθ cψ + sφ sψ )
(6)
U y = ( cφ sθ sψ − sφ cψ )
The control scheme recommended is then, based on two cascade loops. According to
the desired values xd and yd, the outer control loop calculates desired roll and pitch
angles ( φd and θd ) for the inner one. The benefit of this inner control loop is to
calculate corresponding thrusts for desired altitude and attitude, then given as control
inputs for the system (U x ,U y ,U z ,U φ ,Uθ ,Uψ ) .The scheme in Figure 2 shows this
control strategy.
Based on the main approach explained in [7]-[8]-[9] the robust SMC was designed. (7)
is the system equations of the six control laws generated for x, y, z displacement and roll,
pitch and yaw angels.
where s is the SMC, λ and ξ > 0 coefficients of the SMC.
153
O. Gherouat et al.: Sliding Mode Control for a Quadrotor Unmanned Aerial Vehicle
m d k
Ux = x − λx eɺx −ξ x s1 − µ x sign ( s1 ) + dx x2
ɺɺ
U z 1 m
m d kdy
Uy= ɺɺ
x − λ y eɺ y −ξ y s2 − µ y sign ( s2 ) + x
Uz 3 m 4
d kdz
m
Uz = x − λz eɺz −ξ z s3 − µ z sign ( s3 ) +
ɺɺ x +g
cos ϕ cosθ 5 m 6
d
x7 − λϕ eɺϕ −ξϕ s4 − µϕ sign ( s4 ) −
Uϕ = I x ɺɺ
( I y -Iz )
x10 x12 +
kdϕ I
x82 + r Ωx10
Ix Ix Ix
(
I - I )
x9d − λθ eɺθ −ξ θ s5 − µθ sign ( s5 ) − z x x8 x12 + dθ x10
k 2 − I r Ωx
Uθ = I y ɺɺ
I y I y Iy 8
Uψ = I z ɺɺ
d
x11 − λψ eɺψ −ξψ s6 − µψ sign ( s6 ) −
( Ix -I y )
x8 x10 +
kdψ
2
x12
Iz Iz
(7)
4. SIMULATION RESULTS
A nonlinear control technique “Sliding Mode Control (SMC)” has been applied on a
nonlinear model of the X4-flyer with the parameters given in table 1 [6].
154
J. Automation & Systems Engineering 10-3 (2016): 150-157
Figures 3, 4, 5 and 6 represent the result of the application of the SMC on X4-flyer model.
We can see that the system states track their desired values with errors close to zero.
155
O. Gherouat et al.: Sliding Mode Control for a Quadrotor Unmanned Aerial Vehicle
5. CONCLUSIONS
This work deals with the control of an X4-flyer for the purpose of stabilizing the vehicle on
its desired trajectory. Sliding mode controller was employed in both the position and
attitude blocs. In order to further test the performance of the designed controller, the
global system (quadrotor + controller) was used to simulate in MATLAB/Simulink.
156
J. Automation & Systems Engineering 10-3 (2016): 150-157
In spite of the presence of chattering phenomena, we can see the good tracking of the
desired trajectory. It is clearly shown that all the state variables converge to their
reference values, even if these last are suddenly changed.
REFERENCES
[1] J.C.V. Junior, D.J.C. Paula, G.V. Leandro, and M.C. Bonfim, “Stability Control of a Quad-rotor Using a PID
Controller,” Brazilian Journal of Instrumentation and Control, Vol. 1, No. 1, pp. 15-20, 2013.
[2] H. Voos, “Nonlinear Control of a Quadrotor Micro-UAV Using Feedback-Linearization,” IEEE Conf.
International Conference on Mechatronics, pp. 1-6, 2009.
[3] S.A Al-Hiddabi, “Quadrotor Control Using Feedback Linearization With Dynamic Extension,” IEEE Conf. 6th
International Conference on Mechatronics and its Applications, pp. 1-3, 2009.
[4] D. Lee, H.J. Kim, and S. Sastry, “Feedback Linearization vs Adaptive Sliding Mode Control for a Quadrotor
Helicopter,” International Journal of Control, Automation and Systems, Vol. 7, No. 3, pp. 419-428, 2009.
[5] P. Castillo, R. Lozano, and A.E. Dzul, “Modelling and Control of Mini-flying Machines Springer Science &
Business Media, 2006.
[6] H. Khebbache, B. Sait, and F. Yacef, “Robust Fault Tolerant Control with Sensor Faults for a Four-Rotor
Helicopter,” International Journal of Advances in Engineering & Technology, Vol. 3, No. 1, pp. 1-13, 2012.
[7] X. Rong, and U. Ozguner, "Sliding mode control of a quadrotor helicopter,” IEEE Proc. Conference on
Decision and Control, pp. 4957-4962, 2006.
[8] E.H. Zheng, J.J. Xiong, and J.L. Luo, "Second Order Sliding Mode Control for a Quadrotor UAV,” ISA
transactions, Vol. 53, No. 4, pp. 1350-1356, 2014.
[9] L. Jinkun, X. Wang, “Advanced Sliding Mode Control for Mechanical Systems,” Berlin, Springer, pp. 41-80,
2012.
157