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 PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 90
- 238000013459 approach Methods 0.000 title claims description 16
- 238000013461 design Methods 0.000 claims abstract description 14
- 230000003044 adaptive effect Effects 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims description 21
- 230000008569 process Effects 0.000 claims description 13
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 6
- 238000009795 derivation Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000007613 environmental effect Effects 0.000 abstract description 3
- 238000010586 diagram Methods 0.000 description 9
- 230000004044 response Effects 0.000 description 5
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 3
- 230000008901 benefit Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive 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/042—Adaptive 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
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:
1.1 the dynamic model expression form of the aircraft attitude control system is as follows:
wherein,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:
wherein the unit quaternionDescribing the attitude of an aircraft and satisfyingAre 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:
1.4 to more easily describe the attitude dynamics controller design of an aircraft, letSubstituting formula (2) to obtain:
differentiating equation (5) yields:
after the formula (5) and the formula (6) are substituted into the formula (4), P is simultaneously multiplied on two sides of the formulaTObtaining:
wherein, J*=PTJ0P and inertia matrix J due to rotation*Is a skew symmetric positive definite matrix, then the matrixSatisfying the following oblique symmetry relationship:
at the same time J*The following inequalities are satisfied:
Jminand JmaxIs a normal number and represents J*Lower and upper bounds of (1); is a set of interference and uncertainty, satisfying | | Td||≤γ0Φ,Φ=1+||ω||+||ω||2And gamma is0Is a normal number;
2.1 selection of slip form surface s ∈ R3Comprises the following steps:
wherein α and β are normal numbers;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:
if q isvj0, j is 1,2,3 andwherein 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:
wherein q isvr∈R3Is defined as:
then, it is obtained from formula (7), formula (10) and formula (12):
3.1 define the improved power approximation law as:
wherein theta is more than 0 and less than 1; k is more than 0; mu is more than 0 and less than 1;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:
wherein, P is the range of PCounting; f is the norm of F; the | | | Ps | | | is the norm of Ps;is gamma0(ii) an estimate of (d);
4.2 design update law of adaptive parameters:
wherein, c0And0is a normal number;
4.3 design Lyapunov function:
the derivation is performed on equation (20) and is obtained according to equation (8):
thus, formula (21) is expressed as:
wherein, according to formula (9), the following is obtained:
due to the presence of the following inequality:
therefore, from equations (25) and (26), it follows:
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:
the slip form (10) is expressed as:
wherein, ηjIs a normal number, satisfies | ηj|≤Δs;
Then, equation (29) is written in two forms:
or
From formula (30) or formula (31), ifOrThe 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:
from the equations (32) and (33), the attitude quaternion q is obtainedvjThe finite time convergence domain of (c) is:
according toObtained by the formula (2)Wherein | ω | purple∞Andare respectively omega andinfinite norm of (d); at the same time, the user can select the desired position,the time required for the operation of the device to be carried out is limited,therefore, consider equation (5) and the assumptionWhere det (T) is the determinant of T, the following are obtained:
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:
1.1 the dynamic model expression form of the aircraft attitude control system is as follows:
wherein the sum of the values of ω,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:
wherein the unit quaternionDescribing the attitude of an aircraft and satisfyingAre 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:
1.4 toThe design of the attitude dynamics controller of the aircraft is described more convenientlySubstituting formula (2) to obtain:
differentiating equation (5) yields:
after the formula (5) and the formula (6) are substituted into the formula (4), P is simultaneously multiplied on two sides of the formulaTObtaining:
wherein, J*=PTJ0P and inertia matrix J due to rotation*Is a skew symmetric positive definite matrix, then the matrixSatisfying the following oblique symmetry relationship:
at the same time J*The following inequalities are satisfied:
Jminand JmaxIs a normal number and represents J*Lower and upper bounds of (1); is a set of interference and uncertainty, satisfying | | Td||≤γ0Φ,Φ=1+||ω||+||ω||2And gamma is0Is a normal number;
2.1 selection of slip form surface s ∈ R3Comprises the following steps:
wherein α and β are normal numbers;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:
if q isvj0, j is 1,2,3 andwherein 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:
wherein q isvr∈R3Is defined as:
then, it is obtained from formula (7), formula (10) and formula (12):
3.1 define the improved power approximation law as:
wherein theta is more than 0 and less than 1; k is more than 0; mu is more than 0 and less than 1;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:
wherein, P is the norm of P; f is the norm of F; the | | | Ps | | | is the norm of Ps;is gamma0(ii) an estimate of (d);
4.2 design update law of adaptive parameters:
wherein, c0And0is a normal number;
4.3 design Lyapunov function:
the derivation is performed on equation (20) and is obtained according to equation (8):
thus, formula (21) is expressed as:
wherein, according to formula (9), the following is obtained:
due to the presence of the following inequality:
therefore, from equations (25) and (26), it follows:
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:
the slip form (10) is expressed as:
wherein, ηjIs a normal number, satisfies | ηj|≤Δs;
Then, equation (29) is written in two forms:
or
From formula (30) or formula (31), ifOrThe 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:
is represented by formula (32) and formula(33) Obtaining the attitude quaternion qvjThe finite time convergence domain of (c) is:
according toObtained by the formula (2)Wherein | ω | purple∞Andare respectively omega andinfinite norm of (d); at the same time, the user can select the desired position,the time required for the operation of the device to be carried out is limited,therefore, consider equation (5) and the assumptionWhere det (T) is the determinant of T, the following are obtained:
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:
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:
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, 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,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)The resulting buffeting problem, applying a continuous term in the simulationAlternatively, 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) areIs 50, and is larger than K of formula (38) of 0.5. On the contrary, when s is less,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:
wherein the sum of the values of ω,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:
wherein the unit quaternionDescribing the attitude of an aircraft and satisfying 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:
1.4 to more easily describe the attitude dynamics controller design of an aircraft, letSubstituting formula (2) to obtain:
differentiating equation (5) yields:
after the formula (5) and the formula (6) are substituted into the formula (4), P is simultaneously multiplied on two sides of the formulaTObtaining:
wherein, J*=PTJ0P and inertia matrix J due to rotation*Is a skew symmetric positive definite matrix, then the matrixSatisfying the following oblique symmetry relationship:
at the same time J*The following inequalities are satisfied:
wherein, JminAnd JmaxIs a normal number and represents J*Lower and upper bounds of (1); 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:
wherein α and β are normal numbers;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:
wherein,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 andwherein 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:
wherein q isvr∈R3Is defined as:
then, it is obtained from formula (7), formula (10) and formula (12):
step 3, designing an improved power approximation law, wherein the process is as follows:
3.1 define the improved power approximation law as:
wherein theta is more than 0 and less than 1; k is more than 0; mu is more than 0 and less than 1;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:
wherein, P is the norm of P; f is the norm of F; the | | | Ps | | | is the norm of Ps;is gamma0(ii) an estimate of (d);
4.2 design update law of adaptive parameters:
4.3 design Lyapunov function:
the derivation is performed on equation (20) and is obtained according to equation (8):
thus, formula (21) is expressed as:
wherein, according to formula (9), the following is obtained:
due to the presence of the following inequality:
therefore, from equations (25) and (26), it follows:
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:
the slip form (10) is expressed as:
wherein, ηjIs a normal number, satisfies | ηj|≤Δs;
Then, equation (29) is written in two forms:
or
From formula (30) or formula (31), ifOrThe 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:
from the equations (32) and (33), the attitude quaternion q is obtainedvjThe finite time convergence domain of (c) is:
according toObtained by the formula (2)Wherein | ω | purple∞Andare respectively omega andinfinite norm of (d); at the same time, the user can select the desired position,the time required for the operation of the device to be carried out is limited,therefore, consider equation (5) and the assumptionWhere det (T) is the determinant of T, the following are obtained:
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.
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)
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)
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 |
-
2017
- 2017-08-22 CN CN201710725614.XA patent/CN107490966B/en active Active
Patent Citations (5)
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)
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 |