CN111026160A - Trajectory tracking control method for quad-rotor unmanned aerial vehicle - Google Patents
Trajectory tracking control method for quad-rotor unmanned aerial vehicle Download PDFInfo
- Publication number
- CN111026160A CN111026160A CN201911367910.2A CN201911367910A CN111026160A CN 111026160 A CN111026160 A CN 111026160A CN 201911367910 A CN201911367910 A CN 201911367910A CN 111026160 A CN111026160 A CN 111026160A
- Authority
- CN
- China
- Prior art keywords
- angle
- loop
- aerial vehicle
- unmanned aerial
- control
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000001133 acceleration Effects 0.000 claims abstract description 26
- 239000011159 matrix material Substances 0.000 claims description 11
- 230000008859 change Effects 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 4
- 230000009466 transformation Effects 0.000 claims description 3
- 238000010586 diagram Methods 0.000 description 12
- 238000013461 design Methods 0.000 description 8
- 230000009286 beneficial effect Effects 0.000 description 4
- 238000011160 research Methods 0.000 description 4
- 238000009795 derivation Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 230000002195 synergetic effect Effects 0.000 description 2
- 230000009471 action Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000013178 mathematical model Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 239000011541 reaction mixture Substances 0.000 description 1
- 238000004088 simulation 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/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
-
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
The invention belongs to the field of robot control, and particularly relates to a trajectory tracking control method for a quad-rotor unmanned aerial vehicle, which comprises the following steps: estimating the disturbance of the loop in real time by adopting a position and speed control loop, and calculating the resultant force control quantity of the unmanned aerial vehicle, a first angle and the corresponding angular speed and angular acceleration of the first angle based on the disturbance estimation quantity, wherein the first angle is a roll angle and a pitch angle, and the disturbance estimation error of the loop is converged to zero within fixed time; estimating the loop disturbance in real time by adopting an attitude angle control loop, and respectively calculating moment control quantities of the unmanned aerial vehicle rotating around x, y and z axes of a coordinate system of the body based on the disturbance estimation quantity, wherein the second angle is a yaw angle, and the loop disturbance estimation error converges to zero within fixed time; and controlling the unmanned aerial vehicle trajectory tracking based on the resultant force control quantity and the moment control quantity, wherein the angle, the angular speed error, the position and the speed error of the unmanned aerial vehicle are converged to zero in fixed time. The invention realizes the high-precision track tracking control of the unmanned aerial vehicle at fixed time.
Description
Technical Field
The invention belongs to the field of robot control, and particularly relates to a trajectory tracking control method for a quad-rotor unmanned aerial vehicle.
Background
Along with the development of modern control theory and rotor unmanned aerial vehicle technical research, rotor unmanned aerial vehicle can realize stable hovering, and good characteristics such as fixed point take-off and descending, rotor unmanned aerial vehicle has encouraged a large amount of scientific research personnel to engage in the research work of rotor unmanned aerial vehicle control system relevant topic as the mainstream development direction of realizing future air logistics transportation.
However, the system for the single-rotor unmanned aerial vehicle often has poor control difficulty and high stability in practical application, and researchers start to turn research objects to a four-rotor unmanned aerial vehicle system aiming at the stability simplicity of the application field. On the other hand, because of there are more input variables, four rotors often more nimble, easily control and stability better than single rotor unmanned aerial vehicle, can be when flying, accomplish some high-demand tasks simultaneously, like taking photo by plane. Therefore, four rotor unmanned aerial vehicle more accord with practical application demand.
In practical application, a quad-rotor unmanned aerial vehicle system may be required to complete a trajectory tracking task at a fixed time, and the current mainstream control method cannot realize fixed time trajectory tracking, so that the fixed time tracking method is particularly important for meeting the requirements of practical application. In addition, like most mechanical rigid structures, the dynamic characteristics of a quad-rotor drone can be expressed by a mathematical model represented by its mechanical parameters, but provided that the structure of the drone is known and the mechanical parameters are known. In fact, during the working process of the unmanned aerial vehicle, part of mechanical parameters of the unmanned aerial vehicle are often unable to be accurately measured under the influence of working conditions and external interference. So parameter uncertainty usually needs to be considered when mathematically modeling the drone.
Therefore, in combination with the above, the finite time trajectory tracking control of the quad-rotor unmanned aerial vehicle system considering the disturbance and the uncertainty of the model parameters in the task space has great significance.
Disclosure of Invention
The invention provides a trajectory tracking control method for a quad-rotor unmanned aerial vehicle, which is used for solving the technical problem that high-precision tracking control of the unmanned aerial vehicle on time and trajectory cannot be realized in practical application due to the fact that mechanical parameters cannot be accurately obtained and the trajectory tracking time cannot be fixed during modeling in the existing trajectory tracking control of the quad-rotor unmanned aerial vehicle.
The technical scheme for solving the technical problems is as follows: a trajectory tracking control method for a quad-rotor unmanned aerial vehicle comprises the following steps:
based on the expected position, the speed and the acceleration corresponding to the expected position, the real-time acquired actual position, the speed and the angle corresponding to the actual position, a position and speed control loop is adopted to estimate the disturbance of the loop in real time, and based on the estimation quantity of the disturbance, the resultant force control quantity of the unmanned aerial vehicle is calculated, and a first reference angle, the angular speed and the angular acceleration corresponding to the first reference angle are calculated, wherein the first angle is a roll angle and a pitch angle, and the disturbance estimation error of the loop converges to zero within a fixed time;
estimating the disturbance of the loop in real time by adopting an attitude angle control loop based on the reference first angle and the angular velocity and the angular acceleration corresponding to the reference first angle, the angular velocity and the angular acceleration corresponding to the expected second angle, and the actual angle and the angular velocity corresponding to the actual angle, and respectively calculating the moment control quantity of the unmanned aerial vehicle rotating around x, y and z axes of a body coordinate system based on the estimation quantity of the disturbance, wherein the second angle is a yaw angle, and the disturbance estimation error of the loop converges to zero within a fixed time;
and controlling the unmanned aerial vehicle to track based on the resultant force control quantity and the moment control quantity, wherein the angle, the angular speed error, the position and the speed error of the unmanned aerial vehicle are converged to zero in fixed time.
The invention has the beneficial effects that: the method is a fixed time trajectory tracking control method considering disturbance and model parameter uncertainty, and achieves the purposes that the disturbance estimation error in a position speed ring and the disturbance estimation error in an attitude angle control ring are both converged to zero within fixed time, so that the position speed control ring enables the angle and the angular speed error of the unmanned aerial vehicle to be converged to zero within fixed time, and the attitude angle control ring enables the position and the speed error of the unmanned aerial vehicle to be converged to zero within fixed time. In the concrete implementation, the uncertainty of dynamic parameters and external disturbance in a four-rotor unmanned aerial vehicle model can be considered, and appropriate control parameters are selected to meet the requirements on the working speed and the working precision of the robot, so that the related control method can realize that a four-rotor unmanned aerial vehicle system completes a track tracking task in fixed time in practical application, the timeliness is good, the practicability is higher, and the high-precision tracking control of the unmanned aerial vehicle on time and track in practical application is realized.
On the basis of the technical scheme, the invention can be further improved as follows.
Further, the position and speed control loop comprises a controller for making the disturbance estimation error of the loop at a first fixed time T1A state estimator that internally converges to zero, represented as:
wherein,is the actual disturbance D of the loop1At an initial time t0Actual disturbance quantity D of the loop1Is zero, L1An upper bound for the actual disturbance component rate of change of the loop; k is a radical ofiI is 1,2,3 is a control gain constant;v is the actual velocity vector of the drone, vdIs the desired velocity vector of the drone, g is the acceleration of gravity, u1For the total force control quantity, ezExpressing a unit vector of a z axis under a geodetic coordinate system, wherein m is the quality of the unmanned aerial vehicle, and R belongs to R3×3Is a rotation matrix sequentially rotated in the z, y, x order of the body coordinate system, adIs the desired acceleration vector of the drone;
said first fixed time T1Expressed as:
further, the resultant force control amount u1Expressed as:
wherein, αi>0,βi>0,0<ni<mi,0<pi<qi,i=1,2,mi,ni,pi,qiAre all positive odd numbers; p is the actual position of the drone, pdIs the desired position of the drone, evFor speed error of the drone, S1The slip form surface is preset for the loop.
Further, the calculation expression of the reference first angle is:
where ψ is a yaw angle in the geodetic coordinate system.
Further, the position and speed error of the position and speed control loop control is at a fourth fixed time T4Inner convergence is at zero, and the expression is:
the invention has the further beneficial effects that: the invention adopts the state estimator and the control law in the position and speed control loop to carry out the synergistic action, and the formula of the fourth fixed time can know that the position and speed errors can be effectively converged to zero in the fixed time only by effectively setting parameters according to actual needs, so that the practicability is strong.
Further, the attitude angle control element comprises a control unit for enabling the disturbance estimation error of the loop to be at a second fixed time T2The inter-state estimator that internally converges to zero is represented as:
wherein,is WD2Estimate of (2), D2For actual disturbance of the loop, L2For an upper bound on the rate of change of the actual disturbance components of the loop, at an initial time t0Actual disturbance quantity D of the loop2Zero, W is a coordinate system transformation matrix, I is an identity matrix, omega is an actual angular velocity vector under a body coordinate system,the expected angular velocity vector of the unmanned aerial vehicle under the geodetic coordinate system is shown, and tau' is a sliding mode control law of the ring; k is a radical ofiI is 4,5 and 6 are control gain constants,
said second fixed time T2Expressed as:
further, the moment control quantities of the unmanned aerial vehicle rotating around the x, y and z axes of the body coordinate system are u respectively2、u3、u4Expressed as: [ u ] of2,u3,u4]T=τ;τ=I-1Wτ';
Wherein, αi>0,βi>0,0<ni<mi,0<pi<qi,i=3,4,mi,ni,pi,qiAre all positive odd numbers; theta is the actual angle vector of the unmanned aerial vehicle under the geodetic coordinate system, and thetadFor the desired angular vector of the drone in the geodetic coordinate system,for a desired angular acceleration vector of the drone in the geodetic coordinate system,is the derivative of W and is,S2the slip form surface is preset for the loop.
Further, the error of the angle and the angular speed controlled by the attitude angle control loop is in a third fixed time T3Inner convergence to zero, T3The expression of (a) is:
the invention has the further beneficial effects that: the state estimator and the control law in the attitude angle control loop are adopted to carry out the synergistic action, the formula of the third fixed time can know that the convergence of the angle and the angular speed error to zero in the fixed time can be effectively realized only by effectively setting parameters according to actual needs, and the practicability is strong.
Further, the total convergence time T of the track tracking is less than or equal to max (T)1,T2)+T3+T4。
The invention has the further beneficial effects that: the errors of angle and angular velocity converge first, then the errors of position and velocity converge again, and the disturbance convergence time T1、T2And the method is irrelevant to the control input quantity, and based on the control input quantity, the determined total convergence time of the trajectory tracking is high in accuracy and strong in practicability.
The invention also provides a storage medium, wherein the storage medium stores instructions, and when the instructions are read by a computer, the instructions cause the computer to execute any one of the trajectory tracking control methods of the quad-rotor unmanned aerial vehicle.
Drawings
Fig. 1 is a flow chart of a trajectory tracking control method for a quad-rotor unmanned aerial vehicle according to an embodiment of the present invention;
fig. 2 is a schematic diagram of trajectory tracking dual-loop control of a quad-rotor unmanned aerial vehicle according to an embodiment of the present invention;
fig. 3 is a diagram of a model of a quad-rotor drone provided in accordance with an embodiment of the present invention;
FIG. 4 is a block diagram of a position and velocity control loop provided by an embodiment of the present invention;
fig. 5 is a structural diagram of an attitude angle control ring according to an embodiment of the present invention;
FIG. 6 is a diagram illustrating a comparison between disturbance estimators and actual disturbances in position velocity control loops and attitude angle control loops, according to an embodiment of the present invention;
FIG. 7 is a diagram of tracking trajectories of position and attitude angles in a task space provided by an embodiment of the invention;
fig. 8 is a schematic diagram of control input of the unmanned aerial vehicle according to the embodiment of the present invention;
FIG. 9 is a diagram of position and attitude angular trajectory tracking in task space provided by an embodiment of the present invention.
Detailed Description
In order to make the objects, technical solutions and advantages of the present invention more apparent, the present invention is described in further detail below with reference to the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are merely illustrative of the invention and are not intended to limit the invention. In addition, the technical features involved in the embodiments of the present invention described below may be combined with each other as long as they do not conflict with each other.
Example one
A method 100 of trajectory tracking control of a quad-rotor drone, as shown in fig. 1, comprising:
and step 130, controlling the unmanned aerial vehicle to track based on the resultant force control quantity and the moment control quantity, wherein the angle, the angular speed error, the position and the speed error of the unmanned aerial vehicle are converged to zero in fixed time.
It should be noted that, the method firstly considers disturbance and carries out dynamics and kinematics modeling on the unmanned aerial vehicle; then the track tracking control of the unmanned aerial vehicle is converted into double-loop control, the outer loop is a position and speed control loop, and the inner loop is attitude angle loop control; as shown in fig. 2, the position speed control loop inputs a desired position and speed and an actual position and speed, part of control input amounts output to the motor and reference desired angles and angular speeds to the attitude angle control loop; the attitude angle control loop inputs a desired angle and angular speed and an actual angle and angular speed, and outputs the angle and angular speed to the other part of the motor to control input quantity. Next, designing an inner-outer ring controller, specifically including: the position and speed controller design comprises a fixed time state estimator and a fixed time sliding mode controller design, wherein the state estimator can accurately estimate the disturbance of a position and speed control loop after fixed time, and can track an expected position and speed track under the control of the proposed sliding mode control law after accurately compensating the disturbance of the position and speed control loop and after another fixed time; the attitude angle controller design comprises a fixed time state estimator and a fixed time sliding mode controller design, wherein the state estimator can accurately estimate the disturbance of an attitude angle control loop after fixed time, and can track an expected angle and an expected angular speed under the control of the proposed sliding mode control law after accurately compensating the disturbance of the attitude angle control loop and after another fixed time. Wherein the time at which the estimation error of the state estimator converges to 0 is uniquely determined by its parameters; after compensating for the disturbance, the sliding mode controller controls the time for the position velocity to converge to the desired position velocity value to be uniquely determined by its parameters. Based on the system design, the trajectory tracking control of the quad-rotor unmanned aerial vehicle is carried out. And the roll angle, the pitch angle and the yaw angle are all angles in a geodetic coordinate system.
The method is a fixed time trajectory tracking control method considering disturbance and model parameter uncertainty, and achieves the purposes that the disturbance estimation error in a position speed ring and the disturbance estimation error in an attitude angle control ring are both converged to zero within fixed time, so that the position speed control ring enables the angle and the angular speed error of the unmanned aerial vehicle to be converged to zero within fixed time, and the attitude angle control ring enables the position and the speed error of the unmanned aerial vehicle to be converged to zero within fixed time. In the concrete implementation, the uncertainty of dynamic parameters and external disturbance in a four-rotor unmanned aerial vehicle model can be considered, and appropriate control parameters are selected to meet the requirements on the working speed and the working precision of the robot, so that the related control method can realize that a four-rotor unmanned aerial vehicle system completes a track tracking task in fixed time in practical application, and the control method is good in timeliness and higher in practicability.
In order to ensure the correctness of the results of the method, the method is based on the following three conditions:
(1) the disturbance of the position and speed control loop satisfies the following conditions:namely, the disturbance initial value of the position and speed control loop is 0, and the disturbance initial value exists once and is bounded;
(2) posture correction deviceThe disturbance of the attitude angle control loop satisfies the following conditions:namely, the initial value of the disturbance of the attitude angle control loop is 0, and the disturbance exists once and is bounded;
The dynamics and kinematics modeling model was:
a model diagram of a quad-rotor drone as shown in fig. 3, where E ═ Ex,ey,ezDenotes the geodetic coordinate system, B ═ Bx,by,bzDenotes the unmanned plane body coordinate system, p ═ x, y, z]T∈R3Representing the position of the drone in the world coordinate system, v ═ vx,vy,vz]T∈R3For the velocity of the drone in the world coordinate system, Θ ═ phi, θ, ψ]T∈R3For the Euler angle of the unmanned plane in the world coordinate system, omega ═ omega [ omega ]x,ωy,ωz]T∈R3For the angular velocity of the unmanned aerial vehicle in the coordinate system of the fuselage, g, m are the acceleration of gravity and the mass of the unmanned aerial vehicle, respectively, ezIs a unit vector in the z direction, D1=[dx,dy,dz]T∈R3,D2=[dφ,dθ,dψ]T∈R3Is a disturbance; i ═ diag (I)xx,Iyy,Izz)∈R3×3Representing an inertia matrix; τ ═ u2,u3,u4]T∈R3Representing the system input torque, u1Representing the system input unmanned plane total lift; r is formed by R3×3,W∈R3×3Representing a rotation matrix, C·=cos(·),S·Sin (·), additionally:
the mathematical expression of the tracking target is as follows:the expression is the current tracking target, pd=[xd,yd,zd]T∈R3,vd=[vx_d,vy_d,vz_d]T∈R3,ad=[ax_d,ay_d,az_d]T∈R3Respectively representing the position state, velocity and acceleration of the tracking target.
The physical parameters of a quad-rotor drone are shown in table 1 below:
TABLE 1 physical parameters of quad-rotor unmanned aerial vehicle
Combining the position, the speed and the acceleration of the target, and obtaining a position and speed control equation according to Newton's second law:
wherein, T4Is an upper bound of convergence time, a constant determined by design parameters,is an estimate of the disturbance. Thereby can obtainOrder toThen u is1,It can be determined that,
angle of target thetad=[φd,θd,ψd]T∈R3It is possible to obtain:
ψdcan be designed by self and is generally set as 0; to thetadsObtaining the target angular velocity by calculating the derivativeaΩ_d=[aωx_d,aωy_d,aωz_d]T∈R3Target angular acceleration, aΩ_dIs determined by the design parameters of the controller, theta is the roll angle, phi is the pitch angle, and psi is the yaw angle.
And (3) combining the angle, the angular velocity and the acceleration of the target to obtain a control equation of the attitude angle control loop:
wherein, T3Is an upper bound of convergence time, a constant determined by design parameters,is an estimate of the disturbance. From this it is possible to obtain τ, then u2,u3,u4Can be determined.
Preferably, the above-mentioned bitThe speed control loop comprises a first fixed time T for making the disturbance estimation error of the loop1A state estimator that internally converges to zero, represented as:
wherein,is the actual disturbance D of the loop1At an initial time t0Actual disturbance quantity D of the loop1Is zero, L1An upper bound for the actual disturbance component rate of change of the loop; k is a radical ofiI is 1,2,3 is a control gain constant;v is the actual velocity vector of the drone, vdIs the desired velocity vector of the drone, g is the acceleration of gravity, u1For the total force control quantity, ezExpressing a unit vector of a z axis under a geodetic coordinate system, wherein m is the quality of the unmanned aerial vehicle, and R belongs to R3×3Is a rotation matrix sequentially rotated in the z, y, x order of the body coordinate system, adIs the desired acceleration vector of the drone; the first fixed time T1Expressed as:
preferably, the total force control amount u is set to be smaller than the total force control amount u1Expressed as:
wherein, αi>0,βi>0,0<ni<mi,0<pi<qi,i=1,2,mi,ni,pi,qiAre all positive odd numbers; p is the actual position of the drone, pdIs the desired position of the drone, evFor speed error of the drone, S1The slip form surface is preset for the loop.
Preferably, the position and speed error controlled by the position and speed control loop is at a fourth fixed time T4Inner convergence is at zero, and the expression is:
as shown in fig. 4, the structure of the position and velocity control loop includes a state estimator and a control law, in which:
preferably, the attitude angle control unit includes a controller for controlling the disturbance estimation error of the loop at a second fixed time T2The inter-state estimator that internally converges to zero is represented as:
wherein,is WD2Estimate of (2), D2For actual disturbance of the loop, L2Is divided into actual disturbances of the loopUpper bound of rate of change of quantity, at initial time t0Actual disturbance quantity D of the loop2Zero, W is a coordinate system transformation matrix, I is an identity matrix, omega is an actual angular velocity vector under a body coordinate system,the expected angular velocity vector of the unmanned aerial vehicle under the geodetic coordinate system is shown, and tau' is a sliding mode control law of the ring; k is a radical ofiI is 4,5 and 6 are control gain constants,
the second fixed time T2Expressed as:
the parameters of each estimator are specifically selected as shown in table 2 below, and the perturbation is set as follows:
di=0.2sin(5t),i=x,y,z,φ,θ,ψ;
TABLE 2 parameters of the estimator
Parameter name | Value of parameter | Parameter name | Value of parameter |
k1 | 3 | k4 | 3 |
k2 | 0.5 | k5 | 0.5 |
k3 | 4 | |
4 |
μ1 | 0.5 | μ2 | 0.5 |
|
2 | |
2 |
Preferably, the torque control amount of the unmanned aerial vehicle rotating around the x, y and z axes of the body coordinate system is u2、u3、u4Expressed as: [ u ] of2,u3,u4]T=τ;τ=I-1Wτ';
Wherein, αi>0,βi>0,0<ni<mi,0<pi<qi,i=3,4,mi,ni,pi,qiAre all positive odd numbers; theta is the coordinate of the earthActual angle vector of the unmanned aerial vehicle under tether, ΘdFor the desired angular vector of the drone in the geodetic coordinate system,for a desired angular acceleration vector of the drone in the geodetic coordinate system,is the derivative of W and is,S2the slip form surface is preset for the loop.
Preferably, the attitude angle control loop controls the angle and the angular velocity error at a third fixed time T3Inner convergence to zero, T3The expression of (a) is:
preferably, the total convergence time T of the trajectory tracking is less than or equal to max (T)1,T2)+T3+T4。
As shown in fig. 5, the structure diagram of the attitude angle control loop includes a state estimator and a control law, in which:
the selection of the control parameters in each control law can be specifically seen in the following table 3, and the target trajectory is set as:
zd(t)=0.25,ψd(t)=0;
TABLE 3 control parameters
To better illustrate the invention, it has now been demonstrated that the state estimator is fixed time converged, as follows:
defining state observer estimation errorThe position and speed control loop state estimator is derived to obtain:
analyzing the state estimator to obtain the following analysis results:
so it is progressively stabilized.
As shown in fig. 6, the left plot corresponds to the position velocity control loop, the right plot corresponds to the attitude angle control loop, the position velocity control loop and the attitude angle control loop disturbance estimates and the actual disturbance values, and each component of the position and attitude angle disturbance estimates converges to its corresponding disturbance value at a fixed time under the influence of the state estimator designed.
The designed control rate is demonstrated belowThe position velocity can be guaranteed to be fixed time converged:
to slip form surface S1Taking the derivative, we can get:
modeling dynamics and kinematicsOf (2) and designedSubstituting the expression of (a) into the above formula, one can obtain:whereinIs the estimation error.
The position and speed control loop convergence time is as follows:
the convergence time of the attitude angle control loop is as follows:
the errors of angle and angular speed are converged firstly, then the errors of position and speed are converged, and the disturbance convergence time T1、T2Independent of the control input, the total time of trajectory tracking convergence is expressed as:
T≤max(T1,T2)+T3+T4。
as shown in fig. 7, under the action of the designed estimator-based fixed time controller, the tracking trajectory diagram of the position and attitude angle in the task space converges to its corresponding tracking target trajectory in a fixed time (within 8 seconds). Based on fig. 6 and 7, the control input of the unmanned aerial vehicle is obtained, including the resultant force control quantity and all the moment control quantities, as shown in fig. 8, and finally, a position and attitude angle trajectory tracking diagram in the task space is obtained, as shown in fig. 9, the result of the simulation of fig. 9 is very close to that of fig. 7, only because the accuracy problem of the sensor causes a slight error in the position and attitude angle tracking, and the error caused by the factor is removed, so that the position and attitude angle can be converged to the corresponding tracking target trajectory within a fixed time (within 8 seconds), and the result can support the control effect of the method of the embodiment.
Example two
A storage medium having instructions stored therein, which when read by a computer, cause the computer to execute a method for trajectory tracking control of a quad-rotor drone according to the first embodiment.
The related technical solution is the same as the first embodiment, and is not described herein again.
It will be understood by those skilled in the art that the foregoing is only a preferred embodiment of the present invention, and is not intended to limit the invention, and that any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the scope of the present invention.
Claims (10)
1. A trajectory tracking control method for a quad-rotor unmanned aerial vehicle is characterized by comprising the following steps:
based on the expected position, the speed and the acceleration corresponding to the expected position, the real-time acquired actual position, the speed and the angle corresponding to the actual position, a position and speed control loop is adopted to estimate the disturbance of the loop in real time, and based on the estimation quantity of the disturbance, the resultant force control quantity of the unmanned aerial vehicle is calculated, and a first reference angle, the angular speed and the angular acceleration corresponding to the first reference angle are calculated, wherein the first angle is a roll angle and a pitch angle, and the disturbance estimation error of the loop converges to zero within a fixed time;
estimating the disturbance of the loop in real time by adopting an attitude angle control loop based on the reference first angle and the angular velocity and the angular acceleration corresponding to the reference first angle, the angular velocity and the angular acceleration corresponding to the expected second angle, and the actual angle and the angular velocity corresponding to the actual angle, and respectively calculating the moment control quantity of the unmanned aerial vehicle rotating around x, y and z axes of a body coordinate system based on the estimation quantity of the disturbance, wherein the second angle is a yaw angle, and the disturbance estimation error of the loop converges to zero within a fixed time;
and controlling the unmanned aerial vehicle to track based on the resultant force control quantity and the moment control quantity, wherein the angle, the angular speed error, the position and the speed error of the unmanned aerial vehicle are converged to zero in fixed time.
2. A method according to claim 1, wherein the position and velocity control loop comprises means for causing a disturbance estimation error of the loop to be at a first fixed time T1A state estimator that internally converges to zero, represented as:
wherein,is the actual disturbance D of the loop1At an initial time t0Actual disturbance quantity D of the loop1Is zero, L1An upper bound for the actual disturbance component rate of change of the loop; k is a radical ofiI is 1,2,3 is a control gain constant;k2>0,k3>4L1,0<μ1<1,λ1is greater than 1, v is the actual velocity vector of the unmanned plane, vdIs the desired velocity vector of the drone, g is the acceleration of gravity, u1For the total force control quantity, ezExpressing a unit vector of a z axis under a geodetic coordinate system, wherein m is the quality of the unmanned aerial vehicle, and R belongs to R3×3Is a rotation matrix sequentially rotated in the z, y, x order of the body coordinate system, adIs the desired acceleration vector of the drone;
the first fixed timeT1Expressed as:
3. the trajectory tracking control method for quad-rotor unmanned aerial vehicle according to claim 2, wherein the resultant force control amount u is1Expressed as:
wherein, αi>0,βi>0,0<ni<mi,0<pi<qi,i=1,2,mi,ni,pi,qiAre all positive odd numbers; p is the actual position of the drone, pdIs the desired position of the drone, evFor speed error of the drone, S1The slip form surface is preset for the loop.
5. The trajectory tracking control method for quad-rotor unmanned aerial vehicle according to claim 4, wherein the trajectory tracking control method is characterized in thatThe position and speed error controlled by the position and speed control loop is at the fourth fixed time T4Inner convergence is at zero, and the expression is:
6. the method of claim 5, wherein the attitude control loop comprises a second fixed time T for the disturbance estimation error of the loop to occur2The inter-state estimator that internally converges to zero is represented as:
wherein,is WD2Estimate of (2), D2For actual disturbance of the loop, L2For an upper bound on the rate of change of the actual disturbance components of the loop, at an initial time t0Actual disturbance quantity D of the loop2Zero, W is a coordinate system transformation matrix, I is an identity matrix, omega is an actual angular velocity vector under a body coordinate system,the expected angular velocity vector of the unmanned aerial vehicle under the geodetic coordinate system is shown, and tau' is a sliding mode control law of the ring; k is a radical ofiI is 4,5 and 6 are control gain constants,k5>0,k6>4L2,0<μ2<1,λ2>1;
said second fixed time T2Expressed as:
7. the trajectory tracking control method for a quad-rotor unmanned aerial vehicle according to claim 6, wherein the torque control amounts of the unmanned aerial vehicle rotating around x, y and z axes of the body coordinate system are u and z respectively2、u3、u4Expressed as: [ u ] of2,u3,u4]T=τ;τ=I- 1Wτ';
Wherein, αi>0,βi>0,0<ni<mi,0<pi<qi,i=3,4,mi,ni,pi,qiAre all positive odd numbers; theta is the actual angle vector of the unmanned aerial vehicle under the geodetic coordinate system, and thetadFor the desired angular vector of the drone in the geodetic coordinate system,for a desired angular acceleration vector of the drone in the geodetic coordinate system,is the derivative of W and is,S2the slip form surface is preset for the loop.
9. the method of claim 8, wherein the total convergence time T of trajectory tracking is less than or equal to max (T ≦ max)1,T2)+T3+T4。
10. A storage medium having stored thereon instructions which, when read by a computer, cause the computer to perform a method of trajectory tracking control of a quad-rotor drone according to any one of claims 1 to 9.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911367910.2A CN111026160B (en) | 2019-12-26 | 2019-12-26 | Trajectory tracking control method for quad-rotor unmanned aerial vehicle |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911367910.2A CN111026160B (en) | 2019-12-26 | 2019-12-26 | Trajectory tracking control method for quad-rotor unmanned aerial vehicle |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111026160A true CN111026160A (en) | 2020-04-17 |
CN111026160B CN111026160B (en) | 2020-12-08 |
Family
ID=70214743
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911367910.2A Active CN111026160B (en) | 2019-12-26 | 2019-12-26 | Trajectory tracking control method for quad-rotor unmanned aerial vehicle |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111026160B (en) |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111650951A (en) * | 2020-05-22 | 2020-09-11 | 南京航空航天大学 | Full-loop composite dynamic inverse tracking control method for complex track of quad-rotor unmanned aerial vehicle |
CN111665870A (en) * | 2020-06-24 | 2020-09-15 | 深圳市道通智能航空技术有限公司 | Trajectory tracking method and unmanned aerial vehicle |
CN111948935A (en) * | 2020-08-03 | 2020-11-17 | 曾喆昭 | Self-coupling PD control theory method of under-actuated VTOL aircraft |
CN112269401A (en) * | 2020-09-04 | 2021-01-26 | 河南大学 | Self-adaptive active sensor tracking method based on tracking precision and risk control |
CN112650303A (en) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | Unmanned aerial vehicle formation fault-tolerant control method based on fixed time technology |
CN114564047A (en) * | 2022-04-28 | 2022-05-31 | 北京航空航天大学 | Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions |
Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007018572A2 (en) * | 2004-11-08 | 2007-02-15 | Bell Helicopter Textron Inc. | Flight system with three feedback control loops |
CN104865968A (en) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | Quad-rotor aircraft hovering control method employing cascade auto disturbances rejection control technology |
US20170153650A1 (en) * | 2015-11-30 | 2017-06-01 | Metal Industries Research & Development Centre | Multiple rotors aircraft and control method |
CN106933104A (en) * | 2017-04-21 | 2017-07-07 | 苏州工业职业技术学院 | A kind of quadrotor attitude based on DIC PID and the mixing control method of position |
CN106970646A (en) * | 2017-05-23 | 2017-07-21 | 四川理工学院 | Quadrotor control method based on Adaptive Integral contragradience |
CN107608367A (en) * | 2017-09-06 | 2018-01-19 | 天津大学 | The rotor wing unmanned aerial vehicle track of multivariable interference compensation four and posture cooperative control method |
CN108594837A (en) * | 2018-02-12 | 2018-09-28 | 山东大学 | Model-free quadrotor drone contrail tracker and method based on PD-SMC and RISE |
US20190033892A1 (en) * | 2017-07-27 | 2019-01-31 | Intel Corporation | Trajectory tracking controllers for rotorcraft unmanned aerial vehicles (uavs) |
WO2019055025A1 (en) * | 2017-09-15 | 2019-03-21 | Sanyal Amit K | Integrated guidance and feedback control for autonomous vehicle |
CN109597426A (en) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | Based on L1The four-rotor helicopter Trajectory Tracking Control method of self adaptive control |
CN109901606A (en) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | A kind of mixing finite time control method for quadrotor Exact trajectory tracking |
US20190264864A1 (en) * | 2016-02-26 | 2019-08-29 | Sz Dji Osmo Technology Co., Ltd. | Method and system for stabilizing a payload |
KR20190107422A (en) * | 2018-03-12 | 2019-09-20 | 광주과학기술원 | A device for positioning and tracking control based RF of multi unnamed aerial vehicle |
CN110275542A (en) * | 2019-06-14 | 2019-09-24 | 合肥工业大学 | A kind of quadrotor control method based on adaptive finite-time control |
CN110456816A (en) * | 2019-07-05 | 2019-11-15 | 哈尔滨工程大学 | A kind of quadrotor Trajectory Tracking Control method based on continuous terminal sliding mode |
-
2019
- 2019-12-26 CN CN201911367910.2A patent/CN111026160B/en active Active
Patent Citations (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007018572A2 (en) * | 2004-11-08 | 2007-02-15 | Bell Helicopter Textron Inc. | Flight system with three feedback control loops |
CN104865968A (en) * | 2015-04-22 | 2015-08-26 | 浙江工业大学 | Quad-rotor aircraft hovering control method employing cascade auto disturbances rejection control technology |
US20170153650A1 (en) * | 2015-11-30 | 2017-06-01 | Metal Industries Research & Development Centre | Multiple rotors aircraft and control method |
US20190264864A1 (en) * | 2016-02-26 | 2019-08-29 | Sz Dji Osmo Technology Co., Ltd. | Method and system for stabilizing a payload |
CN106933104A (en) * | 2017-04-21 | 2017-07-07 | 苏州工业职业技术学院 | A kind of quadrotor attitude based on DIC PID and the mixing control method of position |
CN106970646A (en) * | 2017-05-23 | 2017-07-21 | 四川理工学院 | Quadrotor control method based on Adaptive Integral contragradience |
US20190033892A1 (en) * | 2017-07-27 | 2019-01-31 | Intel Corporation | Trajectory tracking controllers for rotorcraft unmanned aerial vehicles (uavs) |
CN107608367A (en) * | 2017-09-06 | 2018-01-19 | 天津大学 | The rotor wing unmanned aerial vehicle track of multivariable interference compensation four and posture cooperative control method |
WO2019055025A1 (en) * | 2017-09-15 | 2019-03-21 | Sanyal Amit K | Integrated guidance and feedback control for autonomous vehicle |
CN108594837A (en) * | 2018-02-12 | 2018-09-28 | 山东大学 | Model-free quadrotor drone contrail tracker and method based on PD-SMC and RISE |
KR20190107422A (en) * | 2018-03-12 | 2019-09-20 | 광주과학기술원 | A device for positioning and tracking control based RF of multi unnamed aerial vehicle |
CN109597426A (en) * | 2018-11-13 | 2019-04-09 | 上海无线电设备研究所 | Based on L1The four-rotor helicopter Trajectory Tracking Control method of self adaptive control |
CN109901606A (en) * | 2019-04-11 | 2019-06-18 | 大连海事大学 | A kind of mixing finite time control method for quadrotor Exact trajectory tracking |
CN110275542A (en) * | 2019-06-14 | 2019-09-24 | 合肥工业大学 | A kind of quadrotor control method based on adaptive finite-time control |
CN110456816A (en) * | 2019-07-05 | 2019-11-15 | 哈尔滨工程大学 | A kind of quadrotor Trajectory Tracking Control method based on continuous terminal sliding mode |
Non-Patent Citations (5)
Title |
---|
XIAOLIN AI 等: "Fixed-time trajectory tracking for a quadrotor with external disturbances:A flatness-based sliding mode control approach", 《AEROSPACE SCIENCE AND TECHNOLOGY》 * |
ZHENG ZHANG 等: "Multivariable sliding mode backstepping controller design for quadrotor UAV based on disturbance observer", 《SCIENCE CHINA INFORMATION SCIENCES》 * |
姜明瑞: "四旋翼无人机轨迹跟踪控制系统设计", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
王春阳 等: "四旋翼无人机轨迹跟踪控制系统设计", 《电光与控制》 * |
范云生 等: "四旋翼飞行器轨迹跟踪控制器的设计与验证", 《仪器仪表学报》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111650951A (en) * | 2020-05-22 | 2020-09-11 | 南京航空航天大学 | Full-loop composite dynamic inverse tracking control method for complex track of quad-rotor unmanned aerial vehicle |
CN111650951B (en) * | 2020-05-22 | 2021-09-17 | 南京航空航天大学 | Full-loop composite dynamic inverse tracking control method for complex track of quad-rotor unmanned aerial vehicle |
CN111665870A (en) * | 2020-06-24 | 2020-09-15 | 深圳市道通智能航空技术有限公司 | Trajectory tracking method and unmanned aerial vehicle |
CN111948935A (en) * | 2020-08-03 | 2020-11-17 | 曾喆昭 | Self-coupling PD control theory method of under-actuated VTOL aircraft |
CN112269401A (en) * | 2020-09-04 | 2021-01-26 | 河南大学 | Self-adaptive active sensor tracking method based on tracking precision and risk control |
CN112269401B (en) * | 2020-09-04 | 2021-07-20 | 河南大学 | Self-adaptive active sensor tracking method based on tracking precision and risk control |
CN112650303A (en) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | Unmanned aerial vehicle formation fault-tolerant control method based on fixed time technology |
CN114564047A (en) * | 2022-04-28 | 2022-05-31 | 北京航空航天大学 | Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions |
CN114564047B (en) * | 2022-04-28 | 2022-08-16 | 北京航空航天大学 | Unmanned aerial vehicle constant-speed flight control method considering meteorological conditions |
Also Published As
Publication number | Publication date |
---|---|
CN111026160B (en) | 2020-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111026160B (en) | Trajectory tracking control method for quad-rotor unmanned aerial vehicle | |
CN109614633B (en) | Nonlinear modeling and linearization balancing method for composite rotor craft | |
CN109062042B (en) | Limited time track tracking control method of rotor craft | |
Colorado et al. | Mini-quadrotor attitude control based on Hybrid Backstepping & Frenet-Serret theory | |
CN106325291B (en) | Sliding mode control law and ESO (electronic stability program) based four-rotor aircraft attitude control method and system | |
WO2020177267A1 (en) | Control method and apparatus for quadrotor unmanned aerial vehicle, device, and readable medium | |
CN111258216B (en) | Sliding mode repetitive controller suitable for four-rotor aircraft | |
CN112578805B (en) | Attitude control method of rotor craft | |
CN109507890A (en) | A kind of unmanned plane dynamic inverse generalized predictive controller based on ESO | |
CN108638068B (en) | Design method of flying robot control system with redundant mechanical arm | |
CN110531776A (en) | Quadrotor position control method and system based on Auto Disturbances Rejection Control Technique | |
CN112558621A (en) | Decoupling control-based flying mechanical arm system | |
CN109885074B (en) | Finite time convergence attitude control method for quad-rotor unmanned aerial vehicle | |
CN106200665A (en) | Carry modeling and the self-adaptation control method of the four-axle aircraft of uncertain load | |
CN110377044B (en) | Finite time height and attitude tracking control method of unmanned helicopter | |
CN111813140A (en) | High-precision trajectory tracking control method for quad-rotor unmanned aerial vehicle | |
CN104536448B (en) | Backstepping based control method for unmanned-plane attitude system | |
CN106802570B (en) | Method and device for tracking position of unmanned helicopter | |
CN111459188A (en) | Multi-rotor nonlinear flight control method based on quaternion | |
CN111198570A (en) | Anti-delay high-precision active disturbance rejection attitude control method based on fixed time differentiator prediction | |
CN106292297A (en) | Based on PID controller and the attitude control method of L1 adaptive controller | |
CN109976364B (en) | Attitude decoupling control method for six-rotor aircraft | |
CN117742156B (en) | Four-rotor unmanned aerial vehicle control method and system based on RBF neural network | |
CN116088549B (en) | Tailstock type vertical take-off and landing unmanned aerial vehicle attitude control method | |
CN108845508B (en) | CMAC-sliding mode integrated control-based semi-physical simulation control method for unmanned aerial vehicle |
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 |