quadrotor assignment

46
Modeling and simulation of Quad rotor helicopter using H infinity controller ABSTRACT This report will present an integral predictive/H infinity control structure design in order to provide a solution for the path following quad rotor helicopter. By utilizing Taylor’s series this work will develop a linearized dynamic equation for the system. Therefore the developed model will be simulated by utilizing Mat lab/Simulink software. The simulation results therefore are to enhance the 2013 OKOYE CHUKWUNAENYE NNANNA .S. UNIVERSITY OF DERBY 5/29/2013

Upload: derby

Post on 26-Jan-2023

1 views

Category:

Documents


0 download

TRANSCRIPT

Modeling and simulation of Quad rotor helicopter using H infinity controllerABSTRACT

This report will present an integral predictive/H infinity control structure design in order to provide a solution for the path following quad rotor helicopter. By utilizing Taylor’s series this work will develop a linearized dynamic equation for the system. Therefore the developed model will be simulated by utilizing Mat lab/Simulink software. The simulation results therefore are to enhance the performance of the proposed control design strategy.

2013

OKOYE CHUKWUNAENYE NNANNA .S.UNIVERSITY OF DERBY

5/29/2013

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

ContentsCHAPTER 1............................................................2

INTRODUCTION........................................................2CHAPTER 2............................................................2

STATE OF ART........................................................2CHAPTER 3............................................................4

QUAD ROTOR MODEL AND SYSTEM.........................................43.1 Basic Concepts................................................4

3.2 Newton-Euler model............................................83.3 DC Motor.....................................................11

Voltage and angular velocity of propeller...........................13Voltage and thrust..................................................13

CHAPTER 4...........................................................18CONTROL ALGORITHM..................................................18

4.1 Control modeling.............................................184.2 H infinity controller........................................20

4.3 Quad rotor Simulation........................................234.3 Simulation Results...........................................25

4.4 Discussion...................................................294.5 Conclusion...................................................30

4.6 Reference....................................................304.6 Appendix.....................................................31

1 MSc in Control and Instrumentation

Modeling and simulation of Quad rotor helicopter using H infinity controllerABSTRACT

This report will present an integral predictive/H infinity control structure design in order to provide a solution for the path following quad rotor helicopter. By utilizing Taylor’s series this work will develop a linearized dynamic equation for the system. Therefore the developed model will be simulated by utilizing Mat lab/Simulink software. The simulation results therefore are to enhance the performance of the proposed control design strategy.

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

CHAPTER 1INTRODUCTIONThe design of unmanned aerial vehicles (UAV’S) have much

advantages especially in control area throughout last decades.

Currently this unmanned aerial vehicle has many applications

which include searching and rescuing operations, military

application, and wildlife protection exploration of building

together with security and inspection task. This UAV are very

important especially when all this applications are being

executed in a most dangerous and unapproachable surroundings or

environments. For the past few years the configuration of UAV in

the quad rotor has been noted in so many articles. This vehicle

mostly relies on vertical take-off and landing concepts which is

also known as VTOL which can be also utilized in the development

2 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

of control laws. Moreover in this kind of helicopter it makes use

of the equilibrium forces developed by the four rotors. Therefore

among the advantages of this configured quad rotor is its ability

of load capacity. Mostly this helicopter can be maneuverable i.e.

it can be able to maneuver in different direction which does

enable take-off and landing as well as flight in a rugged

environment. The main aims of this report are the system

modeling, control technique or algorithm, evaluation and

simulation design.

CHAPTER 2STATE OF ARTFor the past few years, the state of the art in vertical take-off

and landing (VTOL) unmanned aerial vehicle has attracted

different contributes. Some project which relies on commercially

available platforms such as Draganflyer, X-UFO and MD4-200. Some

of the researchers instead prefer to develop their own structure.

A few other works directs its attention on modeling derivation

3 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

and efficient configuration. The most important techniques and

the respective publication are now presented:

The first control is done using Lyapunov theory.

The second control is provided by PD2 feedback and PID structure.

On the contrary a PID structure does not require some specific

model parameters and the control law is much simpler to

implement.

The third control uses an adaptive technique.

While fourth control is based on linear quadratic regulator (LQR)

the main advantage of this technique is that the optimal input

signals turn out to be obtained from full state feedback by

solving the Ricatti equation.

The fifth control is done with back stepping control technique.

The sixth control is provided by dynamic feedback.

CHAPTER 34 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

QUAD ROTOR MODEL AND SYSTEMConsidering this chapter, the quad rotor models are derived. The

result is indeed crucial due to the movement of the helicopter

with respect to its inputs. Therefore through the equation it

makes it easy to predict the position acquired by the helicopter

by observing its motor speed.

3.1 Basic ConceptsA quad rotor can be said to be a model which consist of four

rotors in a cross configuration position. Concerning the cross

configuration it physical structure is light and thin, therefore

it displays robustness by connecting the motors mechanically.

While rotating the front and rear propellers rotate counter clock

wise, while both the left and right movies in clock wise

direction. Due to this configuration it does eliminate the

requirement for a tail rotor. The diagram below displays the

physical structure model in the state of hovering, where by all

the propeller has equal speed.

5 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Figure 3.1 quad rotor motor in state of

hovering

Meanwhile considering figure 3.1 the whole propellers does rotate

at the same (hovering) speed ΩH [rad s−1] in order to

counterbalance the acceleration due to gravity. Therefore, the

quad rotor will advance to stationary flight and there will not

any forces or torques which will moves it from its position. It

does obey the description of these fundamental movements which

are listed below:

Throttle (U1 [N])To enable this command, it is therefore important to increase or

decreasing the whole propeller speeds by the same voltage. It

6 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

follows a vertical force body-fixed frame which increase or

decrease the quad rotor. Therefore considering the helicopter in

horizontal position, the vertical direction of the frame and one

of the body-fixed frames correspond. Or else the given thrust

will develop both the vertical and horizontal accelerations in

the inertial frame. The diagram below displays the throttle

command on a quad rotor.

Figure 3.2 throttle motion

Roll (U2 [N m])In this command it is produce by increasing or decreasing the

speed of the left propeller and also through decreasing or

increasing the speed of the right propeller. This can leads to a

7 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

torque force in connection to the XB axis which in turn enables

the quad rotor to rotate. Therefore the general vertical thrust

is the same by comparing with the hovering state, therefore in

this command it will arise just to roll angle acceleration. The

diagram below displays roll command on a quad rotor.

Fig 3.3 roll motion

Pitch (U3 [N m])To enable this command it is almost the same with roll and is

given by increasing or decreasing the speed of the rear propeller

and by decreasing or increasing speed of the front propeller. It

gives in to a torque which is connected to YB axis which in turn

enables the quad rotor rotate. Generally vertical thrust is still8 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

the same when comparing in hovering state so therefore this

command gives in to pitch angle acceleration.

The diagram displays the pitch command on a quad rotor.

Figure 3.4 pitch motion

Yaw (U4 [N m])In order to enable this command it is by increasing or decreasing

the speed of the front rear propeller and by decreasing or

increasing the speed of left and right propeller. It gives in to

a torque in connection with the ZB axis which in turn drives the

quad rotor. The movement in yaw is developed when the left-right

propellers turns clockwise while the front-rear propeller turns

counter-clockwise. So therefore, each time the whole torque is

9 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

not balanced, the helicopter rotates itself around ZB. The

complete vertical thrust remains the same with hovering state

therefore it leads to yaw angle acceleration. The diagram below

displays the yaw on a quad rotor.

Figure 3.5 yaw motion

3.2 Newton-Euler modelIn this part of the report it gives the particular model

information concerning the quad rotor structure or architecture

which begins from the rigid body equations which was derived

using newton Euler theory. This can be group in the following:

• The earth inertial frame.

• The body-fixed frame.10 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

• The inertia matrix is time-invariant.

The motion equation is more easily created in the body-fixed

frame due to some certain reasons:

• The body symmetry can be assumed to analyze the equations.

Equation (3.1) explains the kinematics of a rigid-body.

ᶓ = JӨ V ---------------------------------------- (3.1)

Where by ᶓ is the velocity vector E-frame, V is the velocity

vector B-frame and JӨ is the generalized matrix.

ᶓ is composed of the quad rotor linear ᴦE [m] and angular ΘE

[rad] position vectors-frame as shown in equation (3.2)

ᶓ=¿ ------------------------- (3.2)

Similarly is composed of the quad rotor linear VB [m s−1] and

angular ῳB [rad s−1] velocity vectors WRT B-frame as shown in

equation (3.3)

V=¿ ---------------------------- (3.3)

In addition, the generalized matrix JӨ is composed of 4 sub-matrixes according to equation (3.4).

11 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

JӨ=[RӨ 03x303x3 TӨ

] --------------------------- (3.4)

The notation 03×3 means a sub-matrix with dimension 3 times 3

filled with all zeros while the rotation RӨ and the transfer TӨ

matrices are defined according to equations (3.5) and (3.6).

RӨ=[CΨCӨ −SΨCϕ+CΨSӨSϕ CΨSӨCϕ+SΨSϕSΨCӨ CΨCӨ+SΨSӨSϕ −CΨSϕ+SΨSӨCϕ−SӨ CӨSϕ CӨCϕ ] ------------------- (3.5)

TӨ=[1 SϕtӨ CϕtӨ0 Cϕ −Sϕ0 Sϕ/CӨ Cϕ /CӨ ]--------------- (3.6)

Considering the previous equations this notation has been

adopted: ck = cos k, sk = sin k, tk = tan k.

The dynamics of a generic rigid-body takes into account the mass

of the body m [kg] and its inertia matrix I [N m s2]. The

dynamics is described by equation (3.7).

[mI3x3 03x3

03x3 I ][VB

wB]+[wBx(MVB)WBx(IwB)]=[FBᴦB]------------------ (3.7)

12 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Where the notation I3×3 means a 3 times 3 identity matrix.VB [M

s−2] is the quad rotor linear acceleration vector B-frame while

WBB [rad s−2] is the quad rotor angular acceleration vector B-

frame. In addition, FB [N] is the quad rotor forces vector B-

frame and ᴦB [N m] is the quad rotor torques vector B-frame.

(Where c=cos and s=sin).

The equations of motion can be written using the force moment

balance

13 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

| θ¿⋅¿I

xx=(−F

1−F

2+F3

+F4)l ¿

ϕ¿⋅¿I

yy=(−F

1+F2+F3

−F4

)l ¿

ψ¿⋅¿I

zz=(τ

m1−τ

m2+τm3

−τm4

)¿

x¿

¿ y¿⋅¿=1

m∑14F

i[sinψsinθcosϕ−cosψsin ϕ] ¿

z¿⋅¿=1

m∑14 F

i[cos ϕcosθ ]−g

¿

(2)

Where Fi is the thrust force generated by motor i, l is the length

of the quad-rotor arm, τ is the torque produced by each motor, Ii

14 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

’s the moments of inertia with respect to the axes and m the mass

of the helicopter.

3.3 DC MotorThe DC-motor can be defined as an actuator which therefore

converts electrical energy into mechanical energy. It comprises

of two circuits which are electromagnetic in nature. Therefore

the first is known as rotor which moves around in seconds while

the other is known as stator which does not move. Through the

application DC-current flow in windings, the rotor rotates due to

the force develop through electrical and magnetic reactions.

Moreover the model comprises of resistor R [Ω] in series,

inductor L [H] together with a voltage generator e [V]. Finally

the voltage supplies a voltage which is proportional to the speed

of motor. The model is displays in figure 3.6

15 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Figure 3.6 motor model

Therefore circuit of DC-motor is managed by voltage generator V

[v] which in turn provides the control input. The fundamental

electrical circuit is display below in figure 3.7

Figure 3.7 motor circuit

By applying Kirchhoff’s voltage law, it follows that.

v=vZ+vL+e (3)

16 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Where v Z is the voltage across the resistor Z and v L is thevoltage across the inductor L. The equation above can berewritten as in the next equation.

v=Zi+L ∂i∂t

+KeΩ

(4)

iIs the motor current, Ke is called the motor constant and Ω is

the motor angular speed. The first term has been changed using

Ohm’s law v Z= Zi , while the second one using the inductor

differential equation v L=L ∂i

∂t . The contribution of the inductor

part is important to determine the characteristic of the DC-motor

driver.

Therefore the equation above can be simplified according to theone below.

v=Zi+KeΩ

The dynamics of the motor is described by the following equation.

JΩ¿=τm−τd

Where J the total is motor moment of inertia, Ω¿

is the motor

angular acceleration, τm is the motor torque and τd is the loadtorque.

17 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Voltage and angular velocity of propeller

Since the voltage inputs V to motors affect the rotational speedΩ of propellers.

V−e=iZ

The dynamics of the motor is described by the following equation

τm−τd=JΩ¿

(8)

Equation (8) states that when the motor torque τm and the drag

torque τd are not equal there is an acceleration (ordeceleration). The back electromotive-force voltage isproportional to motor speed

e=KeΩ (9)

The motor torque is proportional to the field current

τm=Kqi (10)

On substituting, we get

V=τdZKq

+ZJΩ

¿

Kq+KeΩ

(11)

As stated earlier, the drag torque is proportional to the squareof propeller’s speed

τd=DΩ2(12)

The relationship between angular velocity and voltage as found in[51] and [5] can thus be obtained as

18 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

V=ZDΩ2

Kq+ZJΩ

¿

Kq+KeΩ

(13)

Voltage and thrust

Voltage is the input of the quad-rotor plant and each rotorproduces a thrust force as it turns. The motor torque is known tobe proportional to the field current

τm=Kqi (14)

τmKq

=i(15)

The electrical power according to Joule’s law is

P=IV=τmKq

V(16)

And the mechanical power output is given as

Pm=ηP=ητmKq

V(17)

With η as the motor efficiency.

The propeller’s figure of merit f is defined as the ratio of

the induced power in air Ph to the mechanical power Pm [2].

f=PhPm (18)

Where Ph is given by

Ph=ηfτmKq

V(19)

19 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

The ideal power is the product of the thrust force and the speedat which it is applied. At hover Ph is

Ph=Fvh (20)

Where vh is the air velocity

ηfτmKq

V=Fvh (21)

By using the momentum theory

vh=√ F2ρA (22)

Then

ηfτmKq

V=F√ F2ρA (23)

The torque is proportional to the trust with constant ratio Ktdepends on blade geometry.

τm=KtF (24)

Then

ηfKtFKq

V=F√ F2ρA (25)

Then the relationship between thrust and voltage thus establishedas

F=2ρA [fηKtKq ]2

V2

(26)

20 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

a) Roll momentThe roll motion is about x-axis and the rolling moment caused bythe actions of motors 2 and 4 can be defined as:

ϕ¿⋅¿Iyy=(−F

1+F2

+F3−F

4)l

¿ (27)

Since F1 and F3 remain unchanged,

ϕ¿⋅¿I

yy=(F

2−F

4)l

¿ (28)

Substituting equation () for F , we have

ϕ

¿⋅¿Iyy=[(2ρA[fηKtKq ]2V22

)−(2ρA[fηKtKq ]2V42

)]l¿ (29)

The final equation for roll motion is obtained as

ϕ

¿⋅¿=2ρAlIyy [fηKtKq ]

2(V22

−V42

)

¿ (30)

b) Pitch Moment

The pitch motion is about the y-axis and the pitching momentcaused by the actions of motors 1 and 3 can be defined as:

θ¿⋅¿Ixx=(−F

1−F

2+F3

+F4

)l

¿ (31)

Just like that of the roll motion, the final equation for pitchmotion is obtained as

21 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

θ

¿⋅¿=2ρAlIxx [fηKtKq ]

2(V32

−V12

)

¿ (32)

c) Yaw moment

The yaw moment is caused by a counter-torque imbalance. Torqueabout z-axis is generally defined as

ψ¿⋅¿Izz=(τm1−τm2+τm3−τm4)

¿ (33)

From Equation (8) each motor supplies machine torque τm which isbalanced by the drag torque so the net torque on propeller is:

τm=JΩ¿+τd

The yaw torque along z-axis given by:

τzz=Izz ψ¿⋅¿=τm1+τm3−τm2−τm4

¿

Izz ψ¿⋅¿=J(Ω

¿

1+Ω

¿

3−Ω

¿

2−Ω

¿

4)+(τd1+τd3−τd2−τd4 )

¿

Since it has been assumed in equation (12) that the drag torqueis proportional to the square of propeller’s speed,

Izz ψ¿⋅¿=J(Ω

¿

1+Ω

¿

3−Ω

¿

2−Ω

¿

4)+D( Ω

12+Ω

32−Ω

22−Ω

42)

¿

ψ

¿⋅¿= JIzz

(Ω¿

1+Ω

¿

3−Ω

¿

2−Ω

¿

4)+

DIzz

12+Ω

32−Ω

22−Ω

42)

¿

22 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

d) Forces along z-axis

From equation (2), the net force at the center of mass of thevehicle is

z¿⋅¿=1

m∑14 Fi [cos ϕcosθ ]−g

¿

On substituting equation (26) for F , we have

z

¿⋅¿=2ρAm [fηKtKq ]

2

(V12+V22

+V32

+V42) (cosθcos ϕ)−g

¿

e) Forces along x-axis

By actuators action, we have the force acting along the x-axis as

On substituting and simplifying further, we have

x

¿⋅¿=2ρaAm [fηKtKq ]

2

(V12+V22

+V32

+V42)[sinϕsinψ+cosϕcos ψsinθ ]

¿

f) Forces along y-axis

Similar to that of the x-axis, actuators action produces thefollowing force, acting along the y-axis

23 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

y

¿⋅¿=2ρaAm [fηKtKq ]

2

(V12+V22

+V32

+V42)[sinψsinθcosϕ−cosψsinϕ ]

¿

CHAPTER 4CONTROL ALGORITHMThis chapter explains the entire control algorithm present in

this report. The first model was done on the Mat lab simulated

model where it was carefully done to evaluate the performance by

utilizing a mathematical approach. This chapter is related

together with the previous one due to analyzing of the quad rotor

model. This has to be done in order to utilize an easier

controller and to reduce the algorithm complexity. Furthermore,

with the help of the parameters determined in the calibration

sheet additional reductions were made possible control chain.

4.1 Control modelingThe dynamics of the quad rotor is well described in the previous

chapter. However the most important concepts can be summarized in

24 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

equations after carefully applied the Taylor series approximation

to get them linearized.

z

¿⋅¿=2ρAm [fηKtKq ]

2

(V12+V22

+V32

+V42) (cosθcos ϕ)−g

¿

For the linearized values of forces along z- axis will be solve

mathematically using Taylor series approximations

dfdV1

=dfdV2

=dfdV3

=dfdV 4

=2pAm

⌈FKtKq

⌉2(2VQ)

By applying the co-efficient

ddz ( ddz (∆Z ))=df

dz∆z+

dfdv

∆V

Therefore the linearized equation will be given as the following

¨Z=

2pAm [fktkq ]

2

(2VQ)(∆V1+∆ V2+∆V3+∆V4)

For the force acting on x-axis which is has the following

equations:

x

¿⋅¿=2ρaAm [fηKtKq ]

2

(V12+V22

+V32

+V42)[sinϕsinψ+cos ϕcos ψsinθ ]

¿

25 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

For the system to go 0.5m x or y direction the theta and phi will

be equal to 2.566 degrees

Ө = ϕ = 2.566, Ψ=0

¨Ẍ=0.00237(¿V12+V22+V32+V42)(0+1)¿

By differentiating the above equation with respect to the voltage

we obtain the following equation

dfdV1

=dfdV2

=dfdV3

=dfdV 4

=2pAm

⌈FKtKq

⌉2(2VQ)

Ẍ=0.00237(2VQ) (V12+V22+V32+V42 ¿

By repeating the above procedure for y axis we obtain the

following equation as our linearized force along y axis but with

negative constants.

Ẍ=-0.00237(2VQ) (V12+V22+V32+V42 ¿

The second system of equations explains how the control commands

that is (T1, T2, T3, and T4).

Those variables are the throttle, roll, pitch and yaw.

T1=Ut+0.7071 (Ur-Up) +Uy

26 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

T2= Ut + 0.7071(-Ur-Up)-Uy

T3=Ut+0.7071(-Ur+Up) +Uy

T4=Ut+0.7071(Ur+Up)-Uy

4.2 H infinity controller

H infinity is being utilized in control to combine controllers in

order to obtain stabilization with a good performance. In other

to utilize H∞ methods, a control engineer convey the control

problem as optimized problem therefore looks for a controller

that solves this issues. H∞ techniques possess a better

performance over classical control techniques to which it is used

to solve problems that deal with multivariable systems in as much

as cross-coupling between channels. It’s very crucial to

understand that the resulting controller is only optimal with

regard to the cost function which does not represent the best

controller in terms of the usual performance measures used to

evaluate controllers such as settling time, energy expended, etc.

H∞ can be regarded as a function of a maximum singular values27 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

over a space. (This can be described as a total gain in every

direction and at some frequency, considering SISO systems; this

is efficiently the total magnitude of the frequency

response.). H∞ techniques can equally be used to reduce the

closed loop effect of a perturbation, which does depending on the

problem formulation; the effect will be obtained in terms of

stabilization or performance.

It can be derived by dissolving Riccati’s two equations.

To design an H infinity controller there are some steps that must

be followed first of all is to select the initial value of ᵞo and

З which are choose from 1 and 0.01 consecutively.

Then select the weighted matrixes W1, W2, W3 then construct the

controller object. The flow chart together with the design step

of the controller is display as follows

28 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

29 MSc in Control and Instrumentation

Start

Initialize ϒo and Є

Choose theweighted matrix

Validateweather the

Judgewhetterclose

loop is

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

4.3 Quad rotor SimulationThe simulation was done by using mat lab/Simulink. The quad rotor

system design using the above equation presented.

30 MSc in Control and Instrumentation

Validation ϒ<ϒo

ADD the ϒ0

END

Reducethe ϒ0

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Quad rotor model

31 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Motor Mixing model

4.3 Simulation Results

Vertical movement In order to attain a particular height, all the voltage inputswere varied at the same rate.

Ω1 Ω2 Ω3 Ω4 Θ ɸ Ψ X Y ZV1 =32.55555

357.876

1.5010

V2 =32.55555

357.876

V3 = 32.55555

357.876

V4 = 32.55555

357.876

V1 =32.55655

356.831

1.5059

V2 =32.55655

356.831

V3 =32.55655

356.831

V4 =32.55655

356.831

V1 =32.55755

357.887

1.5109

V2 =32.55755

357.887

32 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

V3 =32.55755

357.887

V4 =32.55755

357.887

V1 =32.55855

357.892

1.5158

V2 =32.55855

357.892

V3 =32.55855

357.892

V4 =32.55855

357.892

Ω1 Ω2 Ω3 Ω4 Θ ɸ Ψ X Y ZV1 =32.55555

357.892

2.44 0 5.522

0.019

0.495

1.5074

V2 =32.55655

357.881

V3 = 32.55555

357.892

V4 = 32.55455

357.870

V1 =32.55555

356.892

4.888

0 5.522

0.033

-0.99

1.504

V2 = 356.88

33 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

32.55755 6V3 =32.55555

356.892

V4 =32.55355

357.864

V1 =32.55555

357.892

7.333

0 5.522

0.057

-1.49

1.494

V2 =32.55855

357.8922

V3 =32.55555

357.892

V4 =32.55255

357.859

V1 =32.55555

357.838

9.77 0 5.522

0.07 -1.98

1.491

V2 =32.55955

357.838

V3 =32.55555

357.838

V4 =32.55155

357.838

Ω1 Ω2 Ω3 Ω4 Θ ɸ Ψ X Y ZV1 =32.55555

357.870

0 2.44 5.522

0.495

0.019

1.5074

V2 =32.55655

357.892

34 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

V3 = 32.55555

357.881

V4 = 32.55455 357.89

2V1 =32.55555

357.864

0 4.888

5.522

-0.99

0.033

1.504

V2 =32.55755

356.892

V3 =32.55555

357.886

V4 =32.55355 356.89

2V1 =32.55555

357.859

0 7.333

5.522

-1.49

0.057

1.494

V2 =32.55855

357.892

V3 =32.55555

357.8922

V4 =32.55255

357.892

V1 =32.55555

357.838

0 9.77 5.522

-1.98

0.07 1.491

V2 =32.55955

357.892

V3 =32.55555

357.838

V4 =32.55155 357.89

2

35 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Yaw

Ω1 Ω2 Ω3 Ω4 Θ ɸ Ψ X Y ZV1 =32.55655

357.881

0 0 3.684

0 0 1.5010

V2 =32.55455

357.870

V3 = 32.55655

357.881

V4 = 32.55455

357.870

V1 =32.55755

356.886

0 0 7.359

0 0 1.5010

V2 =32.55355

356.864

V3 =32.55755

356.886

V4 =32.55355

356.864

V1 =32.55855

357.892

0 0 11.04

0 0 1.5100

V2 =32.55255

357.859

V3 =32.55855

357.892

V4 =32.55255

357.859

36 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

V1 =32.55955

357.897

0 0 14.71

0 0 1.5010

V2 =32.55155

357.853

V3 =32.55955

357.897

V4 =32.55155

357.853

Linear model simulation resultsMoving in the Z axis

Ω1 Ω2 Ω3 Ω4 Θ ɸ Ψ X Y ZV1 =32.55555

357.822

1.296

V2 =32.55555

357.822

V3 = 32.55555

357.822

V4 = 32.55555

357.822

V1 =32.55655

356.827

1.3002

V2 =32.55655

356.827

V3 =32.55655

356.827

V4 =32.55655

356.827

37 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

V1 =32.55755

357.833

1.3044

V2 =32.55755

357.833

V3 =32.55755

357.833

V4 =32.55755

357.833

V1 =32.55855

357.838

1.3087

V2 =32.55855

357.838

V3 =32.55855

357.838

V4 =32.55855

357.838

generating a phi angle

Ω1 Ω2 Ω3 Ω4 Θ ɸ Ψ X Y ZV1 =32.55555

357.821

0 2.421

0 0.0585

-0.0585

1.296

V2 =32.55655

357.827

V3 = 32. 357.821

38 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

55555V4 = 32.55455

357.816

V1 =32.55555

356.821

0 4.841

0 0.0585

-0.0585

1.296

V2 =32.55755

356.832

V3 =32.55555

356.821

V4 =32.55355

357.810

V1 =32.55555

357.821

0 7.262

0 0.0585

-0.0585

1.296

V2 =32.55855

357.838

V3 =32.55555

357.821

V4 =32.55255

357.804

V1 =32.55555

357.821

0 9.682

0 0.0585

-0.0585

1.296

V2 =32.55955

357.844

V3 =32.55555

357.821

V4 =32.55155

357.799

39 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

Ω1 Ω2 Ω3 Ω4 Θ ɸ Ψ X Y ZV1 =32.55555

357.816

2.421

0 0 -0.0585

0.0585

1.296

V2 =32.55655

357.821

V3 = 32.55555

357.827

V4 = 32.55455 357.82

1V1 =32.55555

357.810

4.841

0 0 -0.0585

0.0585

1.296

V2 =32.55755

356.821

V3 =32.55555

356.832

V4 =32.55355

356.821

V1 =32.55555

357.804

7.262

0 0 -0.0585

0.0585

1.296

V2 =32.55855

357.821

V3 =32.55555

357.838

V4 =32.55255 357.82

1V1 =32.55555

357.799

9.682

0 0 -0.058

0.0585

1.296

40 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

5V2 =32.55955

357.821

V3 =32.55555

357.844

V4 =32.55155 357.82

1

4.4 Discussion When considering the non-linearized model it is observed at

the state of hovering which enabling the quad rotor to

attend a height of 1.5m vertical direction the angular

values are all zero. Therefore the voltage at which the

helicopter hover is 32.5555volt, therefore

V1=V2=V3=V4=32.5555v.

As the voltages increases so do the vertical height of the

helicopter increase which make its proportional to the

voltages.

For the linearized model after acquiring the linearized

model for the x axis and y axis it was observed that when

41 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

the voltage are being change that is V1 and V3 the X and Y

axis which is the distance was not moving.

Another observation noticed was that for the nonlinear model

the angular distance was affecting the movement of the

helicopter while linearize model the angular distance has no

effect on the z, y and x.

4.5 ConclusionThe objective of this test was not successful because the

linearized model for y axis and x axis is mathematically wrong so

the values when the simulation is being debugged show wrong

values.

And beside the H infinity controller was not achieved because the

group initially was supposed to use visual feedback for the model

controller but because school does not have the required

facilities or equipment (camera) for the model. So therefore the

group members decide to use another controller which is H

infinity but when the decision was made it was late for the group

to work on the controller so extra extension was ask but was42 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

turned down so because of the limited time the group was not able

to develop the controller for the assignment.

4.6 Reference Jianying Liu, Shiyue Liu, Qingbo Geng “ The H infinity

Control Algorithm of 3-DOF four Rotor System” Beinjin

Institute of Technology, 2012

University of Derby, Msc in control and instrumentation,

interim report, “Modelling and stimulation of Quad rotor

Helicopter’’

Tommaso Bricsciani, “Modeling, Identification and Control of

a Quad rotor helicopter”, Department of Automatic control

Lund University, October 2008.

43 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

4.6 Appendix

44 MSc in Control and Instrumentation

Modeling and simulation of Quadrotor helicopter using H infinity

controller

2013

45 MSc in Control and Instrumentation