CN107490966B - Aircraft finite time self-adaptive attitude control method based on improved power approach law - Google Patents

Aircraft finite time self-adaptive attitude control method based on improved power approach law Download PDF

Info

Publication number
CN107490966B
CN107490966B CN201710725614.XA CN201710725614A CN107490966B CN 107490966 B CN107490966 B CN 107490966B CN 201710725614 A CN201710725614 A CN 201710725614A CN 107490966 B CN107490966 B CN 107490966B
Authority
CN
China
Prior art keywords
formula
aircraft
sliding mode
following
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.)
Active
Application number
CN201710725614.XA
Other languages
Chinese (zh)
Other versions
CN107490966A (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 CN201710725614.XA priority Critical patent/CN107490966B/en
Publication of CN107490966A publication Critical patent/CN107490966A/en
Application granted granted Critical
Publication of CN107490966B publication Critical patent/CN107490966B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05BCONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
    • G05B13/00Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
    • G05B13/02Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
    • G05B13/04Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
    • G05B13/042Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance

Landscapes

  • Engineering & Computer Science (AREA)
  • Software Systems (AREA)
  • Artificial Intelligence (AREA)
  • Computer Vision & Pattern Recognition (AREA)
  • Evolutionary Computation (AREA)
  • Medical Informatics (AREA)
  • Health & Medical Sciences (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)

Abstract

An aircraft finite time self-adaptive attitude control method based on an improved power approximation law is designed by utilizing a sliding mode control method based on the improved power approximation law and combining self-adaptive control aiming at the problem of aircraft attitude stability with centralized uncertainty. The design of the terminal sliding mode surface is to ensure the finite time convergence of the system and reduce the buffeting problem in the practical control system through an improved power approximation law. In addition, adaptive control is a feedback control system for intelligently adjusting its own characteristics according to environmental changes so that the system can operate in an optimum state according to some set criteria. The invention provides a control method which can reduce the buffeting problem of a sliding mode surface and control moment, and can realize the consistency of limited time of a system and final bounding under the condition that the system has uncertainty and interference.

Description

Aircraft finite time self-adaptive attitude control method based on improved power approach law
Technical Field
The invention relates to an aircraft finite time self-adaptive attitude control method based on an improved power approach law, in particular to an aircraft attitude control method with external interference and rotation inertia matrix uncertainty.
Background
The flight control system is the core of the unmanned aerial vehicle, and the unmanned aerial vehicle needs to complete autonomous flight and has good control characteristics on an inner loop (attitude loop) and an outer loop (horizontal position and height loop). The flight control law design of the drone determines its flight performance. These properties include various flight properties, such as: takeoff and landing performance, operation flight performance, flight safety reliability, flight monitoring performance, system automation, maintainability and the like. The performance requirements of the unmanned aerial vehicle flight control system are more and more complex, and a classical control method is difficult to process and coordinate the multivariable input and output characteristics of the system. With the development of modern control theory, the sliding mode variable structure control as a typical nonlinear control method can effectively improve the stability and maneuverability of the aircraft, thereby improving the task execution capacity. Therefore, the sliding mode variable structure control method for researching the unmanned aerial vehicle attitude system has very important significance.
Sliding mode control is considered to be an effective robust control method in solving system uncertainty and external disturbances. The sliding mode control method has the advantages of simple algorithm, high response speed, strong robustness to external noise interference and parameter perturbation and the like. Therefore, the sliding mode control method is widely applied to various fields. Compared with the traditional linear sliding mode control, the terminal sliding mode control has the advantage of limited time convergence. However, the discontinuous switching characteristic of the terminal sliding mode control in nature will cause the buffeting of the system, and the terminal sliding mode control becomes an obstacle to the application of the terminal sliding mode control in the practical system. To solve this problem, many improved methods are proposed in succession, such as a high-order sliding mode control method, an observer control method. Recently, an improved power approximation law has been proposed that provides a good reduction in the jitter problem and a smoother system input signal in the system response.
However, in most of the proposed methods described above, both the kinematic and the kinetic model parameters of the aircraft attitude system must be known in advance. Therefore, the proposed method cannot be directly applied to attitude control of an aircraft when there is an uncertainty factor in the system. It is known that adaptive control has been widely used for the problem of uncertain system control because it can intelligently adjust its own characteristics of a feedback control system according to environmental changes so that the system can operate in an optimal state according to some set criteria. For the reasons described above, a number of adaptive control methods are used to control spacecraft systems.
Disclosure of Invention
In order to overcome the defects of unknown nonlinearity and sliding mode control buffeting in the existing aircraft attitude control system, the invention provides an aircraft finite time self-adaptive attitude control method based on an improved power approximation law, and a control method for realizing the consistency and final bounding of the finite time of the system under the condition that the system has uncertainty and interference.
The technical scheme proposed for solving the technical problems is as follows:
an aircraft finite time self-adaptive attitude control method based on an improved power approach law comprises the following steps:
step 1, establishing a kinematics and dynamics model of an aircraft attitude control system, initializing system states and control parameters, and carrying out the following processes:
1.1 the dynamic model expression form of the aircraft attitude control system is as follows:
Figure BDA0001385944670000021
wherein,
Figure BDA0001385944670000022
angular velocity and angular acceleration of the aircraft, respectively, × is an operator applying the operator × to a ═ a1,a2,a3]TCan obtain a×=[0,-a3,a2;a3,0,-a1;-a2,a1,0];J∈R3×3Is the rotational inertia matrix of the aircraft u ∈ R3And d (t) ∈ R3Control moment and external disturbance;
1.2 the representation form of the kinematics model of the aircraft attitude control system is as follows:
Figure BDA0001385944670000023
Figure BDA0001385944670000024
wherein the unit quaternion
Figure BDA0001385944670000025
Describing the attitude of an aircraft and satisfying
Figure BDA0001385944670000026
Are each q0And q isvDerivative of I ∈ R3×3Is a 3 × 3 identity matrix;
1.3 suppose the rotational inertia matrix J ═ J0+ Δ J, wherein J0And Δ J represent the nominal and indeterminate portions of J, respectively, then equation (1) is rewritten as:
Figure BDA0001385944670000027
1.4 to more easily describe the attitude dynamics controller design of an aircraft, let
Figure BDA0001385944670000031
Substituting formula (2) to obtain:
Figure BDA0001385944670000032
wherein,
Figure BDA0001385944670000033
differentiating equation (5) yields:
Figure BDA0001385944670000034
wherein,
Figure BDA0001385944670000035
are respectively P and qvFirst and second derivatives of;
after the formula (5) and the formula (6) are substituted into the formula (4), P is simultaneously multiplied on two sides of the formulaTObtaining:
Figure BDA0001385944670000036
wherein, J*=PTJ0P and inertia matrix J due to rotation*Is a skew symmetric positive definite matrix, then the matrix
Figure BDA0001385944670000037
Satisfying the following oblique symmetry relationship:
Figure BDA0001385944670000038
at the same time J*The following inequalities are satisfied:
Figure BDA0001385944670000039
Jminand JmaxIs a normal number and represents J*Lower and upper bounds of (1);
Figure BDA00013859446700000310
Figure BDA00013859446700000311
is a set of interference and uncertainty, satisfying | | Td||≤γ0Φ,Φ=1+||ω||+||ω||2And gamma is0Is a normal number;
step 2, under the condition that the moment of inertia is uncertain and external disturbance exists, designing a required sliding mode surface based on an attitude control system of the aircraft, wherein the process is as follows:
2.1 selection of slip form surface s ∈ R3Comprises the following steps:
Figure BDA0001385944670000041
wherein α and β are normal numbers;
Figure BDA0001385944670000042
r1and r2Is a positive odd number and 0<r1<r2(ii) a Function sig (q)v)rIs defined as sig (q)v)r=[|qv1|rsign(qv1),|qv2|rsign(qv2),|qv3|rsign(qv3)]T
Derivation of equation (10) yields:
Figure BDA0001385944670000043
wherein,
Figure BDA0001385944670000044
is the derivative of s; | qvL is qvAbsolute value of (d);
Figure BDA0001385944670000045
if q isvj0, j is 1,2,3 and
Figure BDA0001385944670000046
wherein q isvjJ is 1,2,3 is qvThe jth element in the vector; to avoid the occurrence of singularities, which arise due to the presence of the negative fractional power r-1, the first derivative of s is changed to:
Figure BDA0001385944670000047
wherein q isvr∈R3Is defined as:
Figure BDA0001385944670000048
wherein ∈ is a small constant, | ∈ | is the absolute value of ∈;
Figure BDA0001385944670000049
is qvjA derivative of (a);
then, it is obtained from formula (7), formula (10) and formula (12):
Figure BDA00013859446700000410
wherein,
Figure BDA00013859446700000411
step 3, designing an improved power approximation law, wherein the process is as follows:
3.1 define the improved power approximation law as:
Figure BDA0001385944670000051
Figure BDA0001385944670000052
wherein theta is more than 0 and less than 1; k is more than 0; mu is more than 0 and less than 1;
Figure BDA0001385944670000053
sign(s) is a sign function; sjJ is 1,2,3 is the j-th element in the s-vector; | sjL is sjJ is the absolute value of 1,2, 3; s is the norm of s;
step 4, designing a finite time self-adaptive sliding mode controller, and the process is as follows:
4.1 consider that the finite time adaptive sliding mode controller is designed to:
Figure BDA0001385944670000054
Figure BDA0001385944670000055
wherein, P is the range of PCounting; f is the norm of F; the | | | Ps | | | is the norm of Ps;
Figure BDA0001385944670000056
is gamma0(ii) an estimate of (d);
4.2 design update law of adaptive parameters:
Figure BDA0001385944670000057
wherein, c0And0is a normal number;
4.3 design Lyapunov function:
Figure BDA0001385944670000058
wherein,
Figure BDA0001385944670000059
sTis the transpose of s;
the derivation is performed on equation (20) and is obtained according to equation (8):
Figure BDA0001385944670000061
for any normal number
Figure BDA0001385944670000062
The following inequalities exist:
Figure BDA0001385944670000063
thus, formula (21) is expressed as:
Figure BDA0001385944670000064
wherein, according to formula (9), the following is obtained:
Figure BDA0001385944670000065
according to
Figure BDA0001385944670000066
And
Figure BDA0001385944670000067
obtaining:
Figure BDA0001385944670000068
due to the presence of the following inequality:
Figure BDA0001385944670000069
therefore, from equations (25) and (26), it follows:
Figure BDA0001385944670000071
wherein,
Figure BDA0001385944670000072
the sliding mode surface is limited in time and finally bounded as obtained by the formula (27); thus, the convergence field Δ s is expressed as:
Figure BDA0001385944670000073
the slip form (10) is expressed as:
Figure BDA0001385944670000074
wherein, ηjIs a normal number, satisfies | ηj|≤Δs;
Then, equation (29) is written in two forms:
Figure BDA0001385944670000075
or
Figure BDA0001385944670000076
From formula (30) or formula (31), if
Figure BDA0001385944670000077
Or
Figure BDA0001385944670000078
The sliding mode surface of the formula (30) or the formula (31) has a similar structure to that of the formula (10), and therefore, the posture quaternion q is obtainedvjCan converge to the following region within a limited time:
Figure BDA0001385944670000081
Figure BDA0001385944670000082
from the equations (32) and (33), the attitude quaternion q is obtainedvjThe finite time convergence domain of (c) is:
Figure BDA0001385944670000083
is obtained from formula (29)
Figure BDA0001385944670000084
Can converge to:
Figure BDA0001385944670000085
according to
Figure BDA0001385944670000086
Obtained by the formula (2)
Figure BDA0001385944670000087
Wherein | ω | purpleAnd
Figure BDA0001385944670000088
are respectively omega and
Figure BDA0001385944670000089
infinite norm of (d); at the same time, the user can select the desired position,
Figure BDA00013859446700000810
the time required for the operation of the device to be carried out is limited,
Figure BDA00013859446700000811
therefore, consider equation (5) and the assumption
Figure BDA00013859446700000812
Where det (T) is the determinant of T, the following are obtained:
Figure BDA00013859446700000813
wherein, ω isjJ is 1,2,3 is the jth element of the ω vector;
based on the analysis, the sliding mode surface s and the attitude quaternion q of the aircraftvjAnd angular velocity ωjIs locally finite time consistent and finally bounded.
The method is based on the aircraft finite time self-adaptive attitude control method of the improved power approximation law under the factors of the uncertainty of the rotation inertia matrix and the external interference, realizes the stable control of the system, reduces buffeting of sliding mode control, and ensures that the system realizes the consistency of finite time and is bounded finally.
The technical conception of the invention is as follows: aiming at an aircraft control system containing the uncertainty of a rotation inertia matrix and external interference, a finite-time self-adaptive attitude control method of an aircraft based on an improved power approach law is designed by combining a sliding mode control method of the improved power approach law and self-adaptive control. The sliding mode surface design based on the improved power approximation law is to ensure that a system can stably converge to the neighborhood of an original point in limited time, and the buffeting is reduced by improving the power approximation law. In addition, the self-adaptive control can intelligently adjust the feedback control system of the self characteristics according to the environmental change so that the system can work in the optimal state according to some set standards. The invention provides a method which can reduce the buffeting problem of a sliding mode surface and a control moment, and realize the consistency of limited time of a system and final bounding under the condition that the system has uncertainty and interference.
The invention has the beneficial effects that: and buffeting is reduced, and the finite time consistency of the system is realized and finally bounded under the condition that uncertainty and interference exist in the system.
Drawings
Fig. 1 is a schematic diagram of a sliding mode surface based on different approaches of the present invention, wherein (a) represents method one, (b) represents method two, and (c) represents method three.
Fig. 2 is a schematic diagram of control torque based on different approach laws, wherein (a) represents method one, (b) represents method two, and (c) represents method three.
Fig. 3 is a diagram showing quaternion of aircraft attitude based on different approaches according to the present invention, wherein (a) shows method one, (b) shows method two, and (c) shows method three.
Fig. 4 is a schematic diagram of angular velocities based on different approach laws according to the present invention, wherein (a) represents method one, (b) represents method two, and (c) represents method three.
Fig. 5 is a schematic diagram of parameter estimation based on different approaches according to the present invention, in which (a) represents method one, (b) represents method two, and (c) represents method three.
FIG. 6 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-6, an aircraft finite time adaptive attitude control method based on an improved power approach law includes the following steps:
step 1, establishing a kinematics and dynamics model of an aircraft attitude control system, initializing system states and control parameters, and carrying out the following processes:
1.1 the dynamic model expression form of the aircraft attitude control system is as follows:
Figure BDA0001385944670000101
wherein the sum of the values of ω,
Figure BDA0001385944670000102
angular velocity and angular acceleration of the aircraft, respectively, × is an operator applying the operator × to a ═ a1,a2,a3]TCan obtain a×=[0,-a3,a2;a3,0,-a1;-a2,a1,0];J∈R3×3Is the rotational inertia matrix of the aircraft u ∈ R3And d (t) ∈ R3Control moment and external disturbance;
1.2 the representation form of the kinematics model of the aircraft attitude control system is as follows:
Figure BDA0001385944670000103
Figure BDA0001385944670000104
wherein the unit quaternion
Figure BDA0001385944670000105
Describing the attitude of an aircraft and satisfying
Figure BDA0001385944670000106
Are each q0And q isvDerivative of I ∈ R3×3Is a 3 × 3 identity matrix;
1.3 suppose the rotational inertia matrix J ═ J0+ Δ J, wherein J0And Δ J represent the nominal and indeterminate portions of J, respectively, then equation (1) is rewritten as:
Figure BDA0001385944670000107
1.4 toThe design of the attitude dynamics controller of the aircraft is described more conveniently
Figure BDA0001385944670000108
Substituting formula (2) to obtain:
Figure BDA0001385944670000109
wherein,
Figure BDA00013859446700001010
differentiating equation (5) yields:
Figure BDA00013859446700001011
wherein,
Figure BDA0001385944670000111
are respectively P and qvFirst and second derivatives of;
after the formula (5) and the formula (6) are substituted into the formula (4), P is simultaneously multiplied on two sides of the formulaTObtaining:
Figure BDA0001385944670000112
wherein, J*=PTJ0P and inertia matrix J due to rotation*Is a skew symmetric positive definite matrix, then the matrix
Figure BDA0001385944670000113
Satisfying the following oblique symmetry relationship:
Figure BDA0001385944670000114
at the same time J*The following inequalities are satisfied:
Figure BDA0001385944670000115
Jminand JmaxIs a normal number and represents J*Lower and upper bounds of (1);
Figure BDA0001385944670000116
Figure BDA0001385944670000117
is a set of interference and uncertainty, satisfying | | Td||≤γ0Φ,Φ=1+||ω||+||ω||2And gamma is0Is a normal number;
step 2, under the condition that the moment of inertia is uncertain and external disturbance exists, designing a required sliding mode surface based on an attitude control system of the aircraft, wherein the process is as follows:
2.1 selection of slip form surface s ∈ R3Comprises the following steps:
Figure BDA0001385944670000118
wherein α and β are normal numbers;
Figure BDA0001385944670000119
r1and r2Is a positive odd number and 0<r1<r2(ii) a Function sig (q)v)rIs defined as sig (q)v)r=[|qv1|rsign(qv1),|qv2|rsign(qv2),|qv3|rsign(qv3)]T
Derivation of equation (10) yields:
Figure BDA00013859446700001110
wherein,
Figure BDA00013859446700001111
is the derivative of s; | qvL is qvAbsolute value of (d);
Figure BDA00013859446700001112
if q isvj0, j is 1,2,3 and
Figure BDA0001385944670000121
wherein q isvjJ is 1,2,3 is qvThe jth element in the vector; to avoid the occurrence of singularities, which arise due to the presence of the negative fractional power r-1, the first derivative of s is changed to:
Figure BDA0001385944670000122
wherein q isvr∈R3Is defined as:
Figure BDA0001385944670000123
wherein ∈ is a small constant, | ∈ | is the absolute value of ∈;
Figure BDA0001385944670000124
is qvjA derivative of (a);
then, it is obtained from formula (7), formula (10) and formula (12):
Figure BDA0001385944670000125
wherein,
Figure BDA0001385944670000126
step 3, designing an improved power approximation law, wherein the process is as follows:
3.1 define the improved power approximation law as:
Figure BDA0001385944670000127
Figure BDA0001385944670000128
wherein theta is more than 0 and less than 1; k is more than 0; mu is more than 0 and less than 1;
Figure BDA0001385944670000129
sign(s) is a sign function; sjJ is 1,2,3 is the j-th element in the s-vector; | sjL is sjJ is the absolute value of 1,2, 3; s is the norm of s;
step 4, designing a finite time self-adaptive sliding mode controller, and the process is as follows:
4.1 consider that the finite time adaptive sliding mode controller is designed to:
Figure BDA0001385944670000131
Figure BDA0001385944670000132
wherein, P is the norm of P; f is the norm of F; the | | | Ps | | | is the norm of Ps;
Figure BDA0001385944670000133
is gamma0(ii) an estimate of (d);
4.2 design update law of adaptive parameters:
Figure BDA0001385944670000134
wherein, c0And0is a normal number;
4.3 design Lyapunov function:
Figure BDA0001385944670000135
wherein,
Figure BDA0001385944670000136
sTis the transpose of s;
the derivation is performed on equation (20) and is obtained according to equation (8):
Figure BDA0001385944670000137
for any normal number
Figure BDA0001385944670000138
The following inequalities exist:
Figure BDA0001385944670000139
thus, formula (21) is expressed as:
Figure BDA0001385944670000141
wherein, according to formula (9), the following is obtained:
Figure BDA0001385944670000142
according to
Figure BDA0001385944670000143
And
Figure BDA0001385944670000144
obtaining:
Figure BDA0001385944670000145
due to the presence of the following inequality:
Figure BDA0001385944670000146
therefore, from equations (25) and (26), it follows:
Figure BDA0001385944670000147
wherein,
Figure BDA0001385944670000148
the sliding mode surface is limited in time and finally bounded as obtained by the formula (27); thus, the convergence field Δ s is expressed as:
Figure BDA0001385944670000149
the slip form (10) is expressed as:
Figure BDA00013859446700001410
wherein, ηjIs a normal number, satisfies | ηj|≤Δs;
Then, equation (29) is written in two forms:
Figure BDA0001385944670000151
or
Figure BDA0001385944670000152
From formula (30) or formula (31), if
Figure BDA0001385944670000153
Or
Figure BDA0001385944670000154
The sliding mode surface of the formula (30) or the formula (31) has a similar structure to that of the formula (10), and therefore, the posture quaternion q is obtainedvjCan converge to the following region within a limited time:
Figure BDA0001385944670000155
Figure BDA0001385944670000156
is represented by formula (32) and formula(33) Obtaining the attitude quaternion qvjThe finite time convergence domain of (c) is:
Figure BDA0001385944670000157
is obtained from formula (29)
Figure BDA0001385944670000158
Can converge to:
Figure BDA0001385944670000159
according to
Figure BDA0001385944670000161
Obtained by the formula (2)
Figure BDA0001385944670000162
Wherein | ω | purpleAnd
Figure BDA0001385944670000163
are respectively omega and
Figure BDA0001385944670000164
infinite norm of (d); at the same time, the user can select the desired position,
Figure BDA0001385944670000165
the time required for the operation of the device to be carried out is limited,
Figure BDA0001385944670000166
therefore, consider equation (5) and the assumption
Figure BDA0001385944670000167
Where det (T) is the determinant of T, the following are obtained:
Figure BDA0001385944670000168
wherein, ω isjJ is 1,2,3 is the jth element of the ω vector;
based on the analysis, the sliding mode surface s and the attitude quaternion q of the aircraftvjAnd angular velocity ωjIs locally finite time consistent and finally bounded.
In order to verify the effectiveness of the proposed method, the invention provides three different methods for simulation comparison, as follows:
the method comprises the following steps: the finite time self-adaptive attitude control method based on the improved power approximation law comprises the following steps that (1) an approximation law expression is expressed as an expression (15) and an expression (16);
the second method comprises the following steps: the finite time self-adaptive attitude control method based on the exponential approximation law comprises the following expression:
Figure BDA0001385944670000169
the third method comprises the following steps: a finite time self-adaptive attitude control method based on a traditional approach law has the following expression:
Figure BDA00013859446700001610
for more efficient comparison, all parameters of the system are identical, i.e. the parameters of equations (14) and (15) are the same as equations (37) and (38), where K is 0.5, μ is 0.01, θ is 0.1,
Figure BDA00013859446700001611
Figure BDA00013859446700001612
and given system external disturbances d (t) 0.005 × sin (0.8t), cos (0.5t), cos (0.3t)]TN.m, sliding mode parameters of α -0.1, β -0.1 and r1=3,r2(ii) 5; the parameters of the adaptive update law are:0=0.01,
Figure BDA0001385944670000171
the actual parameters of the aircraft attitude system are as follows: j. the design is a square0=diag([140,120,130])kg·m2,ΔJ=diag[sin(0.1t),2sin(0.2t),3sin(0.3t)]kg·m2,ω(0)=[0,0,0]Trad/s,qv(0)=[0.3,-0.3,0.2]T,q0(0) 0.8832; the parameters in equation (24) are: j. the design is a squaremax=560,01 is ═ 1; to avoid discontinuities of equation (18)
Figure BDA0001385944670000172
The resulting buffeting problem, applying a continuous term in the simulation
Figure BDA0001385944670000173
Alternatively, where ξ is a normal number, ξ ═ 0.0002.
Fig. 1 and 2 are schematic diagrams of the glide mode surface and the control moment response respectively based on different approach laws. If D(s) tends to 0.01 as | | s | | is larger, the expression (15) and the expression (37) are
Figure BDA0001385944670000174
Is 50, and is larger than K of formula (38) of 0.5. On the contrary, when s is less,
Figure BDA0001385944670000175
tending towards 0.5. This phenomenon causes the controller gain to vary in the range of 50 to 0.5. As shown in fig. 1 and 2, the convergence time of the sliding surfaces based on method one and method two is about 1.2 seconds, while the convergence time of the sliding surfaces based on method three is about 4.2 seconds. Obviously, the method I and the method II are superior to the method III, and the aircraft attitude system can have higher stability performance and shorter convergence time. In addition, | s in the formula (15)j|θThe existence of the first method, the second method and the third method can effectively reduce the buffeting problem.
The aircraft attitude quaternion and angular velocity response diagrams based on different approximation laws are shown in fig. 3 and fig. 4 respectively. The results show that all three methods can achieve finite time consistency and final bounding. The convergence time of the aircraft attitude quaternion based on method one and method two is about 10 seconds, which is 2 seconds faster than method three. Furthermore, the convergence time of the aircraft angular velocity based on method one and method two is about 11 seconds, which is approximately 3 seconds faster than method three. Through the above analysis, the convergence rate of the attitude quaternion and the angular velocity based on the first method and the second method is faster than the convergence rate of the attitude quaternion and the angular velocity based on the third method. A diagram of the response of parameter estimation based on different approach laws is shown in fig. 5. Referring to fig. 1-5, the method of the present invention achieves better control performance than the other two methods.
In summary, compared with the second method and the third method, the first method can achieve good control performance, and has better capability of reducing buffeting on the sliding mode surface and the control moment.
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. An aircraft finite time self-adaptive attitude control method based on an improved power approach law is characterized by comprising the following steps: the control method comprises the following steps:
step 1, establishing a kinematics and dynamics model of an aircraft attitude control system, initializing system states and control parameters, and carrying out the following processes:
1.1 the dynamic model expression form of the aircraft attitude control system is as follows:
Figure FDA0002512997700000011
wherein the sum of the values of ω,
Figure FDA0002512997700000012
angular velocity and angular acceleration of the aircraft, respectively, × is an operator applying the operator × to a ═ a1,a2,a3]TCan obtain a×=[0,-a3,a2;a3,0,-a1;-a2,a1,0];J∈R3×3Is the rotational inertia matrix of the aircraft; u. of∈R3And d (t) ∈ R3Control moment and external disturbance;
1.2 the kinematic model expression form of the aircraft attitude control system is as follows:
Figure FDA0002512997700000013
Figure FDA0002512997700000014
wherein the unit quaternion
Figure FDA0002512997700000015
Describing the attitude of an aircraft and satisfying
Figure FDA0002512997700000016
Figure FDA0002512997700000017
Are each q0And q isvA derivative of (a); i is3∈R3×3Is a 3 × 3 identity matrix;
1.3 suppose the rotational inertia matrix J ═ J0+ Δ J, wherein J0And Δ J represent the nominal and indeterminate portions of J, respectively, equation (1) is rewritten as:
Figure FDA0002512997700000018
1.4 to more easily describe the attitude dynamics controller design of an aircraft, let
Figure FDA0002512997700000019
Substituting formula (2) to obtain:
Figure FDA00025129977000000110
wherein,
Figure FDA0002512997700000021
differentiating equation (5) yields:
Figure FDA0002512997700000022
wherein,
Figure FDA0002512997700000023
are respectively P and qvFirst and second derivatives of;
after the formula (5) and the formula (6) are substituted into the formula (4), P is simultaneously multiplied on two sides of the formulaTObtaining:
Figure FDA0002512997700000024
wherein, J*=PTJ0P and inertia matrix J due to rotation*Is a skew symmetric positive definite matrix, then the matrix
Figure FDA0002512997700000025
Satisfying the following oblique symmetry relationship:
Figure FDA0002512997700000026
at the same time J*The following inequalities are satisfied:
Figure FDA0002512997700000027
wherein, JminAnd JmaxIs a normal number and represents J*Lower and upper bounds of (1);
Figure FDA0002512997700000028
Figure FDA0002512997700000029
is a set of interference and uncertainty, satisfying | | Td||≤γ0Φ,Φ=1+||ω||+||ω||2And gamma is0Is a normal number;
step 2, under the condition that the moment of inertia is uncertain and external disturbance exists, designing a required sliding mode surface based on an attitude control system of the aircraft, wherein the process is as follows:
2.1 selection of slip form surface s ∈ R3Comprises the following steps:
Figure FDA00025129977000000210
wherein α and β are normal numbers;
Figure FDA00025129977000000211
r1and r2Is a positive odd number and 0<r1<r2(ii) a Function sig (q)v)rIs defined as sig (q)v)r=[|qv1|rsign(qv1),|qv2|rsign(qv2),|qv3|rsign(qv3)]T
Derivation of equation (10) yields:
Figure FDA0002512997700000031
wherein,
Figure FDA0002512997700000032
is the derivative of s; | qvL is qvAbsolute value of (d); diag (| q)v|r-1)=diag([|qv1|r-1,|qv2|r-1,|qv3|r-1])∈R3×3
If q isvj0, j is 1,2,3 and
Figure FDA0002512997700000033
wherein q isvjJ is 1,2,3 is qvThe jth element in the vector; to avoid the occurrence of singularities, which arise due to the presence of the negative fractional power r-1, the first derivative of s is changed to:
Figure FDA0002512997700000034
wherein q isvr∈R3Is defined as:
Figure FDA0002512997700000035
wherein ∈ is a small constant, | ∈ | is the absolute value of ∈;
Figure FDA0002512997700000036
is qvjA derivative of (a);
then, it is obtained from formula (7), formula (10) and formula (12):
Figure FDA0002512997700000037
wherein,
Figure FDA0002512997700000038
step 3, designing an improved power approximation law, wherein the process is as follows:
3.1 define the improved power approximation law as:
Figure FDA0002512997700000039
Figure FDA00025129977000000310
wherein theta is more than 0 and less than 1; k is more than 0; mu is more than 0 and less than 1;
Figure FDA0002512997700000041
sign(s) is an s-sign function; sjJ is 1,2,3 is the j-th element in the s-vector; | sjL is sjJ is the absolute value of 1,2, 3; s is the norm of s;
step 4, designing a finite time self-adaptive sliding mode controller, and the process is as follows:
4.1 consider that the finite time adaptive sliding mode controller is designed to:
Figure FDA0002512997700000042
Figure FDA0002512997700000043
wherein, P is the norm of P; f is the norm of F; the | | | Ps | | | is the norm of Ps;
Figure FDA0002512997700000044
is gamma0(ii) an estimate of (d);
4.2 design update law of adaptive parameters:
Figure FDA0002512997700000045
wherein, c0And0is a normal number;
Figure FDA0002512997700000046
is composed of
Figure FDA0002512997700000047
A derivative of (a);
4.3 design Lyapunov function:
Figure FDA0002512997700000048
wherein,
Figure FDA0002512997700000049
sTis the transpose of s;
the derivation is performed on equation (20) and is obtained according to equation (8):
Figure FDA00025129977000000410
for any normal number
Figure FDA0002512997700000051
The following inequalities exist:
Figure FDA0002512997700000052
thus, formula (21) is expressed as:
Figure FDA0002512997700000053
wherein, according to formula (9), the following is obtained:
Figure FDA0002512997700000054
according to
Figure FDA0002512997700000055
And
Figure FDA0002512997700000056
obtaining:
Figure FDA0002512997700000057
due to the presence of the following inequality:
Figure FDA0002512997700000058
therefore, from equations (25) and (26), it follows:
Figure FDA0002512997700000059
wherein,
Figure FDA00025129977000000510
the sliding mode surface is limited in time and finally bounded as obtained by the formula (27); thus, the convergence field Δ s is expressed as:
Figure FDA0002512997700000061
the slip form (10) is expressed as:
Figure FDA0002512997700000062
wherein, ηjIs a normal number, satisfies | ηj|≤Δs;
Then, equation (29) is written in two forms:
Figure FDA0002512997700000063
or
Figure FDA0002512997700000064
From formula (30) or formula (31), if
Figure FDA0002512997700000065
Or
Figure FDA0002512997700000066
The sliding mode surface of the formula (30) or the formula (31) has a similar structure to that of the formula (10), and therefore, the posture quaternion q is obtainedvjCan converge to the following region within a limited time:
Figure FDA0002512997700000067
Figure FDA0002512997700000068
from the equations (32) and (33), the attitude quaternion q is obtainedvjThe finite time convergence domain of (c) is:
Figure FDA0002512997700000071
is obtained from formula (29)
Figure FDA0002512997700000072
Can converge to:
Figure FDA0002512997700000073
according to
Figure FDA0002512997700000074
Obtained by the formula (2)
Figure FDA0002512997700000075
Wherein | ω | purpleAnd
Figure FDA0002512997700000076
are respectively omega and
Figure FDA0002512997700000077
infinite norm of (d); at the same time, the user can select the desired position,
Figure FDA0002512997700000078
the time required for the operation of the device to be carried out is limited,
Figure FDA0002512997700000079
therefore, consider equation (5) and the assumption
Figure FDA00025129977000000710
Where det (T) is the determinant of T, the following are obtained:
Figure FDA00025129977000000711
wherein, ω isjJ is 1,2,3 is the jth element of the ω vector;
based on the analysis, the sliding mode surface s and the attitude quaternion q of the aircraftvjAnd angular velocity ωjIs locally finite time consistent and finally bounded.
CN201710725614.XA 2017-08-22 2017-08-22 Aircraft finite time self-adaptive attitude control method based on improved power approach law Active CN107490966B (en)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201710725614.XA CN107490966B (en) 2017-08-22 2017-08-22 Aircraft finite time self-adaptive attitude control method based on improved power approach law

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201710725614.XA CN107490966B (en) 2017-08-22 2017-08-22 Aircraft finite time self-adaptive attitude control method based on improved power approach law

Publications (2)

Publication Number Publication Date
CN107490966A CN107490966A (en) 2017-12-19
CN107490966B true CN107490966B (en) 2020-08-04

Family

ID=60645854

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201710725614.XA Active CN107490966B (en) 2017-08-22 2017-08-22 Aircraft finite time self-adaptive attitude control method based on improved power approach law

Country Status (1)

Country Link
CN (1) CN107490966B (en)

Families Citing this family (28)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108363298A (en) * 2018-01-17 2018-08-03 合肥工业大学 A kind of quadrotor drone Fast Convergent control method based on quaternion representation
CN108181920B (en) * 2018-01-31 2021-08-31 天津大学 High-precision attitude tracking control method for quad-rotor unmanned aerial vehicle based on given time
CN108490783B (en) * 2018-04-12 2020-02-21 浙江工业大学 Rigid aerospace vehicle finite time self-adaptive fault-tolerant control method based on enhanced double-power approach law and fast terminal sliding mode surface
CN108549224B (en) * 2018-04-12 2020-02-21 浙江工业大学 Rigid aerospace vehicle finite time self-adaptive fault-tolerant control method based on enhanced double-power approach law and terminal sliding mode surface
CN108762065B (en) * 2018-04-12 2020-02-21 浙江工业大学 Rigid aerospace vehicle finite time self-adaptive fault-tolerant control method based on enhanced exponential approach law and fast terminal sliding mode surface
CN108549225B (en) * 2018-04-12 2020-02-21 浙江工业大学 Rigid aerospace vehicle finite time self-adaptive fault-tolerant control method based on enhanced power-order approach law and fast terminal sliding mode surface
CN108828936B (en) * 2018-05-28 2021-06-18 浙江工业大学 Finite time control method of four-rotor aircraft based on arc tangent enhanced constant velocity approach law and fast terminal sliding mode surface
CN108845586B (en) * 2018-05-28 2021-08-03 浙江工业大学 Finite time control method of four-rotor aircraft based on hyperbolic sine enhanced constant-speed approach law and fast terminal sliding mode surface
CN108829120B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on arc tangent enhanced power approach law and fast terminal sliding mode surface
CN108563126B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on hyperbolic sine enhanced power approximation law and fast terminal sliding mode surface
CN108828938B (en) * 2018-05-28 2021-06-18 浙江工业大学 Finite time control method of four-rotor aircraft based on inverse proportion function enhanced index approach law and fast terminal sliding mode surface
CN108829119B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on hyperbolic tangent enhanced power approach law and fast terminal sliding mode surface
CN108628332B (en) * 2018-05-28 2021-08-03 浙江工业大学 Finite time control method of four-rotor aircraft based on arc tangent enhanced index approach law and fast terminal sliding mode surface
CN108776485B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on arc tangent enhanced fast power approach law and fast terminal sliding mode surface
CN108829117B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on logarithm enhancement type power approach law and fast terminal sliding mode surface
CN108828937B (en) * 2018-05-28 2021-08-03 浙江工业大学 Finite time control method of four-rotor aircraft based on exponential enhancement type exponential approaching law and fast terminal sliding mode surface
CN108563127B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on hyperbolic sine enhanced fast power approach law and fast terminal sliding mode surface
CN108549401B (en) * 2018-05-28 2021-02-26 浙江工业大学 Finite time control method of four-rotor aircraft based on hyperbolic sine enhanced index approach law and fast terminal sliding mode surface
CN108829128B (en) * 2018-05-28 2021-08-03 浙江工业大学 Four-rotor aircraft finite time control method based on logarithm enhancement type exponential approaching law and fast terminal sliding mode surface
CN108803638B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on hyperbolic tangent enhanced rapid power approach law and rapid terminal sliding mode surface
CN108762075B (en) * 2018-05-28 2021-06-18 浙江工业大学 Four-rotor aircraft finite time control method based on logarithm enhanced constant-speed approach law and fast terminal sliding mode surface
CN108829118B (en) * 2018-05-28 2021-08-03 浙江工业大学 Four-rotor aircraft self-adaptive control method based on inverse proportional function enhanced power approach law and fast terminal sliding mode surface
CN108563128B (en) * 2018-05-28 2021-08-03 浙江工业大学 Self-adaptive control method of four-rotor aircraft based on exponential enhancement type rapid power approximation law and rapid terminal sliding mode surface
CN108803320B (en) * 2018-05-28 2021-06-18 浙江工业大学 Finite time control method of four-rotor aircraft based on exponential enhancement type constant velocity approach law and rapid terminal sliding mode surface
CN108829127B (en) * 2018-05-28 2021-06-18 浙江工业大学 Finite time control method of four-rotor aircraft based on hyperbolic tangent enhanced constant velocity approach law and fast terminal sliding mode surface
CN109188908B (en) * 2018-09-25 2021-02-26 浙江工业大学 Digital controller design method based on exponential type non-switching attraction law
CN110032205B (en) * 2019-04-29 2021-09-28 河海大学常州校区 Unmanned aerial vehicle attitude control method with anti-jamming capability
CN112290843B (en) * 2020-10-16 2022-02-18 郑州大学 Variable exponential power approach law and PMSM control application thereof

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101937233A (en) * 2010-08-10 2011-01-05 南京航空航天大学 Nonlinear self-adaption control method of near-space hypersonic vehicle
CN102566420A (en) * 2012-03-01 2012-07-11 北京航空航天大学 Sliding mode control method for VTOL (Vertical Take Off And Landing) aircraft
CN105911866A (en) * 2016-06-15 2016-08-31 浙江工业大学 Finite time full-order sliding mode control method of four-rotor unmanned aerial vehicle
CN106444799A (en) * 2016-07-15 2017-02-22 浙江工业大学 Four-rotor unmanned aerial vehicle control method based on fuzzy extended state observer and self-adaptive sliding mode
US9715234B2 (en) * 2015-11-30 2017-07-25 Metal Industries Research & Development Centre Multiple rotors aircraft and control method

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN101937233A (en) * 2010-08-10 2011-01-05 南京航空航天大学 Nonlinear self-adaption control method of near-space hypersonic vehicle
CN102566420A (en) * 2012-03-01 2012-07-11 北京航空航天大学 Sliding mode control method for VTOL (Vertical Take Off And Landing) aircraft
US9715234B2 (en) * 2015-11-30 2017-07-25 Metal Industries Research & Development Centre Multiple rotors aircraft and control method
CN105911866A (en) * 2016-06-15 2016-08-31 浙江工业大学 Finite time full-order sliding mode control method of four-rotor unmanned aerial vehicle
CN106444799A (en) * 2016-07-15 2017-02-22 浙江工业大学 Four-rotor unmanned aerial vehicle control method based on fuzzy extended state observer and self-adaptive sliding mode

Non-Patent Citations (4)

* Cited by examiner, † Cited by third party
Title
Practical MPC Solution to Attitude Control Independent of Angular;Y K Wang, Z X Liu, M W Sun, Z H Wang, Z Q Chen;《2017 13th IEEE International Conference on Control & Automation》;20170706;第630-635页 *
一种多幂次滑模趋近律设计与分析;张瑶,马广富,郭延宁,曾添一;《自动化学报》;20160331;第42卷(第3期);第466-472页 *
四旋翼飞行器的自适应鲁棒滑模控制器设计;林旭梅,王婵;《仪器仪表学报》;20150731;第36卷(第7期);第1522-1528页 *
小型四旋翼无人机建模与有限时间控制;廖卫中,宗群,马亚丽;《控制理论与应用》;20151031;第32卷(第10期);第1343-1350页 *

Also Published As

Publication number Publication date
CN107490966A (en) 2017-12-19

Similar Documents

Publication Publication Date Title
CN107490966B (en) Aircraft finite time self-adaptive attitude control method based on improved power approach law
CN107577144B (en) Aircraft finite time self-adaptive attitude control method based on enhanced exponential approximation law
CN107703952B (en) Nonsingular fixed time self-adaptive attitude control method for rigid aircraft
CN107450584B (en) Aircraft self-adaptive attitude control method based on fixed time sliding mode
CN106774373B (en) A kind of quadrotor drone finite time Attitude tracking control method
CN106444799B (en) Four-rotor unmanned aerial vehicle control method based on fuzzy extended state observer and self-adaptive sliding mode
CN108490783B (en) Rigid aerospace vehicle finite time self-adaptive fault-tolerant control method based on enhanced double-power approach law and fast terminal sliding mode surface
CN107491081B (en) Anti-interference four-rotor unmanned aerial vehicle attitude control method
Li et al. Robust tracking control strategy for a quadrotor using RPD-SMC and RISE
He et al. A Simple Attitude Control of Quadrotor Helicopter Based on Ziegler‐Nichols Rules for Tuning PD Parameters
CN104865968A (en) Quad-rotor aircraft hovering control method employing cascade auto disturbances rejection control technology
Lee Geometric controls for a tethered quadrotor UAV
CN110488603B (en) Rigid aircraft adaptive neural network tracking control method considering actuator limitation problem
CN109062240B (en) Rigid aircraft fixed time self-adaptive attitude tracking control method based on neural network estimation
ud Din et al. Robust control of underactuated systems: Higher order integral sliding mode approach
CN109188910B (en) Adaptive neural network fault-tolerant tracking control method of rigid aircraft
CN109164823A (en) A kind of nonsingular set time Attitude tracking control method of rigid-body spacecraft considering actuator constraints problem
Liu et al. Antisaturation fixed-time attitude tracking control based low-computation learning for uncertain quadrotor UAVs with external disturbances
Suhail et al. Altitude and attitude control of a quadcopter using linear active disturbance rejection control
CN114019997B (en) Finite time control method under position tracking deviation constraint of fixed wing unmanned aerial vehicle
Zhou et al. Adaptive tracking control of quadrotor UAV system with input constraints
CN106842953A (en) A kind of depopulated helicopter self adaptation lower order controller
CN111752157B (en) Second-order sliding mode control method for finite time convergence
CN108762065B (en) Rigid aerospace vehicle finite time self-adaptive fault-tolerant control method based on enhanced exponential approach law and fast terminal sliding mode surface
CN108549224B (en) Rigid aerospace vehicle finite time self-adaptive fault-tolerant control method based on enhanced double-power approach law and 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