CN111176311A - Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium - Google Patents
Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium Download PDFInfo
- Publication number
- CN111176311A CN111176311A CN202010003769.4A CN202010003769A CN111176311A CN 111176311 A CN111176311 A CN 111176311A CN 202010003769 A CN202010003769 A CN 202010003769A CN 111176311 A CN111176311 A CN 111176311A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- rotor unmanned
- quad
- attitude
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 230000000750 progressive effect Effects 0.000 claims abstract description 41
- 239000011159 matrix material Substances 0.000 claims description 78
- 238000006243 chemical reaction Methods 0.000 claims description 37
- 239000000126 substance Substances 0.000 claims description 32
- 238000004590 computer program Methods 0.000 claims description 17
- 230000003044 adaptive effect Effects 0.000 claims description 12
- 230000009466 transformation Effects 0.000 claims description 9
- 238000013178 mathematical model Methods 0.000 claims description 8
- 238000004422 calculation algorithm Methods 0.000 claims description 7
- 238000004364 calculation method Methods 0.000 claims description 6
- 238000009795 derivation Methods 0.000 claims description 6
- 238000005070 sampling Methods 0.000 claims description 6
- 238000001727 in vivo Methods 0.000 claims description 4
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000005457 optimization Methods 0.000 description 8
- 230000008569 process Effects 0.000 description 3
- 238000010586 diagram Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 239000013641 positive control Substances 0.000 description 1
- 239000004576 sand Substances 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
-
- 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)
- 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 method relates to a sliding mode delay estimation control method and a storage medium for the attitude of a quad-rotor unmanned aerial vehicle, and the method comprises the following steps: establishing a dynamic model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion; establishing a global progressive convergence observer based on the state quantity output by the dynamic model of the attitude of the quad-rotor unmanned aerial vehicle; and establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer, and outputting a control quantity. The attitude is represented based on the error quaternion, an attitude dynamics model of the quad-rotor unmanned aerial vehicle is established, a global progressive convergence observer is used for observing the state quantity of the system, the observer has the characteristics of simple parameter setting, insensitivity to noise interference, better robustness to system parameter perturbation and the like, and the attitude of the quad-rotor unmanned aerial vehicle is controlled based on the sliding mode delay estimation controller, so that the attitude control of the quad-rotor unmanned aerial vehicle has better control performance and effectiveness.
Description
Technical Field
The invention relates to the technical field of quad-rotor unmanned aerial vehicles, in particular to a sliding mode delay estimation control method and a storage medium for attitude of a quad-rotor unmanned aerial vehicle.
Background
The quad-rotor unmanned aerial vehicle has the characteristics of vertical take-off and landing, fixed-point hovering, strong maneuverability, flexible operation and the like, and is widely applied to military and civil fields of search and rescue, battlefield investigation, fire scene reconnaissance, traffic control and the like. The attitude mathematical model of the existing four-rotor unmanned aerial vehicle attitude controller is usually established under the condition that the change rate of the limited attitude angle is equal to the angular velocity around the body axis, namely, the default transformation relation matrix from the body axis angular velocity to the euler angle is an identity matrix, but the default condition is reasonable only when the aircraft is hovered or flies at a small angle. However, when the quad-rotor unmanned aerial vehicle is applied to the fields of military and the like, the aircraft may be required to perform large-angle maneuvering flight, namely when the conversion relation matrix is not an identity matrix, the problem of singular value of the conversion matrix expressed based on the euler angle is solved, and meanwhile, the problem of uncertain interference of the quad-rotor unmanned aerial vehicle in the flight process is solved under the condition of not depending on the control system full-state feedback and the system accurate model.
Disclosure of Invention
Therefore, a sliding-mode delay estimation control method and a storage medium for the attitude of the quad-rotor unmanned aerial vehicle are needed to be provided, so that the problem that a conversion matrix based on Euler angle representation in an attitude dynamics model of the existing quad-rotor unmanned aerial vehicle has singular values is solved, and the problem that the quad-rotor unmanned aerial vehicle suffers from uncertain interference in the flight process under the condition of not depending on control system full-state feedback and system accurate model is solved.
In order to achieve the above object, the inventor provides a sliding mode delay estimation control method for attitude of a quad-rotor unmanned aerial vehicle, comprising the following steps:
establishing a dynamic model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion;
establishing a global progressive convergence observer based on the state quantity output by the dynamic model of the attitude of the quad-rotor unmanned aerial vehicle;
and establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer, and outputting the attitude control quantity of the quad-rotor unmanned aerial vehicle.
Further optimization, the method for establishing a dynamics model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion specifically comprises the following steps:
confirm four rotor unmanned aerial vehicle's mathematical modelOmega is the in-vivo coordinate EBRelative to the inertial coordinate EIAngular velocity of, andj is the moment of inertia matrix of quad-rotor unmanned aerial vehicle, andu is the control moment of quad-rotor unmanned aerial vehicle, andd is a combined external moment MTIn addition to the control torque U,bounded and derivatives exist, S (-) is a symmetric matrix;
obtaining a conversion matrix according to Euler angle parameterization and XYZ axis rotation sequence
The conversion matrix R is described based on unit quaternion instead of Euler angle to obtain the conversion matrix based on unit quaternionIs simplified toUnit quaternion ofq0Is a scalar portion of the unit quaternion,is a vector part of unit quaternion, and the unit quaternion q satisfiesI3Is a 3 × 3 identity matrix;
relational equation between angular velocity omega and body coordinate established based on unit quaternion
Expected body coordinate system E according to quad-rotor unmanned aerial vehicleBd=(xBd,yBd,zBd) Quadrotor drone with respect to inertial coordinate EIAt desired body coordinates EBdDesired angular velocity ofdThe desired unit quaternion isSatisfy the requirement ofi is 0,1,2,3, and the transformation matrix from the expected body coordinate to the inertial coordinate is obtained as RdE SO (3) is obtained according to the quaternion of the expected unit
Establishing expected angular velocity omega under expected body coordinates according to expected quaterniondEquation of relationship (c)Wherein the content of the first and second substances,
determining the tracking error quaternion of the quad-rotor unmanned aerial vehicle as the expected body coordinate according to the real-time body coordinateWherein the content of the first and second substances,qve=qodqv-q0qvd+S(qv)qvd,
according to conversion matrices R and RdA conversion error matrix ofEstablishing an expected quaternion qdWith the desired body coordinates EBDesired angular velocity ωdEquation of relationship (c)
According to the angular velocity in the body coordinates relative to the desired body coordinates ofI.e. omegae=ω-ReωdEstablishing an error quaternion qeAnd angular velocity omegaeEquation of relationship (c)Wherein the content of the first and second substances,
Further optimization, the establishment of the global progressive convergence observer based on the state quantity output by the dynamics model of the attitude of the quad-rotor unmanned aerial vehicle specifically comprises the following steps:
state quantity q output by dynamics model of four-rotor unmanned aerial vehicle attitudeve,ωeRespectively is
Determining the observation error of a global progressive convergence observer as χ1=δ1-qve,χ2=δ2-ωe;
According to the observation error, a global progressive convergence observer is established as n is the degree of freedom, LiA matrix is positively determined for a diagonal, ani=1,2;αiIs a pending positive number less than 1, i is 1, 2;
calculating the derivation of the observation error to obtain the state equation of the observation errorWherein the content of the first and second substances,
further optimization, the establishing of the sliding mode delay estimation controller based on the observation state quantity of the global asymptotic convergence observer and the outputting of the control quantity specifically comprise the following steps:
measuring state delta of global progressive convergence observer1And delta2State quantity q output by dynamic model for replacing four-rotor unmanned aerial vehicle attitude respectivelyveAnd ωe;
According to the sliding mode function s ═ z2+Ksz1Estimating the uncertainty according to a delay estimation algorithmCalculating sliding mode delay estimation controllerβ is a normal number, and L is sampling time;
substituting a sliding mode function and a sliding mode delay estimation controller into a dynamics model of the attitude of the quad-rotor unmanned aerial vehicle to obtain a closed-loop system equation
Further optimization, the method also comprises the following steps:
replacing sign function sgn () with tan h (), rewriting the sliding mode delay estimation controller obtained by calculation to obtain a new sliding mode delay estimation controllerWherein the content of the first and second substances,mu is positiveThe gain of the power amplifier is increased,is positively determinate of a switch matrix, anPositive definite switch matrixIs adaptive toi=1,2,3,α is a positive gain and ε is an adaptive gain.
The inventor also provides another technical scheme that: a storage medium storing a computer program which, when executed by a processor, performs the steps of:
establishing a dynamic model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion;
establishing a global progressive convergence observer based on the state quantity output by the dynamic model of the attitude of the quad-rotor unmanned aerial vehicle;
and establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer, and outputting a control quantity.
Further optimization, when the computer program is executed by the processor to perform the step of establishing a dynamics model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion, the following steps are specifically performed:
confirm four rotor unmanned aerial vehicle's mathematical modelOmega is the in-vivo coordinate EBRelative to the inertial coordinate EIAngular velocity of, andj is four rotor unmanned aerial vehicleA rotational inertia matrix ofU is the control moment of quad-rotor unmanned aerial vehicle, andd is a combined external moment MTIn addition to the control torque U,bounded and derivatives exist, S (-) is a symmetric matrix;
obtaining a conversion matrix according to Euler angle parameterization and XYZ axis rotation sequencePhi is a rolling attitude angle of the quad-rotor unmanned aerial vehicle, theta is a pitching attitude angle of the quad-rotor unmanned aerial vehicle, and psi is a yawing attitude angle of the quad-rotor unmanned aerial vehicle;
the conversion matrix R is described based on unit quaternion instead of Euler angle to obtain the conversion matrix based on unit quaternionIs simplified toUnit quaternion ofq0Is a scalar portion of the unit quaternion,is a vector part of unit quaternion, and the unit quaternion q satisfiesI3Is a 3 × 3 identity matrix;
relational equation between angular velocity omega and body coordinate established based on unit quaternion
Expected body coordinate system E according to quad-rotor unmanned aerial vehicleBd=(xBd,yBd,zBd) Quadrotor drone with respect to inertial coordinate EIAt desired body coordinates EBdDesired angular velocity ofdThe desired unit quaternion isSatisfy the requirement ofi is 0,1,2,3, and the transformation matrix from the expected body coordinate to the inertial coordinate is obtained as RdE SO (3) is obtained according to the quaternion of the expected unit
Establishing expected angular velocity omega under expected body coordinates according to expected quaterniondEquation of relationship (c)Wherein the content of the first and second substances,
obtaining expected body coordinates according to the relatively real-time body coordinates, and determining the tracking error quaternion of the quad-rotor unmanned aerial vehicle asWherein the content of the first and second substances,qve=qodqv-q0qvd+S(qv)qvd,
according to conversion matrices R and RdA conversion error matrix ofEstablishing an expected quaternion qdWith the desired body coordinates EBDesired angular velocity ωdEquation of relationship (c)
According to the angular velocity in the body coordinates relative to the desired body coordinates ofI.e. omegae=ω-ReωdEstablishing an error quaternion qeAnd angular velocity omegaeEquation of relationship (c)Wherein the content of the first and second substances,
Further optimization, when the computer program is executed by the processor to perform the step of "establishing a global progressive convergence observer based on the state quantity output by the dynamical model of the attitude of the quad-rotor unmanned aerial vehicle", the following steps are specifically performed:
state quantity q output by dynamics model of four-rotor unmanned aerial vehicle attitudeve,ωeRespectively is
Determining the observation error of a global progressive convergence observer as χ1=δ1-qve,χ2=δ2-ωe;
According to the observation error, a global progressive convergence observer is established as n is the degree of freedom, LiA matrix is positively determined for a diagonal, ani=1,2;αiIs a pending positive number less than 1, i is 1, 2;
calculating the derivation of the observation error to obtain the state equation of the observation errorWherein the content of the first and second substances,
further optimization, when the computer program is executed by the processor, the step of establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer and outputting the control quantity is executed, and the following steps are specifically executed:
measuring state delta of global progressive convergence observer1And delta2State quantity q output by dynamic model for replacing four-rotor unmanned aerial vehicle attitude respectivelyveAnd ωe;
According to the sliding mode function s ═ z2+Ksz1Estimating the uncertainty according to a delay estimation algorithmCalculating sliding mode delay estimation controllerβ is a normal number, and L is sampling time;
substituting a sliding mode function and a sliding mode delay estimation controller into a dynamics model of the attitude of the quad-rotor unmanned aerial vehicle to obtain a closed-loop system equation
Further preferably, the computer program when executed by the processor further performs the steps of:
replacing sign function sgn () with tan h (), rewriting the sliding mode delay estimation controller obtained by calculation to obtain a new sliding mode delay estimation controllerWherein the content of the first and second substances,mu is a positive gain, and mu is a positive gain,is positively determinate of a switch matrix, anPositive definite switch matrixIs adaptive toi=1,2,3,α is a positive gain and ε is an adaptive gain.
Compared with the prior art, the technical scheme has the advantages that the attitude is expressed based on the error quaternion, the attitude dynamics model of the quad-rotor unmanned aerial vehicle is established, and the problem that singular values can appear in a conversion matrix expressed based on an Euler angle is solved; in order to be independent of the full-state feedback of the system, the state quantity of the system is observed by utilizing the global progressive convergence observer, the observer has the characteristics of simple parameter setting, insensitivity to noise interference, better robustness to system parameter perturbation and the like, and the attitude of the quad-rotor unmanned aerial vehicle is controlled based on the sliding-mode delay estimation controller, so that the attitude control of the quad-rotor unmanned aerial vehicle has better control performance and effectiveness.
Drawings
Fig. 1 is a schematic flow chart of a sliding-mode delay estimation control method for attitude of a quad-rotor unmanned aerial vehicle according to an embodiment;
fig. 2 is a topological diagram of a sliding-mode delay estimation control method for attitude of a quad-rotor unmanned aerial vehicle according to an embodiment;
fig. 3 is a schematic structural diagram of a storage medium according to an embodiment.
Description of reference numerals:
310. a storage medium.
Detailed Description
To explain technical contents, structural features, and objects and effects of the technical solutions in detail, the following detailed description is given with reference to the accompanying drawings in conjunction with the embodiments.
Referring to fig. 1-2, the present embodiment provides a sliding mode delay estimation control method for attitude of a quad-rotor unmanned aerial vehicle, including the following steps:
step S110: establishing a dynamic model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion; consider that four rotor unmanned aerial vehicle are in state of hovering, perhaps low-speed flight state, consider closing external moment M that four rotor unmanned aerial vehicle received simultaneouslyTBy controlling torqueU, Coriolis moment McAnd other uncertainty factor moment delta, determining a mathematical model of the quad-rotor unmanned aerial vehicleOmega is the in-vivo coordinate EBRelative to the inertial coordinate EIAngular velocity of, andj is the moment of inertia matrix of quad-rotor unmanned aerial vehicle, andu is the control moment of quad-rotor unmanned aerial vehicle, andd is a combined external moment MTIn addition to the control moment U, including the Coriolis moment McAn unmodeled part, an external disturbance, etc.,bounded and derivatives exist, S (-) is a symmetric matrix; the general form of the symmetric matrix S (-) is:wherein the content of the first and second substances,
singular value problems may arise when the transformation matrix R is represented based on euler angles. Here, the conversion matrix R is represented as a conversion matrix from the body coordinates to the inertial coordinates. Obtaining a conversion matrix according to Euler angle parameterization and XYZ axis rotation sequencePhi is a rolling attitude angle of the quad-rotor unmanned aerial vehicle, theta is a pitching attitude angle of the quad-rotor unmanned aerial vehicle, and psi is a yawing attitude angle of the quad-rotor unmanned aerial vehicle; to avoid the problem of singular values, euler is replaced based on unit quaternionThe angle describes a conversion matrix R to obtain a conversion matrix based on unit quaternionIs simplified toUnit quaternion ofq0Is a scalar portion of the unit quaternion,is a vector part of unit quaternion, and the unit quaternion q satisfiesI3Is a 3 × 3 identity matrix;
expressing the attitude dynamics equation of the quad-rotor unmanned aerial vehicle by using unit quaternion, namely establishing a relational equation between the unit quaternion and the angular velocity omega under the body coordinateWherein the content of the first and second substances,
in order to ensure the attitude control of the quad-rotor unmanned aerial vehicle by designing a proper control quantity tau, an expected body coordinate system E of the quad-rotor unmanned aerial vehicle is adoptedBd=(xBd,yBd,zBd) Quadrotor drone with respect to inertial coordinate EIAt desired body coordinates EBdDesired angular velocity ofdThe desired unit quaternion isSatisfy the requirement ofi is 0,1,2,3, and the expected machine is obtainedThe transformation matrix from the body coordinate to the inertial coordinate is RdE SO (3) is obtained according to the quaternion of the expected unit
Establishing expected angular velocity omega under expected body coordinates according to expected quaterniondEquation of relationship (c)Wherein the content of the first and second substances,
obtaining expected body coordinates according to the relatively real-time body coordinates, and determining the tracking error quaternion of the quad-rotor unmanned aerial vehicle asWherein the content of the first and second substances,qve=qodqv-q0qvd+S(qv)qvdand the error quaternion satisfies the condition:
according to conversion matrices R and RdA conversion error matrix ofEstablishing an expected quaternion qdWith the desired body coordinates EBDesired angular velocity ωdEquation of relationship (c)
Determining a four-rotor unmanned aerial vehicle attitude control target asFrom the tracking error quaternion and the transformation matrices R and RdThe error matrix of the conversion between, can be known as
According to the angular velocity in the body coordinates relative to the desired body coordinates ofI.e. omegae=ω-ReωdEstablishing an error quaternion qeAnd angular velocity omegaeEquation of relationship (c)Wherein the content of the first and second substances,
based on error quaternion, establish four rotor unmanned aerial vehicle attitude's kinetic equation According to the conditions satisfied by the error quaternion and the error quaternion qeAnd angular velocity omegaeCan obtain the relation equation ofAccording to the determined mathematical model of the quad-rotor unmanned aerial vehicle and the angular velocity omega under the body coordinatese=ω-ReωdAnd establishing a kinetic equation of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion.
Step S120: establishing a global progressive convergence observer based on the state quantity output by the dynamic model of the attitude of the quad-rotor unmanned aerial vehicle;
the method specifically comprises the following steps:
state quantity q output by dynamics model of four-rotor unmanned aerial vehicle attitudeve,ωeRespectively is
Determining the observation error of a global progressive convergence observer as χ1=δ1-qve,χ2=δ2-ωe;
According to the observation error, a global progressive convergence observer is established as n is the degree of freedom, LiA matrix is positively determined for a diagonal, ani=1,2;αiIs a pending positive number less than 1, i is 1, 2;
calculating the derivation of the observation error to obtain the state equation of the observation errorWherein the content of the first and second substances,
based on the Lyapunov stability theorem and the Barbalt theorem analysis, the observation error of the global progressive convergence observer and the tracking error of the closed-loop system are progressively converged.
Step S130: and establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer, and outputting a control quantity.
Setting the state quantity q without measuring the angular velocity of the state quantityveIs expected value ofAnd set itThe first and second derivatives exist and are bounded; setting the tracking error amount of the system to
Measuring state delta of global progressive convergence observer1And delta2State quantity q output by dynamic model for replacing four-rotor unmanned aerial vehicle attitude respectivelyveAnd ωe;
According to the sliding mode function s ═ z2+Ksz1Wherein, K iss=diag(ks1,ks2,ks3) For positive control gain, the uncertainty is estimated according to a delay estimation algorithm, so thatCalculating sliding mode delay estimation controllerβ is a normal number, and L is sampling time;
substituting a sliding mode function and a sliding mode delay estimation controller into a dynamics model of the attitude of the quad-rotor unmanned aerial vehicle to obtain a closed-loop system equation
Error of time delay estimation algorithmIs sufficiently small to be able to be adjusted by adjusting the parameter Ksand β, the tracking error can converge to near zero.
In order to reduce buffeting, a sign function sgn () is replaced by tanh (), the sliding mode delay estimation controller obtained through calculation is rewritten, and a new sliding mode delay estimation controller is obtainedWherein the content of the first and second substances,mu is a positive gain, and mu is a positive gain,is positively determinate of a switch matrix, anPositive definite switch matrixIs adaptive toi=1,2,3,α is a positive gain and ε is an adaptive gain.
Referring to fig. 3, in another embodiment, a storage medium 310, the storage medium 310 storing a computer program, the computer program when executed by a processor performing the steps of:
establishing a dynamic model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion;
establishing a global progressive convergence observer based on the state quantity output by the dynamic model of the attitude of the quad-rotor unmanned aerial vehicle;
and establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer, and outputting a control quantity.
When the computer program is executed by the processor to perform the step of establishing a dynamics model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion, the following steps are specifically performed:
confirm four rotor unmanned aerial vehicle's mathematical modelOmega is a sit-on bodyMark EBRelative to the inertial coordinate EIAngular velocity of, andj is the moment of inertia matrix of quad-rotor unmanned aerial vehicle, andu is the control moment of quad-rotor unmanned aerial vehicle, andd is a combined external moment MTIn addition to the control torque U,bounded and derivatives exist, S (-) is a symmetric matrix;
obtaining a conversion matrix according to Euler angle parameterization and XYZ axis rotation sequence
The conversion matrix R is described based on unit quaternion instead of Euler angle to obtain the conversion matrix based on unit quaternionIs simplified toUnit quaternion ofq0Is a scalar portion of the unit quaternion,is a vector part of unit quaternion, and the unit quaternion q satisfiesI3Is a 3 × 3 identity matrix;
based onRelation equation between unit quaternion establishment and angular velocity omega under body coordinate
Expected body coordinate system E according to quad-rotor unmanned aerial vehicleBd=(xBd,yBd,zBd) Quadrotor drone with respect to inertial coordinate EIAt desired body coordinates EBdDesired angular velocity ofdThe desired unit quaternion isSatisfy the requirement ofi is 0,1,2,3, and the transformation matrix from the expected body coordinate to the inertial coordinate is obtained as RdE SO (3) is obtained according to the quaternion of the expected unit
Establishing expected angular velocity omega under expected body coordinates according to expected quaterniondEquation of relationship (c)Wherein the content of the first and second substances,
obtaining expected body coordinates according to the relatively real-time body coordinates, and determining the tracking error quaternion of the quad-rotor unmanned aerial vehicle asWherein the content of the first and second substances,qve=qodqv-q0qvd+S(qv)qvd,
according to conversion matrices R and RdA conversion error matrix ofEstablishing an expected quaternion qdWith the desired body coordinates EBDesired angular velocity ωdEquation of relationship (c)
According to the angular velocity in the body coordinates relative to the desired body coordinates ofI.e. omegae=ω-ReωdEstablishing an error quaternion qeAnd angular velocity omegaeEquation of relationship (c)Wherein the content of the first and second substances,
Further optimization, when the computer program is executed by the processor to perform the step of "establishing a global progressive convergence observer based on the state quantity output by the dynamical model of the attitude of the quad-rotor unmanned aerial vehicle", the following steps are specifically performed:
state quantity q output by dynamics model of four-rotor unmanned aerial vehicle attitudeve,ωeRespectively is
Determining the observation error of a global progressive convergence observer as χ1=δ1-qve,χ2=δ2-ωe;
According to the observation error, a global progressive convergence observer is established as n is the degree of freedom, LiA matrix is positively determined for a diagonal, ani=1,2;αiIs a pending positive number less than 1, i is 1, 2;
calculating the derivation of the observation error to obtain the state equation of the observation errorWherein the content of the first and second substances,
when the computer program is operated by the processor, the steps of establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer and outputting the attitude control quantity of the quad-rotor unmanned aerial vehicle are executed, and the following steps are specifically executed:
measuring state delta of global progressive convergence observer1And delta2State quantity q output by dynamic model for replacing four-rotor unmanned aerial vehicle attitude respectivelyveAnd ωe;
According to the sliding mode function s ═ z2+Ksz1Estimating the uncertainty according to a delay estimation algorithmCalculating sliding mode delay estimation controllerβ is a normal number, and L is sampling time;
substituting a sliding mode function and a sliding mode delay estimation controller into a dynamics model of the attitude of the quad-rotor unmanned aerial vehicle to obtain a closed-loop system equation
Wherein the computer program when executed by the processor further performs the steps of:
replacing sign function sgn () with tan h (), rewriting the sliding mode delay estimation controller obtained by calculation to obtain a new sliding mode delay estimation controllerWherein the content of the first and second substances,mu is a positive gain, and mu is a positive gain,is positively determinate of a switch matrix, anPositive definite switch matrixIs adaptive toi=1,2,3,α is a positive gain and ε is an adaptive gain.
It should be noted that, although the above embodiments have been described herein, the invention is not limited thereto. Therefore, based on the innovative concepts of the present invention, the technical solutions of the present invention can be directly or indirectly applied to other related technical fields by making changes and modifications to the embodiments described herein, or by using equivalent structures or equivalent processes performed in the content of the present specification and the attached drawings, which are included in the scope of the present invention.
Claims (10)
1. A sliding mode delay estimation control method for the attitude of a quad-rotor unmanned aerial vehicle is characterized by comprising the following steps:
establishing a dynamic model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion;
establishing a global progressive convergence observer based on the state quantity output by the dynamic model of the attitude of the quad-rotor unmanned aerial vehicle;
and establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer, and outputting the attitude control quantity of the quad-rotor unmanned aerial vehicle.
2. The sliding-mode delay estimation control method for the attitude of the quad-rotor unmanned aerial vehicle according to claim 1, wherein the step of establishing a dynamical model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion specifically comprises the following steps:
confirm four rotor unmanned aerial vehicle's mathematical modelOmega is the coordinate E of the bodyBRelative to the inertial coordinate EIAngular velocity of, andj is the moment of inertia matrix of quad-rotor unmanned aerial vehicle, andu is the control moment of quad-rotor unmanned aerial vehicle, andd is a combined external moment MTIn addition to the control torque U,bounded and derivatives exist, S (-) is a symmetric matrix;
obtaining a conversion matrix according to Euler angle parameterization and XYZ axis rotation sequencePhi is a rolling attitude angle of the quad-rotor unmanned aerial vehicle, theta is a pitching attitude angle of the quad-rotor unmanned aerial vehicle, and psi is a yawing attitude angle of the quad-rotor unmanned aerial vehicle;
the conversion matrix R is described based on unit quaternion instead of Euler angle to obtain the conversion matrix based on unit quaternionIs simplified toUnit quaternion ofq0Is a scalar portion of the unit quaternion,is a vector part of unit quaternion, and the unit quaternion q satisfiesI3Is a 3 × 3 identity matrix;
relational equation between angular velocity omega and body coordinate established based on unit quaternion
Expected body coordinate system E according to quad-rotor unmanned aerial vehicleBd=(xBd,yBd,zBd) Quadrotor drone with respect to inertial coordinate EIAt desired body coordinates EBdDesired angular velocity ofdThe desired unit quaternion isSatisfy the requirement ofObtaining a transformation matrix from the expected body coordinate to the inertial coordinate as RdE SO (3) is obtained according to the quaternion of the expected unit
Establishing expected angular velocity omega under expected body coordinates according to expected quaterniondEquation of relationship (c)Wherein the content of the first and second substances,
determining the tracking error quaternion of the quad-rotor unmanned aerial vehicle asWherein the content of the first and second substances,qve=qodqv-q0qvd+S(qv)qvd,
according to conversion matrices R and RdA conversion error matrix ofEstablishing an expected quaternion qdWith the desired body coordinates EBDesired angular velocity ωdEquation of relationship (c)
According to the angular velocity in the body coordinates relative to the desired body coordinates ofI.e. omegae=ω-ReωdEstablishing an error quaternion qeAnd angular velocity omegaeEquation of relationship (c)Wherein the content of the first and second substances,
3. The sliding-mode delay estimation control method for the attitude of the quad-rotor unmanned aerial vehicle according to claim 2, wherein the step of establishing the global asymptotic convergence observer based on the state quantity output by the dynamical model of the attitude of the quad-rotor unmanned aerial vehicle specifically comprises the following steps:
state quantity q output by dynamics model of four-rotor unmanned aerial vehicle attitudeve,ωeRespectively is
Determining the observation error of a global progressive convergence observer as χ1=δ1-qve,χ2=δ2-ωe;
According to the observation error, a global progressive convergence observer is established as n is the degree of freedom, LiA matrix is positively determined for a diagonal, anαiIs a pending positive number less than 1, i is 1, 2;
4. the sliding-mode delay estimation control method for the attitude of the quad-rotor unmanned aerial vehicle according to claim 3, wherein the step of establishing the sliding-mode delay estimation controller and outputting the attitude control quantity of the quad-rotor unmanned aerial vehicle based on the observation state quantity of the global progressive convergence observer specifically comprises the following steps:
measuring state delta of global progressive convergence observer1And delta2State quantity q output by dynamic model for replacing four-rotor unmanned aerial vehicle attitude respectivelyveAnd ωe;
According to the sliding mode function s ═ z2+Ksz1Estimating the uncertainty according to a delay estimation algorithmCalculating sliding mode delay estimation controllerβ is a normal number, and L is sampling time;
5. The sliding-mode delay estimation control method for the attitude of the quad-rotor unmanned aerial vehicle according to claim 4, further comprising the following steps:
replacing sign function sgn () with tan h (), rewriting the sliding mode delay estimation controller obtained by calculation to obtain a new sliding mode delay estimation controllerWherein the content of the first and second substances,mu is a positive gain, and mu is a positive gain,is positively determinate of a switch matrix, anPositive definite switch matrixIs adaptive to α is a positive gain and ε is an adaptive gain.
6. A storage medium storing a computer program, the computer program when executed by a processor performing the steps of:
establishing a dynamic model of the attitude of the quad-rotor unmanned aerial vehicle based on the error quaternion;
establishing a global progressive convergence observer based on the state quantity output by the dynamic model of the attitude of the quad-rotor unmanned aerial vehicle;
and establishing a sliding mode delay estimation controller based on the observation state quantity of the global progressive convergence observer, and outputting a control quantity.
7. The storage medium of claim 6, wherein the computer program when executed by the processor performs the step of "building a dynamical model of quad-rotor drone attitude based on error quaternion", by performing the steps of:
confirm four rotor unmanned aerial vehicle's mathematical modelOmega is the in-vivo coordinate EBRelative to the inertial coordinate EIAngular velocity of, andj is the moment of inertia matrix of quad-rotor unmanned aerial vehicle, andu is the control moment of quad-rotor unmanned aerial vehicle, andd is a combined external moment MTIn addition to the control torque U,bounded and derivatives exist, S (-) is a symmetric matrix;
obtaining a conversion matrix according to Euler angle parameterization and XYZ axis rotation sequence
The conversion matrix R is described based on unit quaternion instead of Euler angle to obtain the conversion matrix based on unit quaternionIs simplified toUnit quaternion ofq0Is a scalar portion of the unit quaternion,vector portion being unit quaternion, unitA bit quaternion q satisfyingI3Is a 3 × 3 identity matrix;
relational equation between angular velocity omega and body coordinate established based on unit quaternion
Expected body coordinate system E according to quad-rotor unmanned aerial vehicleBd=(xBd,yBd,zBd) Quadrotor drone with respect to inertial coordinate EIAt desired body coordinates EBdDesired angular velocity ofdThe desired unit quaternion isSatisfy the requirement ofObtaining a transformation matrix from the expected body coordinate to the inertial coordinate as RdE SO (3) is obtained according to the quaternion of the expected unit
Establishing expected angular velocity omega under expected body coordinates according to expected quaterniondEquation of relationship (c)Wherein the content of the first and second substances,
obtaining expected body coordinates according to the relatively real-time body coordinates, and determining the tracking error quaternion of the quad-rotor unmanned aerial vehicle asWherein the content of the first and second substances,qve=qodqv-q0qvd+S(qv)qvd,
according to conversion matrices R and RdA conversion error matrix ofEstablishing an expected quaternion qdWith the desired body coordinates EBDesired angular velocity ωdEquation of relationship (c)
According to the angular velocity in the body coordinates relative to the desired body coordinates ofI.e. omegae=ω-ReωdEstablishing an error quaternion qeAnd angular velocity omegaeEquation of relationship (c)Wherein the content of the first and second substances,
8. The storage medium according to claim 7, wherein the computer program, when executed by the processor, when executing the step "establishing a global asymptotic convergence observer based on a state quantity output by a dynamical model of a quad-rotor drone attitude", specifically executes the following steps:
state quantity q output by dynamics model of four-rotor unmanned aerial vehicle attitudeve,ωeRespectively is
Determining the observation error of a global progressive convergence observer as χ1=δ1-qve,χ2=δ2-ωe;
According to the observation error, a global progressive convergence observer is established as n is the degree of freedom, LiA matrix is positively determined for a diagonal, anαiIs a pending positive number less than 1, i is 1, 2;
9. the storage medium according to claim 8, wherein when the computer program is executed by the processor, when the step "establishing a sliding-mode delay estimation controller based on the observed state quantity of the global asymptotic convergence observer, and outputting the control quantity" is executed, the following steps are specifically executed:
measuring state delta of global progressive convergence observer1And delta2State quantity q output by dynamic model for replacing four-rotor unmanned aerial vehicle attitude respectivelyveAnd ωe;
According to the sliding mode function s ═ z2+Ksz1Estimating the uncertainty according to a delay estimation algorithmCalculating sliding mode delay estimation controllerβ is a normal number, and L is sampling time;
10. The storage medium of claim 9, wherein the computer program, when executed by the processor, further performs the steps of:
replacing sign function sgn () with tanh (), rewriting the sliding mode delay estimation controller obtained by calculation to obtain new sliding mode delay estimation controlDevice for making articlesWherein the content of the first and second substances,mu is a positive gain, and mu is a positive gain,is positively determinate of a switch matrix, anPositive definite switch matrixIs adaptive to α is a positive gain and ε is an adaptive gain.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010003769.4A CN111176311A (en) | 2020-01-03 | 2020-01-03 | Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010003769.4A CN111176311A (en) | 2020-01-03 | 2020-01-03 | Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111176311A true CN111176311A (en) | 2020-05-19 |
Family
ID=70657797
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010003769.4A Pending CN111176311A (en) | 2020-01-03 | 2020-01-03 | Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111176311A (en) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114489105A (en) * | 2022-01-25 | 2022-05-13 | 南京邮电大学 | Novel unmanned aerial vehicle attitude system integral sliding mode control method based on disturbance observer |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007035559A2 (en) * | 2005-09-19 | 2007-03-29 | Cleveland State University | Controllers, observers, and applications thereof |
CN108445760A (en) * | 2018-03-14 | 2018-08-24 | 中南大学 | The quadrotor drone fault tolerant control method of observer is estimated based on adaptive failure |
-
2020
- 2020-01-03 CN CN202010003769.4A patent/CN111176311A/en active Pending
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2007035559A2 (en) * | 2005-09-19 | 2007-03-29 | Cleveland State University | Controllers, observers, and applications thereof |
CN108445760A (en) * | 2018-03-14 | 2018-08-24 | 中南大学 | The quadrotor drone fault tolerant control method of observer is estimated based on adaptive failure |
Non-Patent Citations (3)
Title |
---|
JINGXIN DOU 等: "An adaptive sliding mode controller based on global asymptotic convergent observer for attitude tracking of quadrotor unmanned aerial vehicles", 《ADVANCES IN MECHANICAL ENGINEERING》 * |
魏炳翌 等: "基于高阶滑模观测器的微分滑模四旋翼无人机控制研究", 《航空兵器》 * |
龙诗科 等: "基于滑模和ESO的四旋翼飞行器遥感机动观测姿态控制", 《地球信息科学学报》 * |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114489105A (en) * | 2022-01-25 | 2022-05-13 | 南京邮电大学 | Novel unmanned aerial vehicle attitude system integral sliding mode control method based on disturbance observer |
CN114489105B (en) * | 2022-01-25 | 2024-01-16 | 南京邮电大学 | Novel unmanned aerial vehicle attitude system integral sliding mode control method based on interference observer |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110531777B (en) | Four-rotor aircraft attitude control method and system based on active disturbance rejection control technology | |
CN107608367B (en) | Multivariable interference compensation quadrotor unmanned aerial vehicle trajectory and attitude cooperative control method | |
CN106325291B (en) | Sliding mode control law and ESO (electronic stability program) based four-rotor aircraft attitude control method and system | |
CN109976361B (en) | Event-triggering-oriented four-rotor unmanned aerial vehicle attitude control method | |
CN110119089B (en) | Immersion constant flow pattern self-adaptive quad-rotor control method based on integral sliding mode | |
CN110531776B (en) | Four-rotor aircraft position control method and system based on active disturbance rejection control technology | |
CN112578804B (en) | Four-rotor aircraft formation sliding mode control method based on event trigger mechanism | |
CN109062042B (en) | Limited time track tracking control method of rotor craft | |
CN105607473B (en) | The attitude error Fast Convergent self-adaptation control method of small-sized depopulated helicopter | |
CN111026160B (en) | Trajectory tracking control method for quad-rotor unmanned aerial vehicle | |
CN112578805B (en) | Attitude control method of rotor craft | |
CN112684805B (en) | High-mobility micro unmanned aerial vehicle control method considering attitude constraint | |
CN111443721A (en) | Attitude dynamic surface control method for quad-rotor unmanned aerial vehicle and storage medium | |
CN112558621A (en) | Decoupling control-based flying mechanical arm system | |
CN108121354A (en) | Quadrotor unmanned plane tenacious tracking control method based on instruction filtering Backstepping | |
CN111176312A (en) | Attitude active disturbance rejection dynamic surface control method for quad-rotor unmanned aerial vehicle and storage medium | |
CN111258216A (en) | Sliding mode repetitive controller suitable for four-rotor aircraft | |
CN111007877A (en) | Global robust self-adaptive trajectory tracking control method of four-rotor aircraft | |
CN111198570A (en) | Anti-delay high-precision active disturbance rejection attitude control method based on fixed time differentiator prediction | |
CN111506095A (en) | Method for tracking and controlling relative pose of saturation fixed time between double rigid body feature points | |
CN114237270B (en) | Unmanned helicopter tracking control method considering input saturation | |
Pollini et al. | Simulation and robust backstepping control of a quadrotor aircraft | |
CN114153228A (en) | Four-rotor formation control method without speed measurement under directed interaction topology | |
CN117289598B (en) | Method and system for controlling backstepping sliding mode of aircraft | |
CN111176311A (en) | Sliding mode delay estimation control method for attitude of quad-rotor unmanned aerial vehicle and storage medium |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20200519 |
|
RJ01 | Rejection of invention patent application after publication |