matlab

© All Rights Reserved

Als PDF, TXT **herunterladen** oder online auf Scribd lesen

13 Aufrufe

matlab

© All Rights Reserved

Als PDF, TXT **herunterladen** oder online auf Scribd lesen

- Saturn v Flight Manual
- as13
- 4 - Engine Failure in Flight
- A History of Aeronautics by E. Charles Vivian
- Quadcopter.pdf
- Tow Target Cable Drag Mechanism (1941)
- Untitled
- Engn2221 Kinematics
- What is the Secret of Birds Migration
- Apc
- Abstrat for AIAA
- 064
- Graphs
- fuel.doc
- Test 10
- Hovercraft
- Demonstration of Reality
- Axes systems, orientation and motion notation
- rocket project final
- Referce for Conclusion

Sie sind auf Seite 1von 7

CourseProject

Ifyouwouldliketoworkonsomethingdifferentthanmysuggestionbelow,pleasecontactmeas

soonaspossible.

Theclasshas40students.Iwouldliketosee10groupswith4membersineachgroup.

1 Readtheattachedpaper.

2 UseMatlaband/orSimulinktoreproducethesameresultsshowninthepaper.

Youwillpresentthepaperinfrontofclass.Wewilldecidethedateandtimeinclasslater.Every

groupwillhave12minutestofinishthepresentation.

Note:Youhavetosubmitasoftcopyofthefollowingbeforethepresentation

1 Presentationslides

2 Matlab/Simulinkcode

IftwoormoregroupsusethesameMatlab/Simulinkcode(cheating),allmembersofthesegroups

willgetanautomaticzerooutof15inthecourseproject.

Pointsdistribution:

Presentation(4points)

Topiccovering(4points)

Matlab/Simulink(8points)

International Conference on Mechatronics and Automation

August 7 - 10, Beijing, China

Jun Li Yuntang Li

College of Mechanical and Electrical Engineering College of Mechanical and Electrical Engineering

China Jiliang University China Jiliang University

Hangzhou, China Hangzhou, China

lijunever@yahoo.com.cn yuntangli@cjlu.edu.cn

Abstract - In order to analyze the dynamic characteristics takeoff and landing, hovering and other movement can be

and PID controller performance of a quadrotor, this paper achieved. For example, tumbling movement can be done if

firstly describes the architecture of the quadrotor and analyzes (2,4) get reverse control signal, pitch movement can be done if

the dynamic model of it. Then, based on the classic scheme of (1,3) get reverse control signal. If we control (1,3) and(2,4) at

PID control, this paper designs a controller, which aims to the same time, yaw movement can be achieved.

regulate the posture (position and orientation) of the 6 d.o.f.

quadrotor. Thirdly, the dynamic model is implemented in

Matlab/Simulink simulation, and the PID control parameters

are obtained according to the simulation results. Finally, a

quadrotor with PID controllers is designed and made. In order

to do the experimenta flying experiment for the quadrotor

has been done. The results of flying experiment show that the

PID controllers robustly stabilize the quadrotor.

Keywords- Quadrotor; PID controller; Dynamic model

I. INTRODUCTION

A quadrotor is a kind of non-coaxial multi-rotor aircraft

Figure 1. Schematic Diagram of a Quadrotor

which can achieve vertical take-off and landing (VTOL). The

flight attitude control of the quadrotor can be achieved only by

adjusting the speed of the four butterfly-distribution rotors. II. DYNAMIC MODELLING FOR A QUADROTOR

Compared with the conventional rotor-type aircraft, as no tail,

quadrotors have a more compact structure. four rotors lifting In order to get the mathematical modeling for the

force is more uniform than a single rotor, and thus the flight quadrotor, this paper firstly establish , shown in Figure 2.

attitude is more stable. Compared with fixed-wing aircraft, the Of which: the origin of inertial coordinate system E is the

take-off requirements of quadrotor is less, it has other initial position of the quadrotor. The positive direction of OX

advantages for example, it can hover, has a better axis is the designated heading of the quadrotor. The positive

environmental adaptability, and so on [1]. direction of OX axis is up perpendicular to the horizontal

As an important representative of multi-rotor aircrafts, the plane. OY axis is perpendicular to the plane OXZ. This

quadrotor has became a new aviation research frontier in the coordinate system is used to study the relative movement of

field of aviation and aircraft [2]. In the past few years many ground and quadrotor. The quadrotor's spatial coordinates (X,

research effort has been done in this field. Mesicopter [3] was Y, Z) can be obtained through inertial coordinate system, and

an ambitious project, which explored the ways to fabricate thus we can study the position, heading and attitude of the

centimeter-sized vehicles. Such vehicles can be used for quadrotor.

gathering planetary atmospheric and meteorological data. The The origin of quadrotor coordinate system B (Oxyz) is the

X4 Flyer project of Australian National University [5], aims at center of the quadrotor, Ox parallels to the center connection of

developing a quadrotor for indoor and outdoor applications. the front rotor and the rear rotor, and the positive direction

The control system of the vehicle is based on classical control points to the front. Oz parallels to the center connection of the

methodology. Gabe Hoffmann of Stanford University, left rotor and the right rotor, and the positive direction points to

developed a quadrotor that has achieved autonomous flight. the right. Oy axis perpendicular to the plane Oxz, the positive

Scott Hanford, designed HMX4141 quadrotor, which is direction is the direction conform to the right hand rule. This

controlled by the flight control computer in ground station [4]. two coordinate can be converted to each other through

Researchers of Massachusetts Institute of Technology use transition matrix R.

Draganflyer combining with the computer tracking system

have achieved the vision-based hovering, takeoff and landing

[6].

The movement of the quadrotor is generated by the lifting

force which is provided by the motor driven propeller.

According to the quadrotor model diagram (Fig.2), motor (1,3)

and motor (2,4) are two parts which are symmetrical with each

other. By controlling the speed of the four motor, vertical

The origin of inertial coordinate system is in the same

position with the geometric center and centroid of the

quadrotor;

Resistance and gravity of the quadrotor do not affected

by flight altitude and other factors;

Tensions in all directions are proportional to the square

of the propeller speed. K

Define Fx, Fy, Fz are components of F on the three

coordinate axes of quadrotor coordinate system; p, q, r are

K

components of on the three coordinate axes of quadrotor

coordinate system.

Stress analysis of the quadrotor is shown in Figure 2, where:

Gravity: G = mg

Figure 2. Structure model of the quadrotor

1

Resistance: Di = Cd i2 = kd i2

In figure3, the Euler angles are defined as follows: 2

Yaw angleangle between the X-axis and the projection 1

of Ox in the OXY plane. Lift of a single rotor: Ti = Cti2 = kti2

2

Pitch angleangle between the Z-axis and the projection Newton's second law and dynamics equation of the

of Oz in the OXY plane. quadrotor can be described in vector forms as following:

Roll angleangle between the Y-axis and the projection K

K dV

of Oy in the OXY plane. F =m (5)

Kdt

So, we can get the transition matrix R which is from the

quadrotor coordinate system B (Oxyz) to the inertial frame E K dH

(OXYZ). M= (6)

dt K

1 0 0

Where,F is the external forces acting on the aircraft, m is

Rx = 0 cos sin K

0 sin cos the qualityK of the quadrotor. V is the speed Kof the

(1)

cos 0 sin quadrotor, M is the moment the quadrotor suffered. H is the

angular momentum the quadrotor relative to the ground inertial

Ry = 0 1 0 frame E.

sin 0 cos

() According to mechanical analysis, Newton's second law

and dynamic equation of the quadrotor, the line motion

cos sin 0 equation can be obtained, described as follows:

Rz = sin cos 0 4 2

0 0 1 x = (Fx K1 x) m = kt i ( cos sin cos +sin sin ) K1 x m

(3) i =1

(7)

4 2

cos cos cos sin sin cos sin cos + sin sin y = (Fy K2 y) m = kt i ( sin sin cos cos sin) K2 y m

R = Rx Ry Rz = sin cos sin sin sin sin sin cos sin cos i=1

sin 4 2

cos sin cos cos z = (Fz K3 z mg) m = kt i ( cos cos ) K3 z m g

(4) i=1

The transition matrixes from every axis of quadrotor

According to the relationship between Euler angle and

coordinate system B (Oxyz) to the inertial frame E (OXYZ).

angular velocity of the quadrotor, the following result can be

obtained:

p sin

q = cos + sin cos (8)

r sin + cos cos

( p cos + q sin sin + r cos sin ) cos

Figure 3. Digram of Euler angle.

(9)

= q cos + r sin

In order to establish the dynamic model of the quadrotor,

without loss of generality, we make the following assumptions

( q sin + r cos ) cos

to the quadrotor: Previously the quadrotor has been assumed to be

The quadrotor is a symmetrical rigid body; symmetrical in quality and structure, so the inertia matrix I can

be defined as a diagonal matrix:

574

Ix In the circumstance of no wind and low wind, drag

coefficient can be ignored, so we can get the following model:

I = Iy

(10)

x = ( cos sin cos + sin sin ) U1 m

I z

K y = ( sin sin cos cos sin ) U1 m

K dH z = ( cos cos ) U1 m g

(17)

And according to M = (11)

dt ( I I ) I

= lU 2 +

y z x

We can get

= lU 3 + ( I z I x ) I y

p

( I I ) I

M = I q (12) = U +

4 x y z

r

By calculating the angular momentum, we can obtain the . DESIGN OF PID ALGORITHM

three axial components angular motion equations of M in the

quadrotor coordinate system, which is Mx, My, Mz. By define U1, U2, U3, U4, the complex nonlinear coupled

model are decomposed to the four independent control

M X pI xz + qr ( I z I y ) pqI xz

x rI

channels. So, the model can be viewed as two independent

M = qI

Y y + pr ( I x I z ) + ( p r ) I xz

2 2 (13) subsystems, which are line movement subsystem and angular

M Z rI movement subsystem.

z pI

xz + pq ( I y I z ) + qrI xz We can see from the above, line motion does not affect the

After simplification, the formula is angular motion, but the angular motion affects line motion.

Based on this, we use small perturbation method, after

p [ M x + ( I x I z )qr ] I x ignoring the small perturbation, the motion equation of the

q = M + ( I I )rp I (14) quadrotor is:

y z x y

mx = Ax + Bu

r M z + ( I x I y ) pq I z

x = [ x , y , z, p, q, r , , , ]

T

Where, state variable and

nonlinear motion equations of the quadrotor can be

controlled variable u = [u1 , u2 , u3 , u4 ] .Because there is a

T

obtained by combining the line motion equation and angular

motion equation: quasi-integral relation between the attitude angle and angular

4 velocity, in order to simplify the control system, suppose there

x = ( Fx K1 x) m = kt i2 ( cos sin cos + sin sin ) K1 x m

i =1 is simple integral relation:

4 2 = p = q = r

y = ( Fy K2 y ) m = kt i ( sin sin cos cos sin ) K2 y m (15)

i =1 When straight flying, the longitudinal motion equation of

quadrotor is x g = Ag xg + Bg u g , where, state variable

z = (Fz K3 z mg ) m = kt i2 ( cos cos ) K3 z m g

4

i =1

xg = [ x , z, q, ] , controlled variable u g = [u1 , u4 ] .

T T

p = M x + (I y I z )qr I x

Coefficient matrix is as follows:

q = M y + (I z I x )rp I y

xx xz xq x xt

x

r = M z + (I x I y ) pq I z z

z z zq z 0

z

Ag = x Bg =

(18)

= ( p cos + q sin sin + r cos sin ) cos

mx mz mq m 0

m

= q cos + r sin

= ( q sin + r cos ) cos 0 0 1 0 00

Where, l is the distance between the center of the rotor and When horizontal flying, the motion equation of quadrotor

the origin of the coordinate system. Ki is drag coefficient. is xh = Ah xh + Bh uh , where, state variable xh = [ v, p, r , , ]T ,

DefineU1, U2, U3, U4, as the inputs of the four independent

controlled variable us = u2 .

control channels:

Coefficient matrix is as follows:

4

kt i2 yv y p yr y 0

U1 F1 + F2 + F3 + F4

i =1

l

U 2 = F4 F2 = kt (42 22 ) (16) v l p lr l 0 (19)

U 3 F3 F1 Ag = nv n p nr n 0

k ( 2

2

)

0 1 0 0 0

U 4 F2 + F4 F3 F1

t 3 1

kd (12 22 + 32 42 ) 0 0 1 0 0

Where, U1 is vertical speed control input ; U2 is roll control

input; U3 is pitch control input; U4 is yaw control input; is

rotor speed; F is the tension rotor suffered.

575

TABLE II. PARAMETER OF SIMULATION

y

l

(20) N Kpn Kin Kdn

Bg = n

1 2 0.01 1

0

0 2 2 8 0.1

According to the data of the quadrotor, as well as relative 3 3 0.01 1

references, we can get the parameter table of the quadrotor:

4 3 10 0.1

TABLE I. THE PARAMETER TABLE OF THE QUADROTOR

5 5 5 1

Parameter Unit Value

6 30 1 1

M kg 1.2

L m 0.2

Kt Ns2 3.13e-5

2

Kd Nms 7.5e-7

Ix kgm2 2.353e-3

Iy kgm2 2.353e-3

Iz kgm2 5.262e-2

According to the transfer function G ( s) = (sI A) 1 B and

parameter table of the quadrotor, we can get the transfer

function of each channel: Figure 4. Simulink model of PID controller

Pitch channel:

56.95 s + 4391 (21) The simulation results show that the system overshoot is

G = =

s 3 + 105 s 2 + 870 s + 4430

1

u1 small, steady-state error is almost zero, the system response is

Roll channel: fast and the performance can be improved. System simulations

65s + 4560 (22) verify the effectiveness of the design of the control method.

G2 = =

u2 s 3 + 109 s 2 + 1023s + 2935 1.4

Yaw channel: 1.2

105 1

G3 = = (23)

u3 s + 413s 2

(ra d )

0.8

X-axis direction and pitch angle: 0.6

x x 190 s + 567 (24) 0.4

G4 = = =

s s (57.95s + 4400)

0.2

Z-axis:

z 0

z 1.63 (25) 0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5

G6 = = = t(s)

u4 su4 s ( s + 5)

(a) Step response of yaw angle

Z-axis direction and roll angle: 1.4

y y 276.4 s + 743.5 1.2

G5 = = = (26)

s s(61s + 4463) 1

0.8

(rad)

Based on PID system structure, simulink model is 0.4

built(figure.4) and simulation is done, through commissioning, 0.2

values is obtained and shown in Table 2, the step response of 0

position and attitude of the designed controller are shown in 0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5

Figure5, followed by the yaw angle, pitch angle, roll angle, X t(s)

(b) Step response of pitch angle

axis, Z axis and Y axis.

576

With respect to the mechanical structure, the frame of the

1.2 quadrotor is made by carbon fiber structure, which the chassis

of the aircraft and four motor carriers are made by high-

1

strength 3K carbon fiber board and the cross-type frame is

0.8

(ra d )

0.6 fiber is of light weight, high strength, corrosion resistance, long

0.4 life and other excellent characteristics. The landing gear of the

0.2 quadrotor is the commercial one U380. The cross-type frame

and chassis, as well as the chassis and landing gear is

0 connected by m5 hex bolts. The overall mechanical structure is

0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5

t(s) simple and practical, which meet the requirements of the

(c) Step response of roll angle design of quadrotor.

1.4

1.2

1

0.8

x(m)

0.6

0.4

0.2

0

0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5

t(s)

(d) Step response of X axis position

1.4

1.2

1

Figure 6. Picture of the Quadrotor

0.8

z(m)

0.4 obstacle-free places. When doing the test, firstly we increase

0.2 the throttle, do not control the attitude of the quadrotor, so that

0 the quadrotor will vertical launch. The test shows that the PID

0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5

t(s) controller can adjust the posture changes caused by wind or

other disturbances. The attitude data can be collected by

(e) Step response of Z axis position

angular speed sensors carried by the quadrotor itself, and

1.4 transfer to the lower level computer by bluetooth

1.2 equipment.The results shown in Figure 5, where the abscissa

1 units is 10ms, the vertical axis unit is 0.1 . The quadrotor

0.8 lifted-off in 44s; in 44 ~ 54s, it was in the air; as is shown in

y(m)

0.6 figure5, the pitch angle, the roll angle and yaw angle all change

0.4 little (5 or less).

0.2 50

Pitch Angle

0 40

0 0.5 1 1.5 2 2.5 3 3.5 4 4.5 5 30

Roll Angle

t(s) Yaw Angle

20

(f) Step response of Y axis position 10

0 .1

-10

The simulation results only can be a reference, can not be -20

directly used for the actual flight. Therefore, this paper design a -30

outdoor test, through the test, parameters can be obtained -40

eventually. -50

440 450 460 470 480 490 500 510 520 530 540

In order to do the test, we design a experimental quadrotor. t(0.1s)

It has three main tasks. Firstly, it achieves stable flight so that Figure 7. Test Results of the Flying Experiment

we can do further research for the flight control system.

Secondly, through the quadrotor, we want to design a new

mechanical structure and search for the new materials which

are suitable for making quadrotor. Thirdly, equipped with high-

definition camera, it will do fixed-point aerial photography

supported by GPS.

577

. CONCLUSION

This paper describes the architecture of a quadrotor and

analyzes the dynamic model of it. A quadrotor is designed and

made for the experiment. Based on the classic scheme of PID

control, this paper designs a controller, which aims to regulate

the posture (position and orientation) of the 6 d.o.f. quadrotor.

Simulation and experimental studies had been done to the

control system.

The simulation results show that the system overshoot is

small, at the same time the steady-state error is almost zero,

and the system response is fast, which is to say that the

performance can be improved by PID controller. So the system

simulations of verify the effectiveness of the design of the

control method.

The experiment results show that the quadrotor can achieve

attitude stabilization if the PID parameters are appropriate.

ACKNOWLEDGEMENTS

This work was sponsored by the National Nature & Science

Foundation of China under Grant 50905171, Nature & Science

Foundation of Zhejiang Province, China under Grant

Y1080100, and State Key Laboratory of Mechanical System

and Vibration of China (Shanghai Jiaotong University) under

Grant MSV-2009-09.

REFERENCES

[1] Ly Dat Minh; Cheolkeun Ha; , "Modeling and control of quadrotor

MAV using vision-based measurement," Strategic Technology (IFOST),

2010 International Forum on , vol., no., pp.70-75, 13-15 Oct. 2010

[2] Santos, M.; Lpez, V.; Morata, F.; , "Intelligent fuzzy controller of a

quadrotor," Intelligent Systems and Knowledge Engineering (ISKE),

2010 International Conference on , vol., no., pp.141-146, 15-16 Nov.

2010.

[3] Jun Wu; Hui Peng; Qing Chen; , "RBF-ARX model-based modeling and

control of quadrotor," Control Applications (CCA), 2010 IEEE

International Conference on , vol., no., pp.1731-1736, 8-10 Sept. 2010.

[4] Mian, A.A.; Wang Daobo; , "Nonlinear Flight Control Strategy for an

Underactuated Quadrotor Aerial Robot," Networking, Sensing and

Control, 2008. ICNSC 2008. IEEE International Conference on , vol.,

no., pp.938-942, 6-8 April 2008

[5] Gonzlez-Vzquez, S.; Moreno-Valenzuela, J.; , "A New Nonlinear

PI/PID Controller for Quadrotor Posture Regulation," Electronics,

Robotics and Automotive Mechanics Conference (CERMA), 2010 , vol.,

no., pp.642-647, Sept. 28 2010-Oct. 1 2010

[6] Salih, A.L.; Moghavvemi, M.; Mohamed, H.A.F.; Gaeid, K.S.; ,

"Modelling and PID controller design for a quadrotor unmanned air

vehicle," Automation Quality and Testing Robotics (AQTR), 2010 IEEE

International Conference on , vol.1, no., pp.1-5, 28-30 May 2010.

578

- Saturn v Flight ManualHochgeladen vonDamián Neri
- as13Hochgeladen vonTrip Adler
- 4 - Engine Failure in FlightHochgeladen vonst27383
- A History of Aeronautics by E. Charles VivianHochgeladen vonretrocl
- Quadcopter.pdfHochgeladen vonabhiarora4
- Tow Target Cable Drag Mechanism (1941)Hochgeladen vonCAP History Library
- UntitledHochgeladen voneurolex
- Engn2221 KinematicsHochgeladen vonAsza Shahiza
- What is the Secret of Birds MigrationHochgeladen vonBaican Cao
- ApcHochgeladen vonsanjeevs01
- Abstrat for AIAAHochgeladen vonBajrang Maheswari
- 064Hochgeladen vonandreshuelva
- GraphsHochgeladen vonSumit Agarwal
- fuel.docHochgeladen vonBookMaggot
- Test 10Hochgeladen vonnguyenhunghn09
- HovercraftHochgeladen vonsunilbakoliya786
- Demonstration of RealityHochgeladen vonwoojer
- Axes systems, orientation and motion notationHochgeladen vonDavid Jiménez Mena
- rocket project finalHochgeladen vonapi-254590210
- Referce for ConclusionHochgeladen vonTesfaye Belaye
- UCK441E.pdfHochgeladen vonakinojohnkennedy
- RELATIVEPOSITION-BASEDCOLLISIONAVOIDANCESYSTEMFORSWARMINGUAVSUSINGMULTI-SENSORFUSIONHochgeladen vonmiguel
- BESM - Big Robots, Cool Starships - 02-002Hochgeladen vonJon Denver
- Aerospace Engineering - WikipediaHochgeladen vonrpraj3135
- FAST20Hochgeladen vonApostolos Catsionson
- duar_arm1Hochgeladen vonSumil Sood
- INSPIRE_2_User_Manual_EN.pdfHochgeladen vonHans C. Duran
- syllabus.pdfHochgeladen vonbad guy
- 136206main_X.Gliders.pdfHochgeladen vonMILAD
- Aircraft 1Hochgeladen vonAhmad

- Fama Efficient Market Hypothesis PDFHochgeladen vonBrittney
- Adherence TheoriesHochgeladen vonmakmgm
- Data Mining Notes 2013Hochgeladen vonHimanshuSharma
- Addressing Real-Time Control Problems in Complex Environments Using Dynamic Multi-Objective Evolutionary ApproacheHochgeladen voncgarciahe5427
- Dealing With CompetitorsHochgeladen vonutcm77
- Bourdie - Censorship and the Imposition of PowerHochgeladen vonshibaak
- The Rio Declaration report for Environmental LawHochgeladen vondminoza
- keddilty mayall 4m telescopeHochgeladen vonapi-204948628
- DeQueiroz.2007 Species Concepts and Species DelimitationHochgeladen vonJulio Subagio
- Powerpoint Laporan Ulbs Bi 2008Hochgeladen vonFadzilah Kamarudin
- IntroductionHochgeladen vonLakshmi Kumaran
- ￼Manipulation of History (Historical Revisionism)Hochgeladen vondcocharro
- my syllabus 3020 winter 15-2docHochgeladen vonapi-312648765
- Influence Without AuthorityHochgeladen vonLakshmikanth Lazy Kanth
- My Definite Main Purpose Statement.docHochgeladen vonmommyRICH
- Construction Claims ManagementHochgeladen vontzb05
- To Have Done With the Judgement of God - ArtaudHochgeladen vonalhazred22
- Sunu1....Hochgeladen vonKaan Uçum
- Positive PsychologyHochgeladen vonDaisy
- CIR vs ConstantinoHochgeladen vonJoshua L. De Jesus
- Introduction to POMHochgeladen vonEhsanulhaq786
- Arabian Nights by Richard Burton Part 8Hochgeladen vonmranka
- acrefore-9780190846626-e-249Hochgeladen vonMohmad Yousuf
- An Early Instance of Deductive Discovery Tycho Brahe's Lunar TheoryHochgeladen vonCarolina Garcia Sanchez
- 1 Introduction to Simulation (Harrell) From PptHochgeladen vonz
- The Meronomy Relation Has Itself Some PropertiesHochgeladen vonMari Papashvili
- Phillip's Doc 8-26-17Hochgeladen vonPhillip Morgan
- Attractive Nuisance DoctrineHochgeladen vonJholo Alvarado
- 00 Physics 11se PrelimsHochgeladen vonpecan_lisa38
- padm 7420 - tabish research paperHochgeladen vonapi-334478842

## Viel mehr als nur Dokumente.

Entdecken, was Scribd alles zu bieten hat, inklusive Bücher und Hörbücher von großen Verlagen.

Jederzeit kündbar.