Sliding Mode Control Based on Backstepping Approach for ... - WASET

12 downloads 0 Views 490KB Size Report
nonholonomic constraints in order to develop a new control scheme as well as the ... Hassen Badi, BP.182, EL-Harrah, Algiers, Algeria (e-mail: [email protected]). ...... of an indoor micro quadrotor” ICRA 2004, New Orleans (USA), April.
World Academy of Science, Engineering and Technology International Journal of Mechanical and Mechatronics Engineering Vol:1, No:2, 2007

Sliding Mode Control based on Backstepping Approach for an UAV Type-Quadrotor H. Bouadi, M. Bouchoucha, and M. Tadjine

International Science Index, Mechanical and Mechatronics Engineering Vol:1, No:2, 2007 waset.org/Publication/11524

Abstract—In this paper; we are interested principally in dynamic

modelling of quadrotor while taking into account the high-order nonholonomic constraints in order to develop a new control scheme as well as the various physical phenomena, which can influence the dynamics of a flying structure. These permit us to introduce a new state-space representation. After, the use of Backstepping approach for the synthesis of tracking errors and Lyapunov functions, a sliding mode controller is developed in order to ensure Lyapunov stability, the handling of all system nonlinearities and desired tracking trajectories. Finally simulation results are also provided in order to illustrate the performances of the proposed controller.

Keywords—Dynamic modelling, nonholonomic constraints, Backstepping, Sliding mode.

U

I. INTRODUCTION

NMANNED aerial vehicles (UAV) have shown a growing interest thanks to recent technological projections, especially those related to instrumentation. They made possible the design of powerful systems (mini drones) endowed with real capacities of autonomous navigation at reasonable cost. Despite the real progress made, researchers must still deal with serious difficulties, related to the control of such systems, particularly, in the presence of atmospheric turbulences. In addition, the navigation problem is complex and requires the perception of an often constrained and evolutionary environment, especially in the case of low-altitude flights. Nowadays, the mini-drones invade several application domains [4]: safety (monitoring of the airspace, urban and interurban traffic); natural risk management (monitoring of volcano activities); environmental protection (measurement of air pollution and forest monitoring); intervention in hostile sites (radioactive workspace and mine clearance), management of the large infrastructures (dams, high-tension lines and pipelines), agriculture and film production (aerial shooting). In contrast to terrestrial mobile robots, for which it is often possible to limit the model to kinematics, the control of aerial robots (quadrotor) requires dynamics in order to account for gravity effects and aerodynamic forces [3]. H. Bouadi and M. Bouchoucha are with Control and Command Laboratory, EMP, BEB, 16111, Algiers, Algeria (e-mail: [email protected], [email protected]). M. Tadjine is with Electrical Engineering Department, ENP, 10, Ave Hassen Badi, BP.182, EL-Harrah, Algiers, Algeria (e-mail: [email protected]).

International Scholarly and Scientific Research & Innovation 1(2) 2007

In [7], authors propose a control-law based on the choice of a stabilizing Lyapunov function ensuring the desired tracking trajectories along (X, Z) axis and roll angle. However, they do not take into account nonholonomic constraints. In [9], authors do not take into account frictions due to the aerodynamic torques nor drag forces or nonholonomic constraints. They propose a control-law based on backstepping in order to stabilize the complete system (i.e. translation and orientation). In [1], authors take into account the gyroscopic effects and show that the classical modelindependent PD controller can stabilize asymptotically the attitude of the quadrotor aircraft. Moreover, they used a new Lyapunov function, which leads to an exponentially stabilizing controller based upon the PD2 and the compensation of coriolis and gyroscopic torques. While in [2] the authors develop a PID controller in order to stabilize altitude. Others papers; presented the sliding mode and high-order sliding mode respectively like an observer [14] and [15] in order to estimate the unmeasured states and the effects of the external disturbances such as wind and noise. In this paper, based on the vectorial model form presented in [2] we are interested principally in the modelling of quadrotor to account for various parameters which affect the dynamics of a flying structure such as frictions due to the aerodynamic torques, drag forces along (X, Y, Z) axis and gyroscopic effects which are identified in [2] for an experimental quadrotor and for high-order nonholonomic constraints [11]. Consequently, all these parameters supported the setting of the system under more complete and more realistic new state-space representation, which cannot be found easily in the literature being interested in the control laws synthesis for such systems. Then, we present a control technique based on the development and the synthesis of a control algorithm based upon sliding mode based on backstepping approach ensuring the locally asymptotic stability and desired tracking trajectories expressed in term of the center of mass coordinates along (X, Y, Z) axis and yaw angle, while the desired roll and pitch angles are deduced from nonholonomic constraints unlike to [9]. Finally all synthesized control laws are highlighted by simulations which gave results considered to be satisfactory.

39

scholar.waset.org/1307-6892/11524

World Academy of Science, Engineering and Technology International Journal of Mechanical and Mechatronics Engineering Vol:1, No:2, 2007

II. MODELLING

⎧ξ = v ⎪  ⎪ mξ = Ff + Ft + Fg ⎨ ⎪ R = RS ( Ω ) ⎪  ⎩ J Ω = −Ω ∧ J Ω + Γ f − Γ a − Γ g

A. Quadrotor Dynamic Modelling

International Science Index, Mechanical and Mechatronics Engineering Vol:1, No:2, 2007 waset.org/Publication/11524

Fig. 1 Typical example of a quadrotor

ξ is the position of the quadrotor center of mass with respect to the inertial frame. m is the total mass of the structure and J ∈ R 3×3 is a symmetric positive definite constant inertia matrix of the quadrotor with respect to B .

⎛ Ix ⎜ J =⎜ 0 ⎜0 ⎝

The quadrotor have four propellers in cross configuration. The two pairs of propellers (1,3) and (2,4) as described in Fig. 2, turn in opposite directions. By varying the rotor speed, one can change the lift force and create motion. Thus, increasing or decreasing the four propeller’s speeds together generates vertical motion. Changing the 2 and 4 propeller’s speed conversely produces roll rotation coupled with lateral motion. Pitch rotation and the corresponding lateral motion; result from 1 and 3 propeller’s speed conversely modified. Yaw rotation is more subtle, as it results from the difference in the counter-torque between each pair of propellers. Let E ( O, X , Y , Z ) denote an inertial frame, and B ( o ', x, y, z ) denote a frame rigidly attached to the quadrotor as shown in Fig. 2.

(1)

0

0⎞ ⎟ 0⎟ I z ⎟⎠

Iy 0

(2)

Ω is the angular velocity of the airframe expressed in B : 0 ⎛1 ⎜ Ω = ⎜ 0 cos φ ⎜ 0 − sin φ ⎝

− sin θ ⎞ ⎡ φ ⎤ ⎟⎢ ⎥ cos θ sin φ ⎟ ⎢θ ⎥ cos φ cos θ ⎟⎠ ⎢⎣ψ ⎥⎦

(3)

In the case when the quadrotor performs many angular motions of low amplitude Ω can be assimilated T to φ θ ψ . R is the homogenous matrix transformation [12].

[

]

⎛ Cθ Cψ ⎜ R = ⎜ Cθ Sψ ⎜ − Sθ ⎝

Cψ Sθ Sφ − Sψ Cφ

Cψ Sθ Cφ + Sψ Sφ ⎞ ⎟ Sψ Sθ Sφ + Cψ Cφ Sψ Sθ Cφ − Cψ Sφ ⎟ ⎟ Sφ Cθ Cφ Cθ ⎠

(4)

Where C and S indicate the trigonometrically functions cos

and sin respectively. S ( Ω ) is a skew-symmetric matrix; for a Fig. 2 Quadrotor configuration

[

given vector Ω = Ω1 Ω 2 Ω3

⎛ 0 ⎜ S ( Ω ) = ⎜ Ω3 ⎜ −Ω 2 ⎝

We will make the following assumptions: • The quadrotor structure is rigid and symmetrical. • The center of mass and o’ coincides. • The propellers are rigid. • Thrust and drag are proportional to the square of the propellers speed.

T

it is defined as follows:

−Ω3 0 Ω1

Ω2 ⎞ ⎟ −Ω1 ⎟ 0 ⎟⎠

Ff is the resultant of the forces generated by the four rotors. ⎛ cos φ cosψ sin θ + sin φ sinψ ⎞ 4 ⎜ ⎟ F f = ⎜ cos φ sin θ sinψ − sin φ cosψ ⎟ ∑ Fi (5) ⎜ ⎟ i =1 cos φ cos θ ⎝ ⎠

Under these assumptions, it is possible to describe the fuselage dynamics as that of a rigid body in space to which come to be added the aerodynamic forces caused by the rotation of the rotors. Using the formalism of Newton-Euler, the dynamic equations are written in the following form:

International Scholarly and Scientific Research & Innovation 1(2) 2007

]

Fi = K pωi2

40

scholar.waset.org/1307-6892/11524

(6)

World Academy of Science, Engineering and Technology International Journal of Mechanical and Mechatronics Engineering Vol:1, No:2, 2007

Where

K p is the lift coefficient and ωi is the angular rotor

⎧  1   2  ⎪φ = I θψ ( I y − Iz ) − K faxφ − Jr Ωθ + dU2 x ⎪ ⎪  1  2  ⎪θ = I φψ ( Iz − Ix ) − K fayθ + Jr Ωφ + dU3 y ⎪ ⎪ 1  ( Ix − I y ) − K fazψ 2 + KdU4 ⎪⎪ψ = θφ I z ⎨ ⎪ 1 ⎪x = {( CφSθCψ + SφSψ )U1 − K ftx x} ⎪ m ⎪ 1 ⎪ y = m{( CφSθ Sψ − SφCψ )U1 − K fty y} ⎪ ⎪z = 1 {( CφCθ )U − K z} − g 1 ftz ⎪⎩ m

speed. Ft is the resultant of the drag forces along ( X , Y , Z ) axis.

⎛ −K ftx 0 0 ⎞ ⎜ ⎟ Ft = ⎜ 0 0 ⎟ ξ −K fty ⎜ 0 0 −K ftz ⎟⎠ ⎝ Such as

(7)

International Science Index, Mechanical and Mechatronics Engineering Vol:1, No:2, 2007 waset.org/Publication/11524

coefficients. Fg is the gravity force.

Fg = [ 0 0 -mg ]

T

(8)

Γ f is the moment developed by the quadrotor according to

⎡ ⎤ d ( F3 − F1 ) ⎢ ⎥ d ( F4 − F2 ) Γf = ⎢ ⎥ ⎢ 2 2 2 2 ⎥ ⎢⎣ K d (ω1 − ω2 + ω3 − ω4 ) ⎥⎦

⎡U 1 ⎤ ⎛ K p ⎢U ⎥ ⎜ − K p ⎢ 2⎥ = ⎜ ⎢U 3 ⎥ ⎜ 0 ⎢ ⎥ ⎜ ⎣U 4 ⎦ ⎝ K d and

Γ a is the resultant of aerodynamics frictions torques. K fay 0

K fax , K fay and K faz are

the

frictions

(10)

aerodynamics

coefficients. Γ g is the resultant of torques due to the gyroscopic effects.

⎡ ⎤ 0 4 ⎢ ⎥ 0 Γg = ∑ Ω ∧ Jr ⎢ ⎥ i =1 ⎢ ⎥ i +1 ⎢⎣( −1) ωi ⎥⎦

}

(12)

}

which are written according to the angular velocities of the four rotors as follows:

(9)

d is the distance between the quadrotor center of mass and the rotation axis of propeller and K d is the drag coefficient.

0 ⎤ ⎥ 0 ⎥ Ω2 K faz ⎥⎦

{

With U1 , U 2 , U 3 and U 4 are the control inputs of the system

the body fixed frame. It is expressed as follows:

0

}

{

K ftx , K fty and K ftz are the translation drag

⎡ K fax ⎢ Γa = ⎢ 0 ⎢ 0 ⎣

{

Kp 0 −K p −Kd

Kp Kp 0 Kd

K p ⎞ ⎡ω12 ⎤ ⎟⎢ ⎥ 0 ⎟ ⎢ω22 ⎥ K p ⎟ ⎢ω32 ⎥ ⎟⎢ ⎥ − K d ⎠ ⎣⎢ω42 ⎦⎥

(13)

Ω = (ω1 − ω2 + ω3 − ω4 )

B. Nonholonomic Constraints Taking into account nonholonomic constraints for our system is of major importance as are in compliance with physical laws and define the coupling between various states of the system. From the equations of the translation dynamics (12) we can extract the expressions of the high-order nonholonomic constraints: ⎧ K K ⎛ ⎞ ⎛ ⎞ x − ftx x ⎟ cosψ + ⎜  y − fty y ⎟ sinψ ⎪ ⎜  m m ⎠ ⎝ ⎠ ⎪ tan θ = ⎝ K ftz ⎪   z g z + − ⎪ m ⎪ ⎨ K ftx ⎞ K ⎛ ⎛ ⎞ ⎪ x− x ⎟ sinψ + ⎜  y − fty y ⎟ cosψ − ⎜  m m ⎠ ⎪ ⎝ ⎠ ⎝ ⎪sin φ = 2 2 K K K ⎛ ⎞ ⎛ ⎞ ⎛ ⎪ x − ftx x ⎟ + ⎜  y − fty y ⎟ + ⎜  z + g − ftz ⎜  ⎪ m m m ⎝ ⎠ ⎝ ⎠ ⎝ ⎩

(11)

Such as J r is the rotor inertia. Consequently the complete dynamic model which governs the quadrotor is as follows:

(14)

⎞ z ⎟ ⎠

2

C. Rotor Dynamic The rotor is a unit constituted by D.C-motor actuating a propeller via a reducer. The D.C-motor is governed by the following dynamic equations:

International Scholarly and Scientific Research & Innovation 1(2) 2007

41

scholar.waset.org/1307-6892/11524

World Academy of Science, Engineering and Technology International Journal of Mechanical and Mechatronics Engineering Vol:1, No:2, 2007

di ⎧ ⎪⎪V = ri + L dt + keω ⎨ ⎪k i = J dω + C + k ω 2 r s r ⎪⎩ m dt

⎧ x1 = x 2 ⎪ 2 ⎪ x 2 = a 1 x 4 x 6 + a 2 x 2 + a 3 Ω x 4 + b1U 2 ⎪ x = x 4 ⎪ 3 ⎪ x 4 = a 4 x 2 x 6 + a 5 x 4 2 + a 6 Ω x 2 + b 2U 3 ⎪ ⎪ x 5 = x 6 ⎪ x = a x x + a x 2 + b U 7 2 4 8 6 3 4 ⎪ 6 ⎪ x 7 = x 8 ⎨ ⎪ x = a x + U U 1 9 8 x ⎪ 8 m ⎪ x = x 9 1 0 ⎪ ⎪ U1 ⎪ x1 0 = a 1 0 x1 0 + U y m ⎪ ⎪ x1 1 = x1 2 ⎪ C x1 C x 3 ⎪ x1 2 = a 1 1 x1 2 + U1 − g m ⎩

(15)

The different parameters of the motor are defined such:

V : motor input. ke , km : electrical and mechanical torque constant

r : motor internal resistance. J r : rotor inertia. Cs : solid friction.

Then, the model chosen for the rotor is as follows:

i ∈ [1, 4] with:

β0 =

ω i = bVi − β 0 − β1ωi − β 2ωi 2

Cs kk k k , β1 = e m , β 2 = r and b = m Jr rJ r Jr rJ r

III. SLIDING MODE CONTROL OF THE QUADROTOR The choice of this method is not fortuitous considering the major advantages it presents: − It ensures Lyapunov stability. − It ensures the robustness and all properties of the desired dynamics. − It ensures the handling of all system nonlinearities. The model (12) developed in the first part of this paper can be rewritten in the state-space form: T X = f ( X ) + g ( X ,U ) + δ and X = [ x1...x12 ] is the state vector of the system such as:

T X = ⎡⎣φ ,φ,θ ,θ,ψ ,ψ , x, x , y, y , z , z ⎤⎦

(17)

From (12) and (17) we obtain the following state representation:

(18)

⎧ − K fax ⎛ I y − Iz ⎞ −J , a3 = r ⎪a1 = ⎜ ⎟ , a2 = Ix Ix ⎝ Ix ⎠ ⎪ ⎪ ⎛ Iz − Ix ⎞ K − J fay ⎪a = ⎜ , a6 = r ⎟,a = ⎪⎪ 4 ⎜ I y ⎟ 5 Iy Iy ⎝ ⎠ ⎨ − K faz − K ftx − K fty − K ftz ⎪ ⎛ Ix − Iy ⎞ , a9 = , a10 = , a11 = ⎟ , a8 = ⎪a7 = ⎜ I I m m m z z ⎝ ⎠ ⎪ ⎪ 1 d d ⎪b1 = , b2 = , b3 = Ix Iy Iz ⎪⎩

(16)

⎧⎪ U ⎨ ⎪⎩ U

x

= C x1 S x 3 C x 5 + S x1 S x 5

y

= C x1 S x 3 S x 5 − S x1C x 5

(19)

(20)

The state representation of the system under this form has never been developed before. From high-order nonholonomic constraints developed in (14), roll ( φ ) and pitch ( θ ) angles depend not only on the yaw angle (ψ ) but also on the movements along ( X , Y , Z ) axis and their dynamics. However the adopted control strategy is summarized in the control of two subsystems; the first relates to the position control while the second is that of the attitude control as shown it below the synoptic scheme:

CONTROLEUR POSITION DE CONTROLLER POSITION

U1 Ux Uy

HOLONOMES

φd

θd

U2

SYSTEME

NON CONTRAINTES HOLONOMICS NON CONSTRAINTS

D’ATTITUDE

⎛ xd ⎞ ⎜ ⎟ ⎜ yd ⎟ ⎜ zd ⎟ ⎜⎜ψ ⎟⎟ ⎝ d⎠

CONTROLEUR

International Science Index, Mechanical and Mechatronics Engineering Vol:1, No:2, 2007 waset.org/Publication/11524

respectively. kr : load constant torque.

U3 U4

Fig. 3 Synoptic scheme of the proposed controller

In this section we develop a sliding mode controller for the quadrotor based on Backstepping approach using the technique presented in [13].

International Scholarly and Scientific Research & Innovation 1(2) 2007

42

scholar.waset.org/1307-6892/11524

World Academy of Science, Engineering and Technology International Journal of Mechanical and Mechatronics Engineering Vol:1, No:2, 2007

Using the backstepping approach as a recursive algorithm for the control-laws synthesis, we simplify all the stages of calculation concerning the tracking errors and Lyapunov functions in the following way: / i ∈ {1, 3, 5, 7, 9,11} ⎧⎪ xid − xi zi = ⎨ ⎪⎩ xi − x(i −1)d − α ( i −1) z( i −1) / i ∈ {2, 4, 6,8,10,12}

International Science Index, Mechanical and Mechatronics Engineering Vol:1, No:2, 2007 waset.org/Publication/11524

and:

V2 = With:

(22)

⎧ Sφ = z2 = x2 − x1d − α1 z1 ⎪ ⎪ Sθ = z4 = x4 − x3d − α 3 z3 ⎪⎪ Sψ = z6 = x6 − x5 d − α 5 z5 ⎨ ⎪ S x = z8 = x8 − x7 d − α 7 z7 ⎪ S = z = x − x − α z 10 10 9d 9 9 ⎪ y  ⎪⎩ S z = z12 = x12 − x11d − α11 z11

(23)

1 ⎧ ( Sφ ) −kS1 φ −ax1 4x6 −a2x22 −a3Ωx4 +φd +α1 φd −x2 1 ⎪U2 = b −qsign 1 ⎪ 1 ⎪ 2   ⎪U3 = b −q2sign( Sθ ) −k2Sθ −a4x2x6 −a5x4 −a6Ωx2 +θd +α3 θd − x4 2 ⎪ ⎪ 1 2 ⎪U4 = b −q3sign( Sψ ) −k3Sψ −a7x2x4 −a8x6 +ψd +α5 (ψd − x6 ) ⎪ 3 ⎨ ⎪U = m {−q sign( S ) −k S −a x + x +α ( x − x )} /U ≠ 0 4 x 9 8 7 d 8 1 x d ⎪ x U1 4 ⎪ ⎪U = m −q sign( S ) −k S −a x + y +α ( y − y ) /U ≠ 0 y 5 y 10 10 d 9 d 10 1 ⎪ y U1 5 ⎪ ⎪U = m −q sign( S ) −k S −a x +z +α ( z − x ) + g } z 6 z 11 12 d 11 d 12 ⎪⎩ 1 CφCθ { 6

(

{

(

{

)

Sφ = −q1sign ( Sφ ) − k1Sφ

(29)

= x2 −  x1d − α1 z1

(

  = a1 x4 x6 + a2 x2 2 + a3 Ωx4 + bU 1 2 − φd − α1 φd − x2

)

As for the Backstepping approach, the control input U2 is extracted: 1 (30) U = −q sign S − k S − a x x − a x 2 − a Ωx +φ +α φ − x b1

{

1

( ) φ

1 φ

1 4 6

The same steps extract U 3 , U 4 , U x , U y and U1 .

2 2

3

4

d

are

1

(

d

2

)}

followed

to

The simulation results are obtained based on the following real parameters [2]: ⎧ K p = 2.9842 × 10−5 N .m / rad / s ⎪ −7 ⎪ K d = 3.2320 × 10 N .m / rad / s ⎪m = 486 g ⎪ ⎪d = 25cm ⎪ −3 2 ⎪ J = diag (3.8278;3.8288;7.6566) × 10 N .m / rad / s ⎪ K = diag (5.5670;5.5670;6.3540) ×10−4 N / rad / s ⎪ fa ⎨ −4 ⎪ K ft = diag (5.5670;5.5670;6.3540) × 10 N / m / s ⎪ 2 −5 ⎪ J r = 2.8385 ×10 N .m / rad / s ⎪ β = 189.63 ⎪ 0 ⎪ β1 = 6.0612 ⎪ ⎪ β 2 = 0.0122 ⎪⎩b = 280.19

)}

(

(28)

)}

derivative of (26) satisfying Sφ Sφ < 0 :

necessary sliding condition ( SS < 0 ) must be verified; so the synthesized stabilizing control laws are as follows:

{

(

IV. SIMULATION RESULTS

sliding surfaces. To synthesize a stabilizing control law by sliding mode, the

)}

(24)

}

}

+2

(27)

The chosen law for the attractive surface is the time

2

Sφ , Sθ , Sψ , S x , S y and S z are the dynamic

Such as ( qi , ki ) ∈ \

1 2 1 2 z1 + Sφ 2 2

⎧V2 = z1 z1 +Sφ Sφ ⎪ ⎨ 2   ⎪⎩V2 = z1 z1 +Sφ ax 1 4x6 +a2x2 +a3x4Ω+bU 1 2 −φd −α1 φd − x2

The choice of the sliding surfaces is based upon the synthesized tracking errors which permitted us the synthesis of stabilizing control laws, so from (21) we define:

{

(26)

{

⎧1 2 ⎪⎪ 2 zi / i ∈ {1,3,5, 7,9,11} Vi = ⎨ ⎪ 1 (V + z 2 ) / i ∈ {2, 4, 6,8,10,12} ⎪⎩ 2 i −1 i

Such as

So:

∀i ∈ [1,12]

αi > 0

with

(21)

Sφ = z2 = x2 − x1d − α1 z1

.

Proof We know a priori from (21) and (22) that:

1 2 1 2 ⎧ ⎪V2 = z1 + z2 2 2 ⎨ ⎪⎩ z2 = x2 − x1d − α1 z1

(25) Fig. 4 Global tracking trajectory of the quadrotor by sliding mode

And from (23):

International Scholarly and Scientific Research & Innovation 1(2) 2007

43

scholar.waset.org/1307-6892/11524

World Academy of Science, Engineering and Technology International Journal of Mechanical and Mechatronics Engineering Vol:1, No:2, 2007

of mass coordinates of the system in spite of the complexity of the proposed model. As prospects we hope to develop other control techniques in order to improve the performances and to implement them on a real system. (a)

ACKNOWLEDGMENT

(b)

The authors would like to thank Dr. Taha Chettibi, PhD students Mohamed Guiatni and Karim Souissi for their help and their fruitful discussions about the stability problem of under-actuated systems. REFERENCES

International Science Index, Mechanical and Mechatronics Engineering Vol:1, No:2, 2007 waset.org/Publication/11524

(c) (d) Fig. 5 Tracking simulation results of the desired trajectories along yaw angle (ψ ) and

( X , Y , Z ) axis

[1] [2] [3] [4] [5]

(a)

(b)

[6] [7] [8] [9]

(c)

(d)

Fig. 6 Tracking errors according yaw (ψ ) angle and

[10]

( X ,Y , Z )

respectively

Fig. 4 shows the tracking of desired trajectory by the real one and the evolution of the quadrotor in space and its stabilization. Fig. 5 highlights the tracking of the desired trajectories along yaw angle (ψ ) and (X, Y, Z) axis respectively. The response time of the system is about 3s and the tracking in yaw presents a rather weak permanent error when the desired trajectory is dynamic. Fig. 6 represents the errors made on the desired trajectory tracking.

[11] [12] [13] [14] [15]

A.Tayebi, S.Mcgilvray, 2004 “Attitude stabilisation of a four rotor aerial robot”, IEEE conference on decision and control, December 1417, Atlantis Paradise Island, Bahamas 1216-1217. Derafa L. Madani t. and Benallegue A, 2006 « dynamic modelling and experimental identification of four rotor helicopter parameters » ICIT Mumbai, India. Guenard N. Hamel t. Moreau V, 2004 « modélisation et élaboration de commande de stabilisation de vitesse et de correction d’assiette pour un drone »CIFA. Hamel T. Mahoney r. Lozano r. Et Ostrowski j, 2002. “Dynamic modelling and configuration stabilization for an X4-flyer.” In the 15éme IFAC world congress’, Barcelona, Spain. Olfati. S, 2001 “nonlinear control of under actuated mechanical systems with application to robotics and aerospace vehicles », PhD thesis, MIT. P. Pounds, R.Mahony, 2002 “Design of a four rotor “ICRA, Auckland. R.Lozano, P.Castillo, and A.Dzul, 2004 “global stabilization of the PVTOL: real time application to a mini aircraft” International Journal of Control, Vol 77, Number 8, pp 735-740, may. S. Bouabdellah, P.Murrieri and R.Siegwart, 2004 “Design and control of an indoor micro quadrotor” ICRA 2004, New Orleans (USA), April. S. Bouabdellah and R.Siegwart, 2005 “Backstepping and sliding mode techniques applied to an indoor micro quadrotor” Proceeding of the 2005 IEEE, ICRA, Barcelona, Spain, April. S.Bouabdellah, A.Noth and R.Siegwart, 2004 “modelling of the (OS4) quadrotor” modelling course, EPFL, may. S. Yazir, M. Mekki and T. Chettibi, 2007 “Modélisation dynamique directe et inverse d’un quadrotor» Accepted in CGE, Algiers, Algeria, April. W.Khalil, Dombre, 2002 “modelling, identification and control of robots” HPS edition. A.Benchaib, F.Boudjema and A.Rachid“sliding mode flux observer based on backstepping approach for induction motor” World Automation congress WAC’98, Alaska, USA, may 1998. A.Mokhtari, A.Benallegue and A.Belaidi “polynomial linear quadratic Gaussian and sliding mode observer for a quadrotor unmanned aerial vehicle” Journal of Robotics and Mechatronics Vol.17 No.4, 2005. A.Mokhtari, N.K.M’sirdi, K.Meghriche and A.Belaidi “feedback linearization and linear observer for a quadrotor unmanned aerial vehicle” Advanced Robotics, Vol.20, No.1, pp. 71-91, 2006.

V. CONCLUSION In this paper, we presented stabilizing control laws synthesis by sliding mode based on backstepping approach. Firstly, we start by the development of the dynamic model of the quadrotor taking into account the different physics phenomena which can influence the evolution of our system in the space and secondly by the development of the highorder nonholonomic constraints imposed to the system motions; this says these control laws allowed the tracking of the various desired trajectories expressed in term of the center

International Scholarly and Scientific Research & Innovation 1(2) 2007

44

scholar.waset.org/1307-6892/11524