CN108829118B - Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface - Google Patents

Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface Download PDF

Info

Publication number
CN108829118B
CN108829118B CN201810519668.5A CN201810519668A CN108829118B CN 108829118 B CN108829118 B CN 108829118B CN 201810519668 A CN201810519668 A CN 201810519668A CN 108829118 B CN108829118 B CN 108829118B
Authority
CN
China
Prior art keywords
sliding mode
formula
mode surface
coordinate system
aircraft
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.)
Active
Application number
CN201810519668.5A
Other languages
Chinese (zh)
Other versions
CN108829118A (en
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.)
Zhejiang University of Technology ZJUT
Original Assignee
Zhejiang University of Technology ZJUT
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 Zhejiang University of Technology ZJUT filed Critical Zhejiang University of Technology ZJUT
Priority to CN201810519668.5A priority Critical patent/CN108829118B/en
Publication of CN108829118A publication Critical patent/CN108829118A/en
Application granted granted Critical
Publication of CN108829118B publication Critical patent/CN108829118B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • 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

Abstract

A self-adaptive control method of a four-rotor aircraft based on an inverse proportion function enhanced power approach law and a fast terminal sliding mode surface comprises the following steps: step 1, determining a transfer matrix from a body coordinate system based on a four-rotor aircraft to an inertial coordinate system based on the earth; step 2, analyzing a four-rotor aircraft dynamic model according to a Newton Euler formula; and 3, calculating a tracking error, and designing a controller according to the fast terminal sliding mode surface and the first derivative thereof. The method combines inverse proportion function enhanced power approximation law sliding mode control and rapid terminal sliding mode control, can increase the approximation speed when the sliding mode surface is far away, reduces buffeting, improves the rapidity of the system, realizes rapid and stable control, realizes limited time control of tracking errors, and solves the problem that the tracking errors tend to 0 only when the time tends to be infinite in the traditional sliding mode surface. Meanwhile, the interference boundary is estimated through self-adaptation, and the stability of the system is improved.

Description

Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface
Technical Field
The invention relates to a self-adaptive control method of a four-rotor aircraft based on an inverse proportion function enhanced power approach law and a fast terminal sliding mode surface.
Background
The four-rotor aircraft has attracted wide attention of domestic and foreign scholars and scientific research institutions due to the characteristics of simple structure, strong maneuverability and unique flight mode, and is rapidly one of the hotspots of international research at present. Compared with a fixed-wing aircraft, the rotary-wing aircraft can vertically lift, has low requirement on the environment, does not need a runway, reduces the cost and has great commercial value. The development of the traveling device enables many dangerous high-altitude operations to be easy and safe, so that the traveling device can deter other countries in the military aspect and greatly increase the working efficiency in the civil aspect. The four-rotor aircraft has strong flexibility, can realize rapid transition of motion and hovering at any time, and can be competent for more challenging flight tasks with less damage risk. In the field of scientific research, because a four-rotor aircraft has the dynamic characteristics of nonlinearity, under-actuation and strong coupling, researchers often use the four-rotor aircraft as an experimental carrier for theoretical research and method verification. An aircraft flight control system is built by relying on a small four-rotor aircraft to carry out high-performance motion control research on the aircraft, and the method is a hot research field of the current academic world.
The approach law sliding mode control has the characteristics that discontinuous control can be realized, the sliding mode is programmable and is not related to system parameters and disturbance. The approach law sliding mode not only can reasonably design the speed of reaching the sliding mode surface, reduce the time of the approach stage, improve the robustness of the system, but also can effectively weaken the buffeting problem in the sliding mode control. Currently, in the field of four-rotor control, approach law sliding mode control is less used. The enhanced approach law further accelerates the approach speed of the system to the sliding mode surface and simultaneously enables the buffeting to be smaller on the basis of the traditional approach law. Because the four-rotor aircraft can encounter external environment interference in flight, interference and compensation are carried out on the interference boundary through self-adaptation, and the stability of the system is improved.
Disclosure of Invention
In order to solve the problems that the traditional sliding mode surface can not realize limited time control, further accelerate the approaching speed of an approaching law and reduce buffeting, the method adopts the rapid terminal sliding mode control and the enhanced power approaching law based on the inverse proportion function, avoids the singularity problem through the switching control idea, accelerates the approaching speed of a system to the sliding mode surface, reduces buffeting and realizes the limited time control. Meanwhile, interference and compensation are carried out on the interference boundary through self-adaption, and the stability of the system is improved.
The technical scheme proposed for solving the technical problems is as follows:
a self-adaptive control method of a four-rotor aircraft based on an inverse proportion function enhanced power approach law and a fast terminal sliding mode surface comprises the following steps:
step 1, determining a transfer matrix from a body coordinate system based on a four-rotor aircraft to an inertial coordinate system based on the earth;
Figure BDA0001674493350000021
where psi, theta, phi are the yaw, pitch, roll angles of the aircraft, respectively, representing the angle of rotation of the aircraft about each axis of the inertial frame in sequence, TψTransition matrix, T, representing psiθA transition matrix, T, representing thetaφA transition matrix representing phi;
step 2, analyzing a four-rotor aircraft dynamic model according to a Newton Euler formula, wherein the process is as follows:
2.1, the translation process comprises the following steps:
Figure BDA0001674493350000022
wherein x, y and z respectively represent the position of the four rotors under an inertial coordinate system, m represents the mass of the aircraft, g represents the gravity acceleration, mg represents the gravity borne by the four rotors, and the resultant force U generated by the four rotorsr；
2.2, the rotation process comprises the following steps:
Figure BDA0001674493350000023
wherein tau isx、τy、τzRespectively representing the axial moment components, I, in the coordinate system of the machine bodyxx、Iyy、IzzRespectively representing the rotational inertia component of each axis on the coordinate system of the machine body, x represents cross product, wp、wq、wrRespectively representing the attitude angular velocity components of each axis on the coordinate system of the body,
Figure BDA0001674493350000024
respectively representing the attitude angle of each axis on the coordinate system of the machine body plusA velocity component;
considering that the aircraft is in a low-speed flight or hovering state, consider
Figure BDA0001674493350000031
Then the formula (3) is represented as the formula (4) in the rotation process
Figure BDA0001674493350000032
2.3, connecting the vertical type (1), (2) and (4), and obtaining the dynamic model of the aircraft as shown in the formula (5)
Figure BDA0001674493350000033
Wherein
Figure BDA0001674493350000034
Figure BDA0001674493350000035
Figure BDA0001674493350000036
Ux、Uy、UzThe input quantities of the three position controllers are respectively;
according to the formula (5), decoupling calculation is carried out on the position and posture relation, and the result is as follows:
Figure BDA0001674493350000037
wherein phidIs the desired signal value of phi, thetadDesired signal value of theta, psidFor desired signal values of ψ, the arcsin function is an arcsine function and the arctan function is an arctangent function;
equation (5) can also be written in matrix form as follows:
Figure BDA0001674493350000038
wherein X1＝[x,y,z,φ,θ,ψ]T,
Figure BDA0001674493350000041
B(X)＝diag(1,1,1,b1,b2,b3),U＝[Ux,Uy,Uz,τx,τy,τz]T，
Figure BDA0001674493350000042
Step 3, calculating a tracking error, and designing a controller according to the fast terminal sliding mode surface and the first derivative thereof, wherein the process is as follows:
3.1, defining the tracking error and its first and second differentials:
e＝X1-Xd (8)
Figure BDA0001674493350000043
Figure BDA0001674493350000044
wherein, Xd＝[xd,yd,zd,φd,θd,ψd]T，xd,yd,zd,φd,θd,ψdThe conductive desired signals are x, y, z, phi, theta, psi, respectively,
Figure BDA0001674493350000045
i＝1，2,3,4,5,6，Di，c0i，c1i，c2i，ei，
Figure BDA0001674493350000046
are respectively the corresponding ith element；
3.2, designing a quick terminal sliding mode surface:
Figure BDA0001674493350000047
wherein, sigα(x)＝|x|α·sign(x)，α1＞α2＞1，λ1＞0，λ2＞0；
Derivation of equation (11) yields:
Figure BDA0001674493350000048
order to
Figure BDA0001674493350000049
Formula (12) is simplified to formula (13)
Figure BDA00016744933500000410
But due to the presence of alpha (e)
Figure BDA00016744933500000411
When α (e) is 0 and β (e) is not equal to 0, the negative power term of (a) causes a singularity problem;
consider the method of handover control:
Figure BDA0001674493350000051
wherein q isi(e),αi(e),βi(e) Q (e), alpha (e), beta (e) respectively,
Figure BDA0001674493350000052
combining formula (13) and formula (14) to obtain:
Figure BDA0001674493350000053
conjunctive formula (7), formula (10) and formula (15) yields:
Figure BDA0001674493350000054
3.3 design enhanced approach law
Figure BDA0001674493350000055
Wherein
Figure BDA0001674493350000056
N-1(X) is the inverse of N (X), k1＞0，0＜β1Less than 1, delta is more than 0 and less than 1, gamma is more than 0, mu is more than 1, and p is a positive integer;
3.4, combined vertical (16) and formula (17), to obtain a controller
Figure BDA0001674493350000057
Wherein B is-1(X) is the inverse of B (X),
Figure BDA0001674493350000058
Figure BDA0001674493350000059
respectively corresponding ith element;
the adaptive law is designed as follows:
Figure BDA00016744933500000510
Figure BDA00016744933500000511
Figure BDA00016744933500000512
step 4, property specification, the process is as follows:
when the system moves away from the sliding mode, | s | is large, N(s) approaches δ,
Figure BDA0001674493350000061
the approach speed of the system is accelerated; when the system approaches the sliding mode, | s | approaches 0, N(s) approaches μ,
Figure BDA0001674493350000062
the buffeting of the system is reduced.
The technical conception of the invention is as follows: aiming at a four-rotor aircraft system, a four-rotor aircraft self-adaptive control method based on an inverse proportion function enhanced power approximation law and a fast terminal sliding mode surface is designed by combining power approximation law sliding mode control and fast terminal sliding mode control. The quick terminal sliding mode surface can realize the limited time control of the tracking error, and solves the problems that the time tends to be infinite and the error tends to be 0 in the traditional sliding mode surface. Based on the inverse proportion function enhanced approach law, the approach speed can be increased when the sliding mode face is far away, buffeting can be reduced, the rapidness and robustness of the system are improved, and rapid and stable control is achieved. Meanwhile, interference and compensation are carried out on the interference boundary through self-adaption, and the stability of the system is improved.
The invention has the beneficial effects that: compared with the traditional power approach law sliding mode control, the method can increase the approach speed when the system is far away from the sliding mode surface, reduce buffeting and shorten the arrival time of the sliding mode, thereby enabling the system to realize stable convergence more quickly. In addition, the invention utilizes the quick terminal sliding mode, solves the problems that the time tends to be infinite and the error tends to be 0 in the traditional sliding mode surface, and realizes the limited time control. Meanwhile, interference and compensation are carried out on the interference boundary through self-adaption, and the stability of the system is improved.
Drawings
Fig. 1 is a schematic diagram of a position tracking effect of a four-rotor aircraft, wherein a dotted line represents '1' type enhanced power approximation rule adaptive control under a linear sliding mode surface, and a dotted line represents enhanced power approximation rule adaptive control based on an inverse proportion function 'mu' type under a fast terminal sliding mode surface.
Fig. 2 is a schematic diagram of attitude tracking effect of a four-rotor aircraft, wherein a dotted line represents '1' type enhanced power approximation rule adaptive control of a linear sliding mode surface, and a dotted line represents enhanced power approximation rule adaptive control of a fast terminal sliding mode surface based on an inverse proportional function 'mu'.
Fig. 3 is a schematic diagram of the input of a position controller for enhanced power-law adaptive control of a '1' type under a linear sliding mode surface of a four-rotor aircraft.
Fig. 4 is an input schematic diagram of a position controller for self-adaptive control of a sliding mode surface of a fast terminal of a four-rotor aircraft based on an inverse proportion function mu-type enhanced power approximation law.
Fig. 5 is an input schematic diagram of an attitude controller for '1' -type enhanced power-law adaptive control under a linear sliding mode surface of a four-rotor aircraft.
Fig. 6 is an input schematic diagram of an attitude controller for four-rotor aircraft fast terminal sliding mode surface adaptive control based on inverse proportion function mu type enhanced power approximation law.
Fig. 7 is a schematic diagram of local amplification of input of an attitude controller for '1' -type enhanced power-order approximation law adaptive control under a linear sliding mode surface of a four-rotor aircraft.
Fig. 8 is a schematic diagram of local amplification of input of an attitude controller for four-rotor aircraft fast terminal sliding mode surface based on inverse proportion function mu-type enhanced power approximation law adaptive control.
FIG. 9 is an estimation of the bounds of the position disturbance of the fast terminal sliding mode surface of the quadrotor based on the inverse proportional function 'mu' type enhanced power approximation law adaptive control.
FIG. 10 is an estimation of the boundary of attitude disturbance of a four-rotor aircraft fast terminal sliding mode surface based on inverse proportional function 'mu' type enhanced power approximation law adaptive control.
FIG. 11 is a control flow diagram of the present invention.
Detailed Description
The invention is further described below with reference to the accompanying drawings.
Referring to fig. 1-11, a self-adaptive control method of a quadrotor aircraft based on an inverse proportion function enhanced power approach law and a fast terminal sliding mode surface comprises the following steps:
step 1, determining a transfer matrix from a body coordinate system based on a four-rotor aircraft to an inertial coordinate system based on the earth;
Figure BDA0001674493350000071
where psi, theta, phi are the yaw, pitch, roll angles of the aircraft, respectively, representing the angle of rotation of the aircraft about each axis of the inertial frame in sequence, TψTransition matrix, T, representing psiθA transition matrix, T, representing thetaφA transition matrix representing phi;
step 2, analyzing a four-rotor aircraft dynamic model according to a Newton Euler formula, wherein the process is as follows:
2.1, the translation process comprises the following steps:
Figure BDA0001674493350000081
wherein x, y and z respectively represent the position of the four rotors under an inertial coordinate system, m represents the mass of the aircraft, g represents the gravity acceleration, mg represents the gravity borne by the four rotors, and the resultant force U generated by the four rotorsr；
2.2, the rotation process comprises the following steps:
Figure BDA0001674493350000082
wherein tau isx、τy、τzRespectively representing the axial moment components, I, in the coordinate system of the machine bodyxx、Iyy、IzzRespectively representing the rotational inertia component of each axis on the coordinate system of the machine body, x represents cross product, wp、wq、wrRespectively representing the attitude angular velocity components of each axis on the coordinate system of the body,
Figure BDA0001674493350000083
respectively representing the attitude angular acceleration components of all axes on the coordinate system of the machine body;
considering that the aircraft is in a low-speed flight or hovering state, consider
Figure BDA0001674493350000084
Then the formula (3) is represented as the formula (4) in the rotation process
Figure BDA0001674493350000085
2.3, connecting the vertical type (1), (2) and (4), and obtaining the dynamic model of the aircraft as shown in the formula (5)
Figure BDA0001674493350000091
Wherein
Figure BDA0001674493350000092
Figure BDA0001674493350000093
Figure BDA0001674493350000094
Ux、Uy、UzThe input quantities of the three position controllers are respectively;
according to the formula (5), decoupling calculation is carried out on the position and posture relation, and the result is as follows:
Figure BDA0001674493350000095
wherein phidIs the desired signal value of phi, thetadDesired signal value of theta, psidFor desired signal values of ψ, the arcsin function is an arcsine function and the arctan function is an arctangent function;
equation (5) can also be written in matrix form as follows:
Figure BDA0001674493350000096
wherein X1＝[x,y,z,φ,θ,ψ]T,
Figure BDA0001674493350000097
B(X)＝diag(1,1,1,b1,b2,b3),U＝[Ux,Uy,Uz,τx,τy,τz]T，
Figure BDA0001674493350000098
Step 3, calculating a tracking error, and designing a controller according to the fast terminal sliding mode surface and the first derivative thereof, wherein the process is as follows:
3.1, defining the tracking error and its first and second differentials:
e＝X1-Xd (8)
Figure BDA0001674493350000099
Figure BDA0001674493350000101
wherein, Xd＝[xd,yd,zd,φd,θd,ψd]T，xd,yd,zd,φd,θd,ψdThe conductive desired signals are x, y, z, phi, theta, psi, respectively,
Figure BDA0001674493350000102
i＝1，2,3,4,5,6，Di，c0i，c1i，c2i，ei，
Figure BDA0001674493350000103
respectively corresponding ith element;
3.2, designing a quick terminal sliding mode surface:
Figure BDA0001674493350000104
wherein, sigα(x)＝|x|α·sign(x)，α1＞α2＞1，λ1＞0，λ2＞0；
Derivation of equation (11) yields:
Figure BDA0001674493350000105
order to
Figure BDA0001674493350000106
Formula (12) is simplified to formula (13)
Figure BDA0001674493350000107
But due to the presence of alpha (e)
Figure BDA0001674493350000108
When α (e) is 0 and β (e) is not equal to 0, the negative power term of (a) causes a singularity problem;
consider the method of handover control:
Figure BDA0001674493350000109
wherein q isi(e),αi(e),βi(e) Q (e), alpha (e), beta (e) respectively,
Figure BDA00016744933500001010
combining formula (13) and formula (14) to obtain:
Figure BDA00016744933500001011
conjunctive formula (7), formula (10) and formula (15) yields:
Figure BDA00016744933500001012
3.3 design enhanced approach law
Figure BDA0001674493350000111
Wherein
Figure BDA0001674493350000112
N-1(X) is the inverse of N (X), k1＞0，0＜β1Less than 1, delta is more than 0 and less than 1, gamma is more than 0, mu is more than 1, and p is a positive integer;
3.4, combined vertical (16) and formula (17), to obtain a controller
Figure BDA0001674493350000113
Wherein B is-1(X) is the inverse of B (X),
Figure BDA0001674493350000114
Figure BDA0001674493350000115
respectively corresponding ith element;
the adaptive law is designed as follows:
Figure BDA0001674493350000116
Figure BDA0001674493350000117
Figure BDA0001674493350000118
step 4, property specification, the process is as follows:
when the system moves away from the sliding mode, | s | is large, N(s) approaches δ,
Figure BDA0001674493350000119
the approach speed of the system is accelerated; when the system approaches the sliding mode, | s | approaches 0, N(s) approaches μ,
Figure BDA00016744933500001110
the buffeting of the system is reduced.
In order to verify the effectiveness of the method, the invention provides a comparison between a sliding mode control method of a rapid terminal sliding mode surface based on a inverse proportion function mu-type enhanced power approximation law and a sliding mode control method of a linear sliding mode surface 1-type enhanced power approximation law:
wherein, in the enhanced power approximation law of '1' type
Figure BDA00016744933500001111
Figure BDA00016744933500001112
For more efficient comparison, all parameters of the system are consistent, i.e. xd＝yd＝zd＝2、ψd0.5, fast terminal sliding mode surface parameters: lambda [ alpha ]1＝0.5、λ2＝2、α1＝2、α21.1,. epsilon.0.3, linearA slip form surface: lambda [ alpha ]10.5, "μ" type enhanced proximity law parameter: k is a radical of1＝10、δ＝0.1、p＝1、γ＝1、μ＝10、β10.7, enhanced approximation rule parameter of "1": k is a radical of1＝10、δ＝0.1、p＝1、γ＝1、β10.7, adaptive initial value setting
Figure BDA0001674493350000121
Figure BDA0001674493350000122
p0i＝p1i＝p2i＝0.1、ε0i＝ε1i＝ε2i0.001, 1,2,3,4,5,6, interference parameter: dx＝dy＝dz＝0.2sin(0.2t)、
Figure BDA0001674493350000123
Parameters of the four-rotor aircraft: 1.1 and Ixx＝1.22、Iyy＝1.22、Izz2.2, g 9.81, sampling parameters: t is ts＝0.007，N＝5000。
As can be seen from fig. 1 and 2, the adaptive control of the quadrotor aircraft based on the inverse proportional function enhanced power approach law and the fast terminal sliding mode surface can reach the expected position more quickly; 3-8, the self-adaptive control of the quadrotor aircraft based on the inverse proportion function enhanced power approach law and the fast terminal sliding mode surface has smaller buffeting; fig. 9 and 10 can see the effectiveness of the estimation of the adaptive epipolar.
In conclusion, the adaptive control of the quadrotor aircraft based on the inverse proportion function enhanced power approach law and the fast terminal sliding mode surface can reduce the buffeting, reduce the tracking time, improve the tracking performance and enable the system to enter stable convergence more quickly.
While the foregoing has described a preferred embodiment of the invention, it will be appreciated that the invention is not limited to the embodiment described, but is capable of numerous modifications without departing from the basic spirit and scope of the invention as set out in the appended claims.

Claims (1)

1. A self-adaptive control method of a four-rotor aircraft based on an inverse proportion function enhanced power approach law and a fast terminal sliding mode surface is characterized by comprising the following steps:
step 1, determining a transfer matrix from a body coordinate system based on a four-rotor aircraft to an inertial coordinate system based on the earth;
Figure FDA0003065756010000011
wherein psi, theta and phi are respectively the yaw angle, pitch angle and roll angle of the aircraft, and represent the angle of the aircraft sequentially rotating around each axis of the inertial coordinate system, and TψTransition matrix, T, representing psiθA transition matrix, T, representing thetaφA transition matrix representing phi;
step 2, analyzing a four-rotor aircraft dynamic model according to a Newton Euler formula, wherein the process is as follows:
2.1, the translation process comprises the following steps:
Figure FDA0003065756010000012
wherein x, y and z respectively represent the position of the four rotors under an inertial coordinate system, m represents the mass of the aircraft, g represents the gravity acceleration, mg represents the gravity borne by the four rotors, and the resultant force U generated by the four rotorsr；
2.2, the rotation process comprises the following steps:
Figure FDA0003065756010000013
wherein tau isx、τy、τzRespectively representing the axial moment components, I, in the coordinate system of the machine bodyxx、Iyy、IzzRespectively representing each axis rotation inertia on the coordinate system of the machine bodyComponent of quantity, x represents cross product, wp、wq、wrRespectively representing the attitude angular velocity components of each axis on the coordinate system of the body,
Figure FDA0003065756010000014
respectively representing the attitude angular acceleration components of all axes on the coordinate system of the machine body;
considering that the aircraft is in a low-speed flight or hovering state, consider
Figure FDA0003065756010000021
Then the formula (3) is represented as the formula (4) in the rotation process
Figure FDA0003065756010000022
2.3, connecting the vertical type (1), (2) and (4), and obtaining the dynamic model of the aircraft as shown in the formula (5)
Figure FDA0003065756010000023
Wherein
Figure FDA0003065756010000024
Figure FDA0003065756010000025
Figure FDA0003065756010000026
Ux、Uy、UzThe input quantities of the three position controllers are respectively;
according to the formula (5), decoupling calculation is carried out on the position and posture relation, and the result is as follows:
Figure FDA0003065756010000027
wherein phidIs the desired signal value of phi, thetadDesired signal value of theta, psidFor desired signal values of ψ, the arcsin function is an arcsine function and the arctan function is an arctangent function;
considering further the case where interference exists, equation (5) can be written in a matrix form as follows:
Figure FDA0003065756010000028
wherein X1＝[x,y,z,φ,θ,ψ]T,
Figure FDA0003065756010000031
B(X)＝diag(1,1,1,b1,b2,b3),U＝[Ux,Uy,Uz,τx,τy,τz]T，
Figure FDA0003065756010000032
Step 3, calculating a tracking error, and designing a controller according to the fast terminal sliding mode surface and the first derivative thereof, wherein the process is as follows:
3.1, defining the tracking error and its first and second differentials:
e＝X1-Xd (8)
Figure FDA0003065756010000033
Figure FDA0003065756010000034
wherein, Xd＝[xd,yd,zd,φd,θd,ψd]T，xd,yd,zd,φd,θd,ψdThe conductive desired signals are x, y, z, phi, theta, psi, respectively,
Figure FDA0003065756010000035
i＝1，2,3,4,5,6，Di，c0i，c1i，c2i，ei，
Figure FDA0003065756010000036
respectively corresponding ith element;
3.2, designing a quick terminal sliding mode surface:
Figure FDA0003065756010000037
wherein, sigα(x)＝|x|α·sign(x)，α1＞α2＞1，λ1＞0，λ2＞0；
Derivation of equation (11) yields:
Figure FDA0003065756010000038
order to
Figure FDA0003065756010000039
Formula (12) is simplified to formula (13)
Figure FDA00030657560100000310
But because of
Figure FDA00030657560100000311
In existence of
Figure FDA00030657560100000312
Of negative powerAn entry, when α (e) is 0 and β (e) is not equal to 0, causes a singularity problem;
consider the method of handover control:
Figure FDA0003065756010000041
wherein q isi(e),αi(e),βi(e) Q (e), α (e), β (e), i ═ 1,2,3,4,5, 6;
combining formula (13) and formula (14) to obtain:
Figure FDA0003065756010000042
conjunctive formula (7), formula (10) and formula (15) yields:
Figure FDA0003065756010000043
3.3 design enhanced approach law
Figure FDA0003065756010000044
Wherein
Figure FDA0003065756010000045
N-1(X) is the inverse of N (X), k1＞0，0＜β1Less than 1, delta is more than 0 and less than 1, gamma is more than 0, mu is more than 1, and p is a positive integer;
3.4, combined vertical (16) and formula (17), to obtain a controller
Figure FDA0003065756010000046
Wherein B is-1(X) is the inverse of B (X),
Figure FDA0003065756010000047
Figure FDA0003065756010000048
respectively corresponding ith element;
the adaptive law is designed as follows:
Figure FDA0003065756010000049
Figure FDA00030657560100000410
Figure FDA00030657560100000411
step 4, enhanced property specification, the process is as follows:
when the system moves away from the sliding mode, | s | is large, N(s) approaches δ,
Figure FDA0003065756010000051
the approach speed of the system is accelerated; when the system approaches the sliding mode, | s | approaches 0, N(s) approaches μ,
Figure FDA0003065756010000052
the buffeting of the system is reduced.
CN201810519668.5A 2018-05-28 2018-05-28 Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface Active CN108829118B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810519668.5A CN108829118B (en) 2018-05-28 2018-05-28 Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810519668.5A CN108829118B (en) 2018-05-28 2018-05-28 Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface

Publications (2)

Publication Number Publication Date
CN108829118A CN108829118A (en) 2018-11-16
CN108829118B true CN108829118B (en) 2021-08-03

Family

ID=64145731

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810519668.5A Active CN108829118B (en) 2018-05-28 2018-05-28 Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface

Country Status (1)

Country Link
CN (1) CN108829118B (en)

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106774373A (en) * 2017-01-12 2017-05-31 哈尔滨工业大学 A kind of four rotor wing unmanned aerial vehicle finite time Attitude tracking control methods
CN107490966A (en) * 2017-08-22 2017-12-19 浙江工业大学 A kind of aircraft finite time Adaptive Attitude control method based on improvement power Reaching Law
WO2017219295A1 (en) * 2016-06-22 2017-12-28 SZ DJI Technology Co., Ltd. Systems and methods of aircraft walking systems
CN107577144A (en) * 2017-08-22 2018-01-12 浙江工业大学 A kind of aircraft finite time Adaptive Attitude control method based on enhanced index Reaching Law
CN107608212A (en) * 2017-08-30 2018-01-19 湖北工业大学 A kind of maglev train system control method of the integral sliding mode control based on the double power Reaching Laws of modified
CN107992082A (en) * 2017-12-26 2018-05-04 电子科技大学 Quadrotor UAV Flight Control method based on fractional order power switching law

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9715234B2 (en) * 2015-11-30 2017-07-25 Metal Industries Research & Development Centre Multiple rotors aircraft and control method

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2017219295A1 (en) * 2016-06-22 2017-12-28 SZ DJI Technology Co., Ltd. Systems and methods of aircraft walking systems
CN106774373A (en) * 2017-01-12 2017-05-31 哈尔滨工业大学 A kind of four rotor wing unmanned aerial vehicle finite time Attitude tracking control methods
CN107490966A (en) * 2017-08-22 2017-12-19 浙江工业大学 A kind of aircraft finite time Adaptive Attitude control method based on improvement power Reaching Law
CN107577144A (en) * 2017-08-22 2018-01-12 浙江工业大学 A kind of aircraft finite time Adaptive Attitude control method based on enhanced index Reaching Law
CN107608212A (en) * 2017-08-30 2018-01-19 湖北工业大学 A kind of maglev train system control method of the integral sliding mode control based on the double power Reaching Laws of modified
CN107992082A (en) * 2017-12-26 2018-05-04 电子科技大学 Quadrotor UAV Flight Control method based on fractional order power switching law

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
Sliding Mode Control-based Limit Cycle Oscillation Suppression for UAVs Using Synthetic Jet Actuators;Natalie RamosPedroza,等;《iEEE》;20151231;第1-5页 *
一种新型滑模控制双幂次趋近律;张合新等;《控制与决策》;20131231;第28卷(第2期);第289-293页 *

Also Published As

Publication number Publication date
CN108829118A (en) 2018-11-16

Similar Documents

Publication Publication Date Title
CN108828937B (en) Finite time control method of four-rotor aircraft based on exponential enhancement type exponential approaching law and fast terminal sliding mode surface
CN108536018B (en) Four-rotor aircraft self-adaptive control method based on inverse proportion function enhanced double-power approach law and fast terminal sliding mode surface
CN108563128B (en) Self-adaptive control method of four-rotor aircraft based on exponential enhancement type rapid power approximation law and rapid terminal sliding mode surface
CN108646773B (en) Self-adaptive control method of four-rotor aircraft based on exponential enhancement type double-power approach law and fast terminal sliding mode surface
CN108845497B (en) Finite time control method of four-rotor aircraft based on hyperbolic tangent enhanced index approach law and fast terminal sliding mode surface
CN108803638B (en) Self-adaptive control method of four-rotor aircraft based on hyperbolic tangent enhanced rapid power approach law and rapid terminal sliding mode surface
CN108563125B (en) Self-adaptive control method of four-rotor aircraft based on exponential enhancement type power approach law and fast terminal sliding mode surface
CN108563126B (en) Self-adaptive control method of four-rotor aircraft based on hyperbolic sine enhanced power approximation law and fast terminal sliding mode surface
CN108829117B (en) Self-adaptive control method of four-rotor aircraft based on logarithm enhancement type power approach law and fast terminal sliding mode surface
CN108549241B (en) Self-adaptive control method of four-rotor aircraft based on arc tangent enhanced double-power approach law and fast terminal sliding mode surface
CN108803319B (en) Self-adaptive control method of four-rotor aircraft based on logarithm enhancement type fast power approach law and fast terminal sliding mode surface
CN108549400B (en) Self-adaptive control method of four-rotor aircraft based on logarithm enhanced double-power approach law and fast terminal sliding mode surface
CN108845586B (en) Finite time control method of four-rotor aircraft based on hyperbolic sine enhanced constant-speed approach law and fast terminal sliding mode surface
CN108762076B (en) Finite time control method of four-rotor aircraft based on inverse proportion function enhanced constant speed approach law and rapid terminal sliding mode surface
CN108829118B (en) Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface
CN108829128B (en) Four-rotor aircraft finite time control method based on logarithm enhancement type exponential approaching law and fast terminal sliding mode surface
CN108628168B (en) Four-rotor aircraft self-adaptive control method based on inverse proportion function enhanced rapid power approach law and rapid terminal sliding mode surface
CN108549401B (en) Finite time control method of four-rotor aircraft based on hyperbolic sine enhanced index approach law and fast terminal sliding mode surface
CN108829120B (en) Self-adaptive control method of four-rotor aircraft based on arc tangent enhanced power approach law and fast terminal sliding mode surface
CN108829119B (en) Self-adaptive control method of four-rotor aircraft based on hyperbolic tangent enhanced power approach law and fast terminal sliding mode surface
CN108536019B (en) Self-adaptive control method of four-rotor aircraft based on hyperbolic tangent enhanced double-power approach law and fast terminal sliding mode surface
CN108628333B (en) Self-adaptive control method of four-rotor aircraft based on hyperbolic sine enhanced double-power approach law and fast terminal sliding mode surface
CN108563127B (en) Self-adaptive control method of four-rotor aircraft based on hyperbolic sine enhanced fast power approach law and fast terminal sliding mode surface
CN108776485B (en) Self-adaptive control method of four-rotor aircraft based on arc tangent enhanced fast power approach law and fast terminal sliding mode surface
CN108829127B (en) Finite time control method of four-rotor aircraft based on hyperbolic tangent enhanced constant velocity approach law and fast terminal sliding mode surface

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
EE01 Entry into force of recordation of patent licensing contract
EE01 Entry into force of recordation of patent licensing contract

Application publication date: 20181116

Assignee: Zhejiang puyun Technology Co.,Ltd.

Assignor: JIANG University OF TECHNOLOGY

Contract record no.: X2023980037552

Denomination of invention: Adaptive Control Method for Four Rotor Aircraft Based on Inverse Proportional Function Enhanced Power Reaching Law and Fast Terminal Sliding Surface

Granted publication date: 20210803

License type: Common License

Record date: 20230706