CN115826604A - Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode - Google Patents

Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode Download PDF

Info

Publication number
CN115826604A
CN115826604A CN202211589931.0A CN202211589931A CN115826604A CN 115826604 A CN115826604 A CN 115826604A CN 202211589931 A CN202211589931 A CN 202211589931A CN 115826604 A CN115826604 A CN 115826604A
Authority
CN
China
Prior art keywords
sliding mode
unmanned aerial
aerial vehicle
adaptive
terminal sliding
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
Application number
CN202211589931.0A
Other languages
Chinese (zh)
Inventor
王立辉
祝文星
任元
李勇
陈飞鹏
许宁徽
孟骞
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Southeast University
Original Assignee
Southeast University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Southeast University filed Critical Southeast University
Priority to CN202211589931.0A priority Critical patent/CN115826604A/en
Publication of CN115826604A publication Critical patent/CN115826604A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • YGENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
    • Y02TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
    • Y02TCLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
    • Y02T90/00Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

The unmanned aerial vehicle attitude control method based on the self-adaptive terminal sliding mode comprises the following steps: 1. establishing an unmanned aerial vehicle attitude stabilization control system model; 2. designing a novel rapid nonsingular fixed time terminal sliding mode surface; 3. deducing a nonsingular fixed time terminal sliding mode law according to the designed dynamic sliding mode surface; 4. designing an adaptive law to effectively estimate an unknown interference upper bound value; 5. and (3) proving the closed loop stability of the control system by using a candidate Lyapunov function. The method can ensure that the controller has non-singularity and rapid convergence characteristics, solves the upper bound problem of unknown interference by using a self-adaptive law, and improves the tracking precision of the unmanned aerial vehicle attitude control system under the condition of lumped interference.

Description

Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode
Technical Field
The invention belongs to the field of unmanned aerial vehicle attitude stability control, and particularly relates to an unmanned aerial vehicle attitude control method based on a self-adaptive terminal sliding mode.
Background
Unmanned aerial vehicles are widely used in the fields of military reconnaissance, disaster search and rescue and the like because of their lightness and flexibility. The dynamic system has the characteristics of nonlinearity, strong coupling, modeling uncertainty and the like, and in addition, the attitude stability control caused by external interference also brings huge challenges. The attitude stabilization control system is positioned in an inner ring, the control bandwidth is high, and the control frequency is up to 200Hz. Under the condition of higher control frequency, the fast convergence performance of the attitude controller is very important, and particularly the attitude is stable under the condition of large disturbance and high dynamic.
Sliding mode control is used for solving the problem of attitude stability control by a plurality of scholars, but the sliding mode tracking control of the unmanned aerial vehicle still faces the following difficulties. Firstly, the method comprises the following steps: the shake problem is inevitable, and can be weakened to a certain extent only, which becomes a prominent obstacle for the application of the sliding mode variable structure control in a practical system. Secondly, the method comprises the following steps: generally, a sliding mode controller can only ensure gradual stability, but the gradual stability means that the state of a closed loop system can be converged to a balance point when the time tends to infinity, and the requirement of quick stability in actual engineering cannot be well met. Thirdly, the method comprises the following steps: the problem of singularity means that the designed controller has infinite value, and the problem cannot be realized in the actual engineering. Fourthly: the time for the finite time to converge depends on the initial value of the state of the closed-loop system, and the convergence time varies with the initial state. If the initial state of the aircraft is far from the equilibrium point, the convergence time will grow exponentially and infinitely, which is clearly contrary to the control requirements. These difficulties make the attitude stabilization control of the unmanned aerial vehicle a very challenging research topic.
The sliding mode control research of the attitude stabilization fixed time of the unmanned aerial vehicle is developed, the convergence speed and the control precision of the attitude stabilization control can be improved, and the excellent control performance is provided for the wide application of the unmanned aerial vehicle in complex environments such as military reconnaissance, disaster search and rescue, terrain survey and the like.
The prior art currently comprises:
application No.: CN201710532250.3, patent name: a finite time self-adaptive control method of a quadrotor unmanned aerial vehicle based on a non-singular terminal sliding mode aims at a quadrotor unmanned aerial vehicle system with inertia uncertain factors and external disturbance. According to a dynamics system of the quad-rotor unmanned aerial vehicle, a non-singular terminal sliding mode control method is utilized, and then self-adaptive control is combined, so that a quad-rotor unmanned aerial vehicle self-adaptive control method based on a non-singular terminal sliding mode is designed. The non-singular terminal sliding mode is designed to ensure the finite time convergence characteristic of the system, avoid the singularity problem in the terminal sliding mode control and effectively weaken the buffeting problem. In addition, adaptive control is used to deal with inertial uncertainty and external disturbances of the system. The invention provides a control method which can eliminate the singularity problem of a sliding mode surface, effectively inhibit and compensate the inertial uncertainty and the external interference of a system and ensure the finite time convergence characteristic of the system.
However, the self-adaptive control method of the quadrotor unmanned aerial vehicle by using the nonsingular terminal sliding mode can effectively process inertial uncertain factors and external disturbance. The method ensures the finite time convergence characteristic of the system, avoids the singularity problem existing in the terminal sliding mode control, and effectively weakens the buffeting problem.
The method of the patent is designed for solving the problem of unknown interference in trajectory tracking of the quad-rotor unmanned aerial vehicle, and an adaptive law is designed to effectively estimate the upper bound value. And a novel fast nonsingular fixed time terminal sliding mode surface is provided, so that a nonsingular fixed time terminal sliding mode controller is designed, the closed loop stability of a control system is proved by using a candidate Lyapunov function, and the tracking precision of an unmanned aerial vehicle attitude control system under the condition of lumped interference is improved. It is noted that the sliding mode surface adopted in the comparative patent is
Figure BDA0003993682730000021
The sliding form surface designed by the patent is
Figure BDA0003993682730000022
Wherein h (e) i )=arctan(|e i |)
The two sliding mode surfaces are completely different, and compared with the patent, the limited time convergence performance can be realized, while the patent can realize the fixed time convergence performance and has better performance. Thus, the two patents are completely different in the design of the slip-form face.
Application No.: CN 201710823686.8, patent name: a quadrotor unmanned aerial vehicle attitude controller with unknown dynamic characteristics and a method thereof assume that model parameters of the quadrotor unmanned aerial vehicle, such as rotational inertia, air damping coefficient and the like, are unknown, and bounded disturbance suffered by a system is time-varying and always exists in the system. Aiming at unknown model parameters, the invention designs a corresponding differential estimator to carry out online estimation on the position parameters. Based on the parameter estimated value, an improved self-adaptive nonsingular terminal sliding mode controller is designed to complete attitude stability control of the quad-rotor unmanned aerial vehicle. In addition, the invention also designs an adaptive disturbance compensator to effectively compensate the bounded disturbance. Simulation and experiment results show that the control algorithm can well complete the attitude stability control of the quad-rotor unmanned aerial vehicle, and has stronger robustness on unknown dynamic characteristics and disturbance of the system.
Aiming at unknown model parameters and time-varying bounded disturbance, a corresponding differential estimator is designed to carry out online estimation on position parameters. Based on the parameter estimation value, an improved self-adaptive nonsingular terminal sliding mode controller is designed to complete attitude stable control of the quad-rotor unmanned aerial vehicle, and the robust control system has strong robustness on unknown dynamic characteristics and disturbance of the system.
And this patent has the problem of unknown interference to exist among the four rotor unmanned aerial vehicle trajectory tracking, has designed the self-adaptation law and has effectively estimated this upper bound value. And a novel fast nonsingular fixed time terminal sliding mode surface is provided, so that a nonsingular fixed time terminal sliding mode controller is designed, the closed loop stability of a control system is proved by using a candidate Lyapunov function, and the tracking precision of an unmanned aerial vehicle attitude control system under the condition of lumped interference is improved. It is noted that the sliding form surfaces used in the comparative patent are
Figure BDA0003993682730000031
The sliding form surface designed by the patent is
Figure BDA0003993682730000032
Wherein h (e) i )=arctan(|e i |)
The two sliding modes are completely different in surface, and compared with a patent, the limited time convergence performance can be realized, while the fixed time convergence performance can be realized, and the performance is better. Thus, the two patents are completely different in the design of the slip-form face.
Disclosure of Invention
In order to solve the problems, the application provides an unmanned aerial vehicle attitude control method based on a self-adaptive terminal sliding mode, the method can effectively estimate an unknown interference upper bound value, can improve the convergence speed and control precision of attitude stable control, and improves the stable attitude control performance of the unmanned aerial vehicle in a complex environment.
In order to achieve the purpose, the invention adopts the technical scheme that:
the invention provides an unmanned aerial vehicle attitude control method based on a self-adaptive terminal sliding mode, which comprises the following steps:
(1) Establishing an unmanned aerial vehicle attitude stabilization control system model;
(2) Designing a novel rapid nonsingular fixed time terminal sliding mode surface;
(3) Deducing a nonsingular fixed time terminal sliding mode law according to the designed dynamic sliding mode surface;
(4) Designing an adaptive law to effectively estimate an unknown interference upper bound value;
(5) And (3) proving the closed loop stability of the control system by using a candidate Lyapunov function.
As a further improvement of the invention, in the step (1), establishing an unmanned aerial vehicle attitude stabilization control system model includes the following steps:
(1.1) establishing a coordinate system;
establishing an inertial coordinate system I = { x = { (x) I ,y I ,z I And carrier coordinate system B = { x = } B ,y B ,z B P = [ x (t), y (t), z (t) for position and attitude in the inertial coordinate system, respectively] T And
Figure BDA0003993682730000033
linear and angular velocities in the carrier coordinate system are respectively denoted as V = [ V = x ,v y ,v z ] T And ω = [ ω ] x ,ω y ,ω z ] T Position rotation matrix from carrier coordinate system to inertial coordinate system
Figure BDA0003993682730000034
And angular velocity transformation matrix R ω Are respectively expressed as
Figure BDA0003993682730000035
Figure BDA0003993682730000036
Where S is i =sin(i),C i =cos(i),i=ψ,θ,φ;
(1.2) establishing an unmanned aerial vehicle dynamic model;
the dynamic model, expressed by newton-euler equation, is:
Figure BDA0003993682730000041
the concrete development is as follows:
Figure BDA0003993682730000042
here forces generated by the rotor of the electric machine
Figure BDA0003993682730000043
The generated forceMoment of being
Figure BDA0003993682730000044
Lift force generated for the i-th rotor, C T And C m The coefficients of thrust and moment are respectively, l is the distance from the center of mass to the center of the rotor, m is the mass, and J is the rotational inertia matrix. Tau is aero =K r Omega is respectively the aerodynamic moment, K r Is an aerodynamic drag coefficient matrix. Tau is d The method comprises the following steps of (1) obtaining the tension and moment caused by parameter uncertainty and external interference under an inertial coordinate system;
(1.3) establishing a spatial state formal dynamics model;
converting kinetic equations into spatial state form
Figure BDA0003993682730000045
Here, the system state is X = [ X = 1 ,X 2 ,X 3 ] T =[φ,θ,ψ] T Δ f and Δ g are the parameter uncertainties caused by the system parameters m, J, and the nonlinear state function f (X) is defined as follows:
Figure BDA0003993682730000046
the system control gain matrix is
Figure BDA0003993682730000047
The system control input matrix U is expressed as
Figure BDA0003993682730000048
The external disturbance D is defined as follows
Figure BDA0003993682730000049
Finally, the lumped interference L, which contains the parameter uncertainty and the external interference, is defined as follows
L=[L 1 ,L 2 ,L 3 ] T =Δf+ΔgU+D (9)
Assuming that the upper bound of the lumped interference is known, i.e.
Figure BDA00039936827300000410
Here, the
Figure BDA00039936827300000411
The upper bound of the lumped interference.
As a further improvement of the present invention, in step (2), designing a novel fast nonsingular fixed time terminal sliding mode surface comprises the following steps:
(2.1) defining a system error;
let X d =[φ d ,θ d ,ψ d ] T In the desired pose. The attitude tracking error is defined as the difference between the actual and expected values, and is described as
e=X-X d (10)
According to this definition, the tracking error is differentiated into
Figure BDA0003993682730000051
(2.2) designing a novel rapid nonsingular fixed time terminal sliding mode surface;
defining a nonlinear dynamic sliding mode surface as S = [ S (e) 1 ),s(e 2 ),s(e 3 )] T For a single channel, a nonsingular rapid terminal sliding mode surface with fixed time convergence is designed as
Figure BDA0003993682730000052
Wherein h (e) i )=arctan(|e i |),α>1,0<β<1,λ 1 >0,λ 2 >0。
As a further improvement of the present invention, in the step (3), deriving the nonsingular fixed time terminal sliding mode law includes the following steps:
(3.1) to the slip form surface s (e) i ) And (3) carrying out derivation:
Figure BDA0003993682730000053
here h (e) i )=arctan(|e i |),
Figure BDA0003993682730000054
Let k (e) i )=λ 1 h α-β (e i )+λ 2 Then, then
Figure BDA0003993682730000055
Can be simplified into
Figure BDA0003993682730000056
(3.2) ensuring that the sliding mode surface converges to zero in fixed time by the designed approach law;
Figure BDA00039936827300000510
wherein k is 1 ,k 2 ,γ>1,0<μ<1;
(3.3) control law derivation;
designing a controller for the following standard second-order nonlinear system;
Figure BDA0003993682730000057
the designed control law is
Figure BDA0003993682730000058
As a further improvement of the present invention, in the step (4), designing an adaptation law includes the following steps:
the interference upper bound value is effectively estimated through the design of an adaptive law, and the adaptive switching control law is designed to
Figure BDA0003993682730000059
Figure BDA0003993682730000061
Here, the
Figure BDA0003993682730000062
Is a lumped disturbance L i Estimate of (e), epsilon, sigma i Is a normal number, and designs the following self-adaptive nonsingular fixed time sliding mode control law:
Figure BDA0003993682730000063
as a further improvement of the invention, in the step (5), the step of proving the closed-loop stability of the control system by using the candidate Lyapunov function comprises the following steps:
consider the following Lyapunov function
Figure BDA0003993682730000064
Obtaining the derivative according to time;
Figure BDA0003993682730000065
design-in control law U i To obtain
Figure BDA0003993682730000066
Simplified formula (22) to obtain
Figure BDA0003993682730000067
Due to exp (2) s -1) is ≧ 1, obtained
Figure BDA0003993682730000068
Designed dynamic sliding mode surface at fixed time T r Inner convergence to the origin. Convergence time to origin upper bound of
Figure BDA0003993682730000069
Compared with the prior art, the invention has the beneficial effects that:
1. the control quantity of the method is designed by adopting rapid nonsingular fixed time sliding mode control, and compared with the traditional sliding mode controller, the controller designed by the method has control continuity and further reduces the shaking problem. Meanwhile, the proposed algorithm can be stably converged within a fixed time, and has higher tracking accuracy.
2. The fixed-time dynamic sliding mode surface designed by the method is nonsingular, and an indirect mode of sectionally processing the sliding mode surface by a critical layer is not required to be established to avoid the singularity problem, so that the sliding mode surface design is further simplified, and the calculated amount is reduced.
3. The method designs the self-adaptive control law for effectively estimating the upper bound value of the lumped interference, and further improves the quality of control input under the condition of unknown disturbance.
Drawings
Fig. 1 is a flow chart of the unmanned aerial vehicle attitude stabilization control method disclosed by the invention;
FIG. 2 is a graph comparing the effect of the method disclosed in the present invention with other conventional methods.
Detailed Description
The invention is described in further detail below with reference to the following detailed description and accompanying drawings:
as shown in fig. 1, the invention discloses an unmanned aerial vehicle attitude stabilization control method based on a self-adaptive nonsingular fixed time terminal sliding mode, which comprises the following steps:
and (1.1) establishing a coordinate system.
Establishing an inertial coordinate system I = { x = { (x) I ,y I ,z I And carrier coordinate system B = { x = } B ,y B ,z B }. The position and attitude in the inertial coordinate system are represented as P = [ x (t), y (t), z (t), respectively] T And
Figure BDA0003993682730000071
linear and angular velocities in the carrier coordinate system are respectively denoted as V = [ V = x ,v y ,v z ] T And ω = [ ω ] x ,ω y ,ω z ] T . Position rotation matrix from carrier coordinate system to inertial coordinate system
Figure BDA0003993682730000072
And angular velocity transformation matrix R ω Are respectively expressed as
Figure BDA0003993682730000073
Figure BDA0003993682730000074
Where S is i =sin(i),C i =cos(i),i=ψ,θ,φ。
And (1.2) establishing an unmanned aerial vehicle dynamic model.
The kinetic model, which is expressed by the newton-euler equation, can be expressed as:
Figure BDA0003993682730000075
the concrete development is as follows:
Figure BDA0003993682730000076
here forces generated by the rotor of the machine
Figure BDA0003993682730000077
The generated moment is
Figure BDA0003993682730000078
Lift force generated for the i-th rotor, C T And C m The coefficients of thrust and moment are respectively, l is the distance from the center of mass to the center of the rotor, m is the mass, and J is the rotational inertia matrix. Tau is aero =K r Omega is respectively the aerodynamic moment, K r Is an aerodynamic drag coefficient matrix. Tau. d The parameters in the inertial coordinate system are uncertain, and the pulling force and moment caused by external disturbance (such as wind power, variable load, and the like).
And (1.3) establishing a spatial state formal dynamics model.
Converting kinetic equations into spatial state form
Figure BDA0003993682730000081
Here, the system state is X = [ X = [) 1 ,X 2 ,X 3 ] T =[φ,θ,ψ] T . Δ f and Δ g are the parameter uncertainties caused by the system parameters m, J. The nonlinear state function f (X) is defined as follows
Figure BDA0003993682730000082
The system control gain matrix is
Figure BDA0003993682730000083
The system control input matrix U is expressed as
Figure BDA0003993682730000084
The external disturbance D is defined as follows
Figure BDA0003993682730000085
Finally, the lumped interference L, which contains the parameter uncertainty and the external interference, is defined as follows
L[L 1 ,L 2 ,L 3 ] T =Δf+ΔgU+D (9)
In general, it is assumed that the upper bound of the lumped interference is known, i.e.
Figure BDA0003993682730000086
Here, the
Figure BDA0003993682730000087
The upper bound of the lumped interference.
And (2.1) defining a system error.
Let X d =[φ d ,θ d ,ψ d ] T In the desired pose. The attitude tracking error is defined as the difference between the actual and expected values, and is described as
e=X-X d (10)
By this definition, the differential of the tracking error is
Figure BDA0003993682730000088
(2.2) designing a novel fast nonsingular fixed time terminal sliding mode surface.
Defining a nonlinear dynamic sliding mode surface as S = [ S (e) 1 ),s(e 2 ),s(e 3 )] T . Aiming at a single channel, a nonsingular rapid terminal sliding mode surface with fixed time convergence is designed as
Figure BDA0003993682730000089
Wherein h (e) i )=arctan(|e i |),α>1,0<β<1,λ 1 >0,λ 2 >0
(3.1) to the slip form surface s (e) i ) And (6) carrying out derivation.
Figure BDA00039936827300000810
Here h (e) i )=arctan(|e i |),
Figure BDA00039936827300000811
Let k (e) i )=λ 1 h α-β (e i )+λ 2 Then, then
Figure BDA00039936827300000812
Can be simplified into
Figure BDA0003993682730000091
And (3.2) the designed approach law can ensure that the sliding mode surface converges to zero in fixed time.
Figure BDA0003993682730000092
Wherein k is 1 ,k 2 ,γ>1,0<μ<1。
And (3.3) control law derivation.
The controller was designed for the following standard second order nonlinear system.
Figure BDA0003993682730000093
The designed control law is
Figure BDA0003993682730000094
And (4.1) designing an adaptive law.
And the interference upper bound value is effectively estimated through the design of an adaptive law. The adaptive switching control law is designed as
Figure BDA0003993682730000095
Figure BDA0003993682730000096
Here, the
Figure BDA0003993682730000097
Is a lumped disturbance L i Estimate of (e), epsilon, sigma i Is a normal number. The following self-adaptive nonsingular fixed time sliding mode control law is designed:
Figure BDA0003993682730000098
and (5.1) proving the closed loop stability of the control system by using a candidate Lyapunov function.
Consider the following Lyapunov function
Figure BDA0003993682730000099
Derived over time.
Figure BDA0003993682730000101
Design-in control law U i Can obtain
Figure BDA0003993682730000102
Simplified formula (22) can be obtained
Figure BDA0003993682730000103
Due to exp (2) ε -1) is ≧ 1, can be obtained
Figure BDA0003993682730000104
Designed dynamic sliding mode surface at fixed time T r Internally converging to the origin. Convergence time to origin upper bound of
Figure BDA0003993682730000105
In order to verify the attitude stability control performance of the unmanned aerial vehicle disclosed by the invention, the mass of the unmanned aerial vehicle is m =0.9kg, the distance from a rotor to the center of the unmanned aerial vehicle is l =0.175m, and the moment of inertia is [ J ] x J y J z ]=[8.276e-3 8.276e-3 1.612e-2]kg m 2 The moment of inertia of the motor is J r =8.17e-5kg m 2 The moment damping coefficient matrix is [ k ] φ k θ k ψ ]=[5.576e-3 5.576e-3 5.576e-3]Nm(rad/s) 2 . Compared with the attitude stabilization control system for the traditional sliding mode attitude control, the error is shown in fig. 2, in the figure, "-" is a traditional sliding mode attitude stabilization curve, "-" is an unmanned aerial vehicle attitude stabilization curve disclosed by the invention, and the specific comparison effect is as follows:
in the traditional method, the attitude stabilization control root mean square errors of three attitude angles phi, theta and psi are respectively 0.0631,0.0468 and 0.0438; the attitude stabilization control root mean square errors of the three attitude angles phi, theta and psi are respectively 0.0489,0.0360 and 0.0344, and the convergence time is less than 2.1s.
The above description is only a preferred embodiment of the present invention, and is not intended to limit the present invention in any way, but any modifications or equivalent variations made according to the technical spirit of the present invention are within the scope of the present invention as claimed.

Claims (6)

1. The unmanned aerial vehicle attitude control method based on the self-adaptive terminal sliding mode comprises the following steps, and is characterized in that:
(1) Establishing an unmanned aerial vehicle attitude stabilization control system model;
(2) Designing a novel rapid nonsingular fixed time terminal sliding mode surface;
(3) Deducing a nonsingular fixed time terminal sliding mode law according to the designed dynamic sliding mode surface;
(4) Designing an adaptive law to effectively estimate an unknown interference upper bound value;
(5) And (3) proving the closed loop stability of the control system by using the candidate Lyapunov function.
2. The unmanned aerial vehicle attitude control method based on the adaptive terminal sliding mode according to claim 1, characterized in that: in the step (1), the establishment of the unmanned aerial vehicle attitude stabilization control system model comprises the following steps:
(1.1) establishing a coordinate system;
establishing an inertial coordinate system I = { x = { (x) I ,y I ,z I And carrier coordinate system B = { x = } B ,y B ,z B P = [ x (t), y (t), z (t) for position and attitude in the inertial coordinate system, respectively] T And
Figure FDA0003993682720000019
linear and angular velocities in the carrier coordinate system are respectively denoted as V = [ V = x ,v y ,v z ] T And ω = [ ω ] x ,ω y ,ω z ] T Position rotation matrix from carrier coordinate system to inertial coordinate system
Figure FDA0003993682720000011
And angular velocity transformation matrix R ω Are respectively expressed as
Figure FDA0003993682720000012
Figure FDA0003993682720000013
Where S is i =sin(i),C i =cos(i),i=ψ,θ,φ;
(1.2) establishing an unmanned aerial vehicle dynamic model;
the dynamic model, expressed by the newton-euler equation, is:
Figure FDA0003993682720000014
the concrete development is as follows:
Figure FDA0003993682720000015
here forces generated by the rotor of the electric machine
Figure FDA0003993682720000016
The generated moment is
Figure FDA0003993682720000017
Figure FDA0003993682720000018
Lift force generated for the i-th rotor, C T And C m The coefficients of thrust and moment are respectively, l is the distance from the center of mass to the center of the rotor, m is the mass, and J is the rotational inertia matrix. Tau is aero =K r Omega is respectively the aerodynamic moment, K r Is an aerodynamic drag coefficient matrix. Tau is d The method comprises the following steps of (1) obtaining the tension and moment caused by parameter uncertainty and external interference under an inertial coordinate system;
(1.3) establishing a spatial state formal dynamics model;
converting kinetic equations into spatial state form
Figure FDA0003993682720000021
Here, the system state is X = [ X = [) 1 ,X 2 ,X 3 ] T =[φ,θ,ψ] T Δ f and Δ g are the parameter uncertainties caused by the system parameters m, J, and the nonlinear state function f (X) is defined as follows:
Figure FDA0003993682720000022
the system control gain matrix is
Figure FDA0003993682720000023
The system control input matrix U is expressed as
Figure FDA0003993682720000024
The external disturbance D is defined as follows
Figure FDA0003993682720000025
Finally, the lumped disturbance L, which includes parameter uncertainty and external disturbance, is defined as follows
L=[L 1 ,L 2 ,L 3 ] T =Δf+ΔgU+D (9)
Assuming that the upper bound of the lumped interference is known, i.e.
Figure FDA0003993682720000026
Here, the
Figure FDA0003993682720000027
The upper bound of the lumped interference.
3. The unmanned aerial vehicle attitude control method based on the adaptive terminal sliding mode according to claim 1, characterized in that: in the step (2), designing a novel fast nonsingular fixed time terminal sliding mode surface comprises the following steps:
(2.1) defining a system error;
let X d =[φ d ,θ d ,ψ d ] T In the desired pose. The attitude tracking error is defined as the difference between the actual and expected values, and is described as
e=X-X d (10)
According to this definition, the tracking error is differentiated into
Figure FDA0003993682720000028
(2.2) designing a novel rapid nonsingular fixed time terminal sliding mode surface;
defining a nonlinear dynamic sliding mode surface as S = [ S (e) 1 ),s(e 2 ),s(e 3 )] T For a single channel, a nonsingular rapid terminal sliding mode surface with fixed time convergence is designed as
Figure FDA0003993682720000029
Wherein h (e) i )=arctan(|e i |),α>1,0<β<1,λ 1 >0,λ 2 >0。
4. The unmanned aerial vehicle attitude control method based on the adaptive terminal sliding mode according to claim 1, characterized in that: in the step (3), the step of deriving the nonsingular fixed time terminal sliding mode law comprises the following steps:
(3.1) to the slip form surface s (e) i ) And (3) carrying out derivation:
Figure FDA0003993682720000031
here h (e) i )=arctan(|e i |),
Figure FDA0003993682720000032
Let k (e) i )=λ 1 h α-β (e i )+λ 2 Then, then
Figure FDA0003993682720000033
Can be simplified into
Figure FDA0003993682720000034
(3.2) ensuring that the sliding mode surface converges to zero in fixed time by the designed approach law;
Figure FDA00039936827200000310
wherein k is 1 ,k 2 ,γ>1,0<μ<1;
(3.3) control law derivation;
designing a controller for the following standard second-order nonlinear system;
Figure FDA0003993682720000035
the designed control law is
Figure FDA0003993682720000036
5. The unmanned aerial vehicle attitude control method based on the adaptive terminal sliding mode according to claim 1, characterized in that: in the step (4), designing an adaptive law includes the following steps:
the interference upper bound value is effectively estimated through the design of an adaptive law, and the adaptive switching control law is designed to be
Figure FDA0003993682720000037
Figure FDA0003993682720000038
Here, the
Figure FDA0003993682720000039
Is a lumped disturbance L i Estimate of (e), epsilon, sigma i Is a normal number, and designs the following self-adaptive nonsingular fixed time sliding mode control law:
Figure FDA0003993682720000041
6. the unmanned aerial vehicle attitude control method based on the adaptive terminal sliding mode according to claim 1, characterized in that: in the step (5), the step of proving the closed-loop stability of the control system by using the candidate Lyapunov function comprises the following steps:
consider the following Lyapunov function
Figure FDA0003993682720000042
Obtaining the derivative according to time;
Figure FDA0003993682720000043
design-in control law U i To obtain
Figure FDA0003993682720000044
Simplified formula (22) to obtain
Figure FDA0003993682720000045
Due to exp (2) ε -1) is ≧ 1, obtained
Figure FDA0003993682720000046
Designed dynamic sliding mode surface at fixed time T r Internally converging to the origin. Convergence time to origin upper bound of
Figure FDA0003993682720000047
CN202211589931.0A 2022-12-12 2022-12-12 Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode Pending CN115826604A (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202211589931.0A CN115826604A (en) 2022-12-12 2022-12-12 Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202211589931.0A CN115826604A (en) 2022-12-12 2022-12-12 Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode

Publications (1)

Publication Number Publication Date
CN115826604A true CN115826604A (en) 2023-03-21

Family

ID=85546480

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202211589931.0A Pending CN115826604A (en) 2022-12-12 2022-12-12 Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode

Country Status (1)

Country Link
CN (1) CN115826604A (en)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117891281A (en) * 2024-03-15 2024-04-16 天目山实验室 Second-order nonsingular terminal sliding mode flight control method based on nested double modes
CN117991830A (en) * 2024-04-03 2024-05-07 天目山实验室 Method for improving convergence rate of sliding mode control of second-order nonsingular terminal
CN118331062A (en) * 2024-04-30 2024-07-12 青岛大学 Self-adaptive fuzzy fractional order sliding mode fault-tolerant control method and system for suspended load unmanned aerial vehicle
CN118567380A (en) * 2024-08-02 2024-08-30 浙江大学海南研究院 Attitude control method of underwater helicopter
CN118567380B (en) * 2024-08-02 2024-10-22 浙江大学海南研究院 Attitude control method of underwater helicopter

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN117891281A (en) * 2024-03-15 2024-04-16 天目山实验室 Second-order nonsingular terminal sliding mode flight control method based on nested double modes
CN117891281B (en) * 2024-03-15 2024-06-21 天目山实验室 Second-order nonsingular terminal sliding mode flight control method based on nested double modes
CN117991830A (en) * 2024-04-03 2024-05-07 天目山实验室 Method for improving convergence rate of sliding mode control of second-order nonsingular terminal
CN117991830B (en) * 2024-04-03 2024-06-21 天目山实验室 Method for improving convergence rate of sliding mode control of second-order nonsingular terminal
CN118331062A (en) * 2024-04-30 2024-07-12 青岛大学 Self-adaptive fuzzy fractional order sliding mode fault-tolerant control method and system for suspended load unmanned aerial vehicle
CN118567380A (en) * 2024-08-02 2024-08-30 浙江大学海南研究院 Attitude control method of underwater helicopter
CN118567380B (en) * 2024-08-02 2024-10-22 浙江大学海南研究院 Attitude control method of underwater helicopter

Similar Documents

Publication Publication Date Title
CN115826604A (en) Unmanned aerial vehicle attitude control method based on adaptive terminal sliding mode
CN109189087B (en) Self-adaptive fault-tolerant control method for vertical take-off and landing reusable carrier
CN109144084B (en) A kind of VTOL Reusable Launch Vehicles Attitude tracking control method based on set time Convergence monitoring device
CN107491081B (en) Anti-interference four-rotor unmanned aerial vehicle attitude control method
CN108803632B (en) Water surface unmanned ship all-state constraint trajectory tracking control method based on saturation compensation technology
CN107479370B (en) A kind of quadrotor drone finite time self-adaptation control method based on non-singular terminal sliding formwork
CN110377045B (en) Aircraft full-profile control method based on anti-interference technology
CN106444799B (en) Four-rotor unmanned aerial vehicle control method based on fuzzy extended state observer and self-adaptive sliding mode
CN109100939B (en) Input saturation considered water surface unmanned ship all-state constraint trajectory tracking control method
CN107544256B (en) Underwater robot sliding mode control method based on self-adaptive backstepping method
CN109358634B (en) Robust self-adaptive control method for hypersonic aircraft
CN112947067B (en) Precise tracking control method for three-dimensional track of underwater robot
CN107577145B (en) Backstepping sliding mode control method for formation flying spacecraft
CN110109361B (en) Rapid smooth self-adaptive sliding mode control method for hypersonic aircraft
CN108536020A (en) A kind of model reference adaptive sliding model control method for VTOL Reusable Launch Vehicles
CN102880060A (en) Self-adaptive index time varying slip form posture control method of reentry flight vehicle
CN112631316B (en) Limited time control method of variable-load quad-rotor unmanned aerial vehicle
CN113219838B (en) Triaxial inertia stabilized platform high-precision control method based on self-adaptive time-varying bandwidth observer
CN112578805B (en) Attitude control method of rotor craft
CN113238567B (en) Benthonic AUV weak buffeting integral sliding mode point stabilizing control method based on extended state observer
CN105182984A (en) Linear active disturbance rejection control (ADRC) design and parameter tuning of aircraft pitch attitude
CN113858198B (en) Mechanical arm force tracking impedance control method considering joint motor dynamics
CN114281092A (en) Hypersonic aircraft coordination attitude control method based on sliding mode disturbance observer
CN110334411A (en) A kind of underwater robot kinetic parameters discrimination method based on Huber M estimation
CN110471438A (en) A kind of set time Adaptive Attitude Tracking control method of rigid aircraft

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