CN108445895B - Robust control method for position control of tilting type three-rotor unmanned aerial vehicle - Google Patents
Robust control method for position control of tilting type three-rotor unmanned aerial vehicle Download PDFInfo
- Publication number
- CN108445895B CN108445895B CN201810113891.XA CN201810113891A CN108445895B CN 108445895 B CN108445895 B CN 108445895B CN 201810113891 A CN201810113891 A CN 201810113891A CN 108445895 B CN108445895 B CN 108445895B
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- rotor unmanned
- tilting
- coordinate system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 16
- 238000013461 design Methods 0.000 claims abstract description 20
- 239000011159 matrix material Substances 0.000 claims description 23
- 230000008878 coupling Effects 0.000 claims description 7
- 238000010168 coupling process Methods 0.000 claims description 7
- 238000005859 coupling reaction Methods 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 5
- 238000001914 filtration Methods 0.000 claims description 4
- 239000000126 substance Substances 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 230000005484 gravity Effects 0.000 claims description 2
- 238000011217 control strategy Methods 0.000 abstract description 4
- 230000008569 process Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 238000002474 experimental method Methods 0.000 description 6
- 238000004458 analytical method Methods 0.000 description 5
- 238000004088 simulation Methods 0.000 description 4
- 230000003044 adaptive effect Effects 0.000 description 3
- 238000005259 measurement Methods 0.000 description 3
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000013178 mathematical model Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 230000003068 static effect Effects 0.000 description 2
- 239000000725 suspension Substances 0.000 description 2
- 208000010718 Multiple Organ Failure Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000005065 mining Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004806 packaging method and process Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000002123 temporal effect Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Remote Sensing (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Algebra (AREA)
- Mathematical Analysis (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Pure & Applied Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention relates to nonlinear control of a position of a tilting type three-rotor unmanned aerial vehicle, and designs a controller of a position subsystem and an attitude subsystem of the tilting type three-rotor unmanned aerial vehicle aiming at the problem of an inner and outer ring control strategy of the tilting type three-rotor unmanned aerial vehicle, so that the robust control method for the position control of the tilting type three-rotor unmanned aerial vehicle comprises the following steps: 1) establishing a coordinate system related to the tilting three-rotor unmanned aerial vehicle: 2) establishing a dynamic model of the position and the posture of the tilt rotor unmanned aerial vehicle: 3) design non-linear controller a) position subsystem controller design b) attitude subsystem controller design. The invention is mainly applied to the nonlinear control occasion of the position of the three-rotor unmanned aerial vehicle.
Description
Technical Field
The invention relates to a nonlinear control design of a position of a tilting type three-rotor unmanned aerial vehicle, in particular to a robust control method for the position control of the tilting type three-rotor unmanned aerial vehicle.
Background
Three rotor unmanned vehicles of formula of verting have fused the two advantage of many rotors helicopter and the formula of verting aircraft, are keeping many rotors helicopter VTOL, on the basis of the characteristics of the operation of being convenient for, have increased the steering wheel at the tail vane, have improved power unit, therefore also possess the formula of verting aircraft maneuverability reinforce, advantage such as payload is big possesses certain research potentiality and research value.
As one of the multi-rotor unmanned aerial vehicle, the tilting type three-rotor unmanned aerial vehicle has the characteristics of static instability, underactuation, strong coupling, nonlinear mathematical model and the like. Static instability requires that a control strategy designed for a multi-rotor unmanned aerial vehicle must be a real-time control law; the under-actuated characteristic shows that the multi-rotor unmanned aerial vehicle is difficult to realize the independent control of six degrees of freedom, and the coupling of related degrees of freedom is required; the strong coupling and the nonlinearity of the mathematical model require that the designed controller has good robustness, and meanwhile, the control difficulty of the type of the aircraft is increased due to various uncertain factors in the flight process of the unmanned aerial vehicle.
Researchers at the university of France' S Gongbene technology establish a dynamic model of the attitude and position of a tilting three-rotor unmanned aerial vehicle under the condition of neglecting the lateral force generated by a tail rudder, and design an attitude and position controller of the unmanned aerial vehicle by combining a saturation function and a proportional differential controller, wherein the position Control precision is within 0.1m, the Control precision of a roll angle and a pitch angle is within 2, and the Control precision of a yaw angle is within 5 (journal: Control Engineering Practice; author: Salazar-Cruz S, Lozano R,J, published month and year: 2009; the article title: stabilization and nonlinear control for a novel triotor mini-aircraft, page number: 886-: IEEE Transactions on Aerospace&Electronic Systems; the authors: Salazar-Cruz S, Kendoul F, Lozano R, published New year month: 2008; the article title: real-time stabilization of a small thread-rotor aircraft, page number: 783-794).
The researcher of national defense science and technology university combines together three rotor unmanned aerial vehicle structures of formula of verting and fixed wing aircraft, keeps the tail vane motor fixed, installs the steering wheel under the motor of front side to install the wing additional in unmanned aerial vehicle fuselage both sides, obtained a comparatively nimble wing section structure. The configuration effectively improves the endurance time of the unmanned aerial vehicle, enhances the maneuvering performance of the unmanned aerial vehicle, and makes the analysis and the control of the unmanned aerial vehicle dynamic model more complex. Researchers mainly study the dynamic model of the unmanned aerial vehicle and verify the dynamic model on a suspension type experiment platform. A PI-PD dual-ring controller is designed on The basis of The prior art, The stabilization of The speed and The posture of The unmanned aerial vehicle is realized, and The numerical simulation verification is carried out (The Conference: The 35th Chinese Control Conference (CCC); The authors: Chen A, Zhang D, Zhang J; The publication year: 2016; The article title: A new structural configuration of The top unmanned aerial vehicle temporal modification; The page number: 2120-.
The steering wheel is all installed to mining schools such as national paris in France below the brushless direct current motor of each axle of three rotor unmanned aerial vehicle, and the inclination of its every motor rotation axis can independently be adjusted, therefore this kind of three rotor unmanned aerial vehicle has possessed stronger maneuverability. Researchers analyze the stress condition of the unmanned aerial vehicle, deduce a dynamic model of the attitude and the position, on the basis, a control scheme based on flatness is designed aiming at the problem of trajectory tracking of the three-rotor unmanned aerial vehicle, and the circular Trajectory tracking flight experiment is completed, the diameter of the reference Trajectory is about 2.0m, and the control precision is within 0.2m (Conference: the International Conference on Unmanned air Systems; authors: service E, D 'Andrea-Novel B, Mounder H; published month: 2015; article title: group control of a hybrid tracker; page number: 945. 950) (Conference: International Conference on Methods and MODS in Automation and Robotics; authors: service E, D' Andrea-Novel B, Mounder H; published month: 2015; article title: Trajectory UAV packaging with suspension load; and du: 517. 522).
Disclosure of Invention
In order to overcome the defects of the prior art, the invention aims to provide a controller for a position subsystem and an attitude subsystem of a tilting three-rotor unmanned aerial vehicle aiming at the problem of an inner and outer ring control strategy of the tilting three-rotor unmanned aerial vehicle, and therefore, the robust control method for the position control of the tilting three-rotor unmanned aerial vehicle comprises the following steps:
1) establishing a coordinate system related to the tilting three-rotor unmanned aerial vehicle:
defining two coordinate systems, namely an inertial coordinate system { I } and a body coordinate system { B }, which both meet the right-hand rule, wherein the origin of the inertial coordinate system { I } is located on the ground, the origin of the body coordinate system { B } is located in the mass center of the three-rotor unmanned aerial vehicle, { E }x Ey EzAnd { B }x By BzRespectively representing three main shafts corresponding to an inertial coordinate system (I) and a body coordinate system (B);
2) establishing a dynamic model of the position and the posture of the tilt rotor unmanned aerial vehicle:
the position model is represented as:
wherein x, y and z respectively represent coordinate values of the centroid position of the tilting three-rotor unmanned aerial vehicle in an inertial coordinate system { I }, and FzTo representThe unmanned plane is in an inertial coordinate system { I }, EzThe lift force in the axial direction, m represents the mass of the unmanned aerial vehicle, phi, theta and psi respectively represent the attitude information of the unmanned aerial vehicle, namely the roll angle, the pitch angle and the yaw angle, g represents the gravity acceleration, d represents the disturbance acceleration introduced by a tail rudder of the tilting three-rotor unmanned aerial vehicle, and H (e)η,ηd) Express three rotor unmanned aerial vehicle ectonexine coupling parts of tilting, v expresses three rotor unmanned aerial vehicle's of tilting controller, expresses as:
in the above formula, phid、θd、ψdRespectively obtaining the target roll angle, the target pitch angle and the target yaw angle of the unmanned aerial vehicle obtained by resolving through a position controller;
the attitude dynamics model of the tilting three-rotor unmanned aerial vehicle is expressed as follows:
where M (η) is an inertia matrix, abbreviated as M,a matrix of coriolis forces and centripetal forces, which may be referred to as C,the kinetic moment of each channel of the unmanned aerial vehicle is eta (t) [ [ phi ] theta ] psi]TThe attitude of the drone is represented and,psi represents an angular velocity conversion matrix from a body coordinate system { B } to an inertial coordinate system { I } for a disturbance moment vector received by the unmanned aerial vehicle in the body coordinate system { B };
3) designing a non-linear controller
a) Position subsystem controller design
When designing the outer loop control ware, the three rotor unmanned aerial vehicle kinetic model that vert that adopts is as shown as follows:
the outer loop error is denoted as EηAnd designing an error system filter gamma, and constructing a disturbance observer as shown in the following formula:
defining the intermediate variable δ ═ s-z and substituting into the formula above to obtain:
wherein the content of the first and second substances,as an observed value of disturbance d of a formula system, a reasonable assumption is made, and when the lateral force disturbance d and a derivative thereof are bounded, a condition d is less than or equal to | M1|,Estimating disturbancesThe first derivative with respect to time of (a) is designed as:
in the above formulaAre diagonal parameter matrixes, and simultaneously, a position loop controller v is designed as follows:
b) attitude subsystem controller design
Utilize three rotor unmanned aerial vehicle attitude dynamics models of tilting type that following formula shows:
where M (η) is an inertia matrix, abbreviated as M,an attitude angle tracking error is defined for the Coriolis force and centripetal force matrix, denoted CAnd filtering errorRepresented by the formula:
eη=η-ηd,
wherein etad=[φd θd ψd]TRepresenting a target pose of the drone,is a positive diagonal normal coefficient matrix. The first derivative with respect to time is taken for r η to obtain the following equation:
wherein N is defined as an intermediate variable expressed as
simultaneous definition ofDefinition sη=[eη rη]TTherefore, the attitude control power moment tau of the tilting type three-rotor unmanned aerial vehicle can be designed as follows:
τ=(ΨT)-1(-Krrη-Γ1sign(rη)-Γ2||sη||sign(rη))
The invention has the characteristics and beneficial effects that:
aiming at the position control of the tilting type three-rotor unmanned aerial vehicle, the position-attitude double-loop kinetic model of the unmanned aerial vehicle is established, and a position controller and an attitude controller based on the unmanned aerial vehicle are designed on the basis, so that the position control of the tilting type three-rotor unmanned aerial vehicle can be effectively realized, better control stability is kept, and certain robustness is achieved.
Description of the drawings:
fig. 1 is a schematic diagram of the present invention employing a tilt-type three-rotor drone;
FIG. 2 is a schematic diagram of a coordinate system employed in the present invention;
FIG. 3 is a block diagram of a dual-ring controller designed by the present invention;
fig. 4 is a schematic diagram of a curve of a rectangular trajectory tracking flight process of the unmanned aerial vehicle after the control scheme is adopted.
a is an attitude error curve of the unmanned aerial vehicle in the rectangular track tracking flight process after the control scheme is adopted;
b, adopting the control scheme to track the actual position curve of the flight process by the rectangular track of the unmanned aerial vehicle;
c, adopting the control scheme to obtain a position error curve of the rectangular track tracking flight process of the unmanned aerial vehicle;
d is a position three-dimensional schematic diagram of the rectangular track tracking flight process of the unmanned aerial vehicle after the control scheme is adopted.
Detailed Description
The invention aims to solve the technical problem that a nonlinear controller which has better robustness and can ensure the stability of a position-attitude closed-loop coupling closed-loop system is designed for a tilting type three-rotor unmanned aerial vehicle with a tail rudder inclination angle capable of being independently controlled.
The technical scheme adopted by the invention is as follows: the method comprises the following steps of establishing a position-attitude double-loop dynamic model of the tilting three-rotor unmanned aerial vehicle, and designing a corresponding nonlinear controller, wherein the method comprises the following steps:
the following definitions are first accomplished: two coordinate systems are defined, an inertial coordinate system { I } and a body coordinate system { B } as shown in FIG. 2. The origin of the inertial coordinate system { I } is located on the ground, and the origin of the body coordinate system { B } is located in the center of mass of the three-rotor unmanned aerial vehicle, and both meet the right-hand rule. Defining the attitude angle of the tilting three-rotor unmanned plane in an inertial coordinate system as eta ═ phi theta psi]TWherein phi, theta and psi respectively represent the roll angle, yaw angle and pitch angle of the unmanned aerial vehicle. In an inertial coordinate system { I }, a position vector of the tilting three-rotor unmanned aerial vehicle is represented as epsilon ═ x y z]TWherein x, y, z respectively represent { E } of the three-rotor unmanned aerial vehicle under an inertial coordinate system { I }x Ey EzCoordinate values on the axis. In the inertial coordinateIn the system { I }, the target attitude of the tilting type three-rotor unmanned aerial vehicle is defined as etad=[φd θd ψd]TWherein phid、θd、ψdRespectively representing target roll angle, pitch angle, yaw angle, epsilond=[xd yd zd]TIs defined as the target position of the drone, where xd、yd、zdRespectively representing the target position of the unmanned aerial vehicle. The target position and attitude and its derivative with respect to time are bounded. Under the body coordinate system { B }, three rotor unmanned aerial vehicle of tilting, the angular velocity of each gesture passageway of this unmanned aerial vehicle expresses as
The second pair of tilting type three-rotor unmanned aerial vehicle is subjected to stress analysis, and a position dynamic model of the three-rotor unmanned aerial vehicle with a downward tilting rotation inertial coordinate system (I) is establishedWherein R istRepresenting a rotation matrix transformed from the bulk coordinate system { B } to the inertial coordinate system { I },for under body coordinate system { B }, the power that three rotor unmanned aerial vehicle rotors of formula of verting and steering wheel produced shows as:
the equations of dynamics for this drone can therefore be written as:
therefore, the tilting type three-rotor unmanned plane position ring dynamic model can be written as follows:
in the normal flight process of the tilting three-rotor unmanned aerial vehicle, the lateral force under a body coordinate system (B)The lift force of the tail rudder is represented as ByProjection on axis, denoted f3sin α, normally overriding this force at drone B when controlling the position of a tilt-type tri-rotor droneyAcceleration of direction due to both the magnitude of the force and the total lift FzCompared to a smaller value. Because the model can contain FyIs treated as a bounded perturbationTherefore, the position dynamics model of the unmanned aerial vehicle can be rewritten into the following model:
whereinIndicating lateral force F from tail rudderyThe unknown bounded perturbation introduced into the system can be expressed as:
wherein Fz、φd、θd、ψdRespectively represent byThe target vertical lift force, the target roll angle and the target pitch angle obtained by the position outer ring controller and the target yaw angle of the system can be solved to obtain Fz、φd、θdAs follows:
closed loop system position error system is defined hereinAnd attitude error systemAs shown in the following formula:
whereinDefined as the difference between the reference position trajectory and the actual position of the drone, written Eη=ε-εd,Is defined as the difference between the attitude reference trajectory of the unmanned aerial vehicle and the actual attitude angle, and is written as eη=η-ηdThus, the following formula can be obtained:
φ=eφ+φd
θ=eθ+θd
ψ=eψ+ψd.
from the trigonometric function sum and difference formula, the kinetic model of the position subsystem can be rewritten as:
whereinRepresenting the coupling terms of the inner and outer rings of a rotor unmanned aerial vehicle system, which can be written as H (e)η,ηd)=[Hx(eη,ηd)Hy(eη,ηd)Hz(eη,ηd)]T. The position dynamics model of a tilt-type tri-rotor drone can therefore be expressed as:
thirdly, establishing an attitude dynamics model of the tilting three-rotor unmanned aerial vehicle,represents the moment of inertia matrix, j, of the three-rotor unmanned aerial vehicle1、j2、j3The rotational inertia of the unmanned aerial vehicle in the rolling channel, the pitching channel and the yawing channel is respectively expressed as:Ψ (η) is an angular velocity transformation matrix, whose expression is:
a dynamic model which takes the power moment of the unmanned aerial vehicle as control input is established by using an integral moment analysis method for the tilting type three-rotor unmanned aerial vehicle:
wherein M (η) represents an inertia matrix, which is defined as M (η) ═ ΨTJ Ψ is a positive definite symmetric matrix,representing a matrix of Coriolis force and centripetal force, the definition of whichτd=[τdφτdθτdψ]TRepresenting unknown external disturbance torques on the roll, pitch, yaw channels of the three-rotor drone. As shown in FIG. 1 with l1、l2、l3Come to show each rotor to the arm of force of this unmanned aerial vehicle barycenter, c shows the counter-torque coefficient, three rotor unmanned aerial vehicle's of formula of verting each gesture passageway dynamic moment this momentCan be expressed as:
after the dynamic model of the position posture is established, the design idea for the inner and outer ring control strategies of the tilting three-rotor unmanned aerial vehicle is shown in fig. 3 and respectively:
1. designing a control law for a position ring of the tilting type three-rotor unmanned aerial vehicle to make the position error x of the unmanned aerial vehicle converge to 0;
2. designing a control law for an attitude ring of the tilting type three-rotor unmanned aerial vehicle to make an attitude error xi of the unmanned aerial vehicle converge to 0;
the fourth is accomplished the nonlinear control ware design to three rotor unmanned aerial vehicle positions of tilting and gesture respectively, when design position ring control ware, the three rotor unmanned aerial vehicle kinetic model of tilting that adopt as shown in the following formula:
the outer loop error may be denoted as EηAnd an error system filter gamma is designed. Here, a disturbance observer can be constructed as follows:
defining the intermediate variable δ -s-z and substituting into the above formula, one can obtain:
whereinAs an observed value of disturbance d of a formula system, a reasonable assumption is made, and when the lateral force disturbance d and a derivative thereof are bounded, a condition d is less than or equal to | M1|,The disturbance can be estimatedThe first derivative with respect to time of (a) is designed as:
in the above formulaAre diagonal parameter matrixes, and simultaneously, a position loop controller v is designed as follows:
On the basis, the design of the attitude controller of the unmanned aerial vehicle is changed, and the tracking error of the attitude angle is definedAnd filtering errorRepresented by the formula:
eη=η-ηd,
wherein etad=[φd θd ψd]TRepresenting a target pose of the drone,is a positive diagonal normal coefficient matrix. To rηThe first derivative with respect to time is found as follows:
wherein N is defined as an intermediate variable expressed as
simultaneous definition ofDefinition sη=[eη rη]TTherefore, the attitude control power moment tau of the tilting type three-rotor unmanned aerial vehicle can be designed as follows:
τ=(ΨT)-1(-Krrη-Γ1sign(rη)-Γ2||sη||sign(rη)).
wherein Kr、Γ1And gamma2Are positive diagonal parameter matrixes and can be adjusted by self.
The nonlinear controller for the position control of the tilting three-rotor unmanned aerial vehicle is designed.
The following describes the establishment of the dynamic model and the design of the nonlinear controller and the adaptive law in combination with the real derivation and the attached drawings.
The invention comprehensively aims at the problem of flight position control of the tilting three-rotor unmanned aerial vehicle, and establishes a position-attitude dynamic model of the tilting three-rotor unmanned aerial vehicle due to the under-actuated characteristic of the unmanned aerial vehicle, and designs a nonlinear controller respectively aiming at the position control and the attitude control of the tilting three-rotor unmanned aerial vehicle on the basis, thereby realizing the position control of the unmanned aerial vehicle under an inertial coordinate system { I }.
The invention designs a position nonlinear controller of a tilting type three-rotor unmanned aerial vehicle, which comprises the following steps:
1) establishing a coordinate system related to the tilting three-rotor unmanned aerial vehicle:
in order to facilitate the design of the nonlinear controller and the adaptive law, the present invention defines a coordinate system as shown in fig. 2.
In order to facilitate the design of the nonlinear controller and the adaptive law, two coordinate systems are defined as an inertial coordinate system { I } and a body coordinate system { B } which meet the right-hand rule, the origin of the inertial coordinate system { I } is located on the ground, and the body is located on the groundThe origin of coordinate system { B } is located at the center of mass of the triple rotor drone, { Ex Ey EzAnd { B }x By BzRespectively representing three main shafts corresponding to an inertial coordinate system (I) and a body coordinate system (B);
2) establishing a position-posture double-ring system dynamic model of the tilting three-rotor unmanned aerial vehicle:
after carrying out the atress analysis, establish three rotor unmanned aerial vehicle's of formula of verting position dynamics model:
a dynamic model which takes the power moment of the unmanned aerial vehicle as control input is established by using an integral moment analysis method for the tilting type three-rotor unmanned aerial vehicle:
3) designing a non-linear controller for the position-attitude of the unmanned aerial vehicle
When the position and attitude dynamics model is adopted, the position nonlinear disturbance observer, the controller and the attitude nonlinear controller of the tilting three-rotor unmanned aerial vehicle are respectively designed, and the control structure block diagram is shown in fig. 3.
The position controller v is designed to:
the external disturbance observer is designed as follows:
in addition to three rotor unmanned aerial vehicle's of formula of verting gesture dynamics model, design nonlinear controller does:
τ=(ΨT)-1(-Krrη-Γ1sign(rη)-Γ2||sη||sign(rη)).
the variables in the above equations are defined above.
The controller is designed to converge the asymptotic closed loop dynamics system to 0.
Specific examples are given below:
first, introduction of semi-physical simulation platform
The semi-physical simulation platform of the tilting three-rotor unmanned aerial vehicle built by a subject group is used for verifying the effects of the nonlinear controller and the self-adaptation law designed in the text. The platform adopts a PC/104 embedded computer as a processor, an xPC system based on a MATLABRTW tool box is used as a semi-physical simulation environment, an independently designed circuit board and an inertia measurement sensor are adopted to obtain the attitude angle of the tilting type three-rotor unmanned aerial vehicle and the angular acceleration of each corresponding channel through a filtering link, and virtual position information is calculated by combining the dynamic model and the attitude information of the unmanned aerial vehicle. The measurement precision of the pitch angle and the roll angle of the experimental platform is about 1.0, and the measurement precision of the yaw angle is about 2.0 degrees. The experiment platform system controls the frequency to be 500 Hz.
Second, flight experiment results
To verify the effectiveness and realizability of the nonlinear control algorithm proposed herein, matrix trajectory tracking flight experiments of the tilting triple-rotor drone were performed for about 90 seconds on the semi-physical experimental platform described above.
As can be seen from fig. 4a to 4d, the control accuracy of the roll angle, the pitch angle and the yaw angle of the unmanned aerial vehicle after the experiment is started is within 3.0 degrees; in the inertial frame { I }, Ex、EyPosition tracking error in direction within 1.0m, EzThe directional height error is in the range of 0.1 m.
Claims (1)
1. A robust control method for position control of a tilting type three-rotor unmanned aerial vehicle comprises the following steps:
1) establishing a coordinate system related to the tilting three-rotor unmanned aerial vehicle:
define the following two coordinate systemsAn inertial coordinate system { I } and a body coordinate system { B } which both meet the right-hand rule, wherein the origin of the inertial coordinate system { I } is located on the ground, the origin of the body coordinate system { B } is located in the center of mass of the three-rotor unmanned aerial vehicle, { E }x Ey EzAnd { B }xBy BzRespectively representing three main shafts corresponding to an inertial coordinate system (I) and a body coordinate system (B);
2) establishing a dynamic model of the position and the posture of the tilting three-rotor unmanned aerial vehicle:
the position model is represented as:
wherein x, y and z respectively represent coordinate values of the centroid position of the tilting three-rotor unmanned aerial vehicle in an inertial coordinate system { I }, and FzRepresenting the unmanned plane in an inertial coordinate system { I }, EzThe lift force in the axial direction, m represents the mass of the unmanned aerial vehicle, phi, theta and psi respectively represent the attitude information of the unmanned aerial vehicle, namely the roll angle, the pitch angle and the yaw angle, g represents the gravity acceleration, d represents the disturbance acceleration introduced by a tail rudder of the tilting three-rotor unmanned aerial vehicle, and H (e)η,ηd) Express three rotor unmanned aerial vehicle ectonexine coupling parts of tilting, v expresses three rotor unmanned aerial vehicle's of tilting virtual controller, expresses as:
in the above formula, phid、θd、ψdRespectively obtaining the target roll angle, the target pitch angle and the target yaw angle of the unmanned aerial vehicle obtained by resolving through a position controller;
the attitude dynamics model of the tilting three-rotor unmanned aerial vehicle is expressed as follows:
where M (η) is an inertia matrix which can be abbreviated asIs a matrix of Coriolis force and centripetal force, which can be abbreviated as The kinetic moment of each channel of the unmanned aerial vehicle is eta (t) [ [ phi ] theta ] psi]TThe attitude of the drone is represented and,psi represents an angular velocity conversion matrix from a body coordinate system { B } to an inertial coordinate system { I } for a disturbance moment vector received by the unmanned aerial vehicle in the body coordinate system { B };
3) designing a non-linear controller
a) Position subsystem controller design
When designing the outer loop control ware, the three rotor unmanned aerial vehicle kinetic model that vert that adopts is as shown as follows:
define the outer-loop error as EηAnd designing an error system filter gamma, and obtaining by the following formula:
wherein, define disturbance observer z, write:
wherein, the intermediate variable δ ═ γ -z is defined and substituted into the formula above to obtain:
wherein the content of the first and second substances,as an observed value of disturbance d of a formula system, a reasonable assumption is made, and if the disturbance d of the lateral force and a derivative thereof are bounded, the condition that the d is less than or equal to | M1|,Wherein the disturbance is estimatedThe first derivative with respect to time of (a) is designed as:
in the above formulaAre all diagonal parameter matrices, while the virtual controller v is numerically designed as:
b) attitude subsystem controller design
Utilize three rotor unmanned aerial vehicle attitude dynamics models of tilting type that following formula shows:
where M (η) is an inertia matrix which can be abbreviated asAn attitude angle tracking error is defined for the Coriolis force and centripetal force matrix, denoted CAnd filtering errorRepresented by the formula:
wherein etad=[φd θd ψd]TRepresenting a target pose of the drone,is a matrix of normal diagonal normal coefficients, for rηThe first derivative with respect to time is found as follows:
where N is defined as an intermediate variable, expressed as:
simultaneous definition ofDefinition sη=[eη rη]TTherefore, the attitude control power moment tau of the tilting type three-rotor unmanned aerial vehicle is designed as follows:
τ=(ΨT)-1(-Krrη-Γ1sign(rη)-Γ2||sη||sign(rη)),
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810113891.XA CN108445895B (en) | 2018-02-05 | 2018-02-05 | Robust control method for position control of tilting type three-rotor unmanned aerial vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810113891.XA CN108445895B (en) | 2018-02-05 | 2018-02-05 | Robust control method for position control of tilting type three-rotor unmanned aerial vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108445895A CN108445895A (en) | 2018-08-24 |
CN108445895B true CN108445895B (en) | 2021-01-29 |
Family
ID=63191797
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810113891.XA Expired - Fee Related CN108445895B (en) | 2018-02-05 | 2018-02-05 | Robust control method for position control of tilting type three-rotor unmanned aerial vehicle |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108445895B (en) |
Families Citing this family (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109116860B (en) * | 2018-08-29 | 2022-05-03 | 天津大学 | Nonlinear robust control method for three-rotor unmanned aerial vehicle |
CN109085847B (en) * | 2018-09-03 | 2021-12-07 | 中国运载火箭技术研究院 | Elastic stability control system and control method for large-static-instability aircraft |
CN110058600B (en) * | 2019-02-26 | 2022-01-14 | 天津大学 | Fault-tolerant control method for pose system under three-rotor unmanned aerial vehicle steering engine blocking fault |
CN110609569B (en) * | 2019-09-26 | 2022-07-15 | 温岭市非普电气有限公司 | Autonomous control unmanned aerial vehicle accurate inspection system and method applied to electric power tower |
CN112650270A (en) * | 2019-10-11 | 2021-04-13 | 天津工业大学 | Motion model applied to unmanned aerial vehicle and model identification technology |
CN111459175B (en) * | 2019-12-18 | 2021-07-27 | 北京航空航天大学 | Tailstock type unmanned aerial vehicle trajectory tracking fault-tolerant control method based on L1 adaptive controller |
CN112198885B (en) * | 2019-12-31 | 2022-04-05 | 北京理工大学 | Unmanned aerial vehicle control method capable of meeting autonomous landing requirement of maneuvering platform |
CN111338369B (en) * | 2020-03-19 | 2022-08-12 | 南京理工大学 | Multi-rotor flight control method based on nonlinear inverse compensation |
CN111522356B (en) * | 2020-03-27 | 2021-06-04 | 北京航空航天大学 | Strong-robustness full-envelope integrated control method for tilt rotor unmanned aerial vehicle |
CN111897219B (en) * | 2020-07-21 | 2022-11-22 | 广东工业大学 | Optimal robust control method for transitional flight mode of tilting quad-rotor unmanned aerial vehicle based on online approximator |
CN113820950B (en) * | 2021-02-24 | 2022-12-02 | 西北工业大学 | Rope connection aircraft stability control method |
CN113110581B (en) * | 2021-04-19 | 2022-09-13 | 西北工业大学 | Nonlinear aircraft position maintaining control method based on combination of main system and auxiliary system |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106647783B (en) * | 2016-11-22 | 2019-07-16 | 天津大学 | Three rotor wing unmanned aerial vehicle posture of tilting type and height adaptive robust control method |
CN106777739B (en) * | 2016-12-28 | 2020-10-20 | 南京航空航天大学 | Solving method for tilt transition process of tilt rotor aircraft |
CN107618675A (en) * | 2017-07-26 | 2018-01-23 | 南京航空航天大学 | A kind of test system and control method for tiltrotor total state blowing experiment |
-
2018
- 2018-02-05 CN CN201810113891.XA patent/CN108445895B/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN108445895A (en) | 2018-08-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108445895B (en) | Robust control method for position control of tilting type three-rotor unmanned aerial vehicle | |
CN106647783B (en) | Three rotor wing unmanned aerial vehicle posture of tilting type and height adaptive robust control method | |
CN109116860B (en) | Nonlinear robust control method for three-rotor unmanned aerial vehicle | |
Colorado et al. | Mini-quadrotor attitude control based on Hybrid Backstepping & Frenet-Serret theory | |
CN109062042B (en) | Limited time track tracking control method of rotor craft | |
Kuantama et al. | Feedback linearization LQR control for quadcopter position tracking | |
CN109283932B (en) | Four-rotor aircraft attitude control method based on integral backstepping sliding mode | |
CN106874617B (en) | Efficient helicopter maneuvering flight quality grade evaluation method | |
Salazar-Cruz et al. | Real-time stabilization of a small three-rotor aircraft | |
CN109885074B (en) | Finite time convergence attitude control method for quad-rotor unmanned aerial vehicle | |
Chowdhury et al. | A generalized control method for a Tilt-rotor UAV stabilization | |
Santos et al. | Real-time stabilization of a quadrotor uav: Nonlinear optimal and suboptimal control | |
CN111045440B (en) | Hypersonic aircraft nose-down section rapid rolling control method | |
CN104298109A (en) | Coordinated turning control method for tailless air vehicle on basis of fusion of multiple controllers | |
Raj et al. | Novel lyapunov-based autonomous controllers for quadrotors | |
Oktay et al. | Dynamic Modeling and Simulation of Quadcopter for Several Flight Conditions | |
Wei et al. | Backstepping approach for controlling a quadrotor using Barrier Lyapunov Functions | |
CN111061282A (en) | Four-rotor unmanned aerial vehicle suspension flight system control method based on energy method | |
CN112327629B (en) | Small unmanned helicopter self-adaptive fault-tolerant control method based on dynamic compensation | |
CN109634110B (en) | Tailstock type unmanned aerial vehicle transition section robust control method based on nonlinear disturbance observer | |
CN117289598B (en) | Method and system for controlling backstepping sliding mode of aircraft | |
Khebbache et al. | Robust stabilization of a quadrotor aerial vehicle in presence of actuator faults | |
CN111897219A (en) | Optimal robust control method for transitional flight mode of tilting quad-rotor unmanned aerial vehicle based on online approximator | |
Salazar-Cruz et al. | Real-time control of a small-scale helicopter having three rotors | |
Castillo et al. | Real-time stabilization and tracking of a four rotor mini-rotorcraft |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20210129 Termination date: 20220205 |
|
CF01 | Termination of patent right due to non-payment of annual fee |