CN111290421A - Hypersonic aircraft attitude control method considering input saturation - Google Patents
Hypersonic aircraft attitude control method considering input saturation Download PDFInfo
- Publication number
- CN111290421A CN111290421A CN202010201787.3A CN202010201787A CN111290421A CN 111290421 A CN111290421 A CN 111290421A CN 202010201787 A CN202010201787 A CN 202010201787A CN 111290421 A CN111290421 A CN 111290421A
- Authority
- CN
- China
- Prior art keywords
- loop
- attitude
- angular rate
- designed
- aircraft
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000013461 design Methods 0.000 claims abstract description 23
- 238000013178 mathematical model Methods 0.000 claims abstract description 23
- 230000008569 process Effects 0.000 claims abstract description 9
- 230000001052 transient effect Effects 0.000 claims abstract description 8
- 238000004422 calculation algorithm Methods 0.000 claims description 15
- 238000012938 design process Methods 0.000 claims description 7
- 238000006243 chemical reaction Methods 0.000 claims description 6
- 230000014509 gene expression Effects 0.000 claims description 5
- 230000003247 decreasing effect Effects 0.000 claims description 4
- 238000005457 optimization Methods 0.000 abstract 1
- 238000013528 artificial neural network Methods 0.000 description 8
- 238000011160 research Methods 0.000 description 3
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 230000007547 defect Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000003044 adaptive effect Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000012940 design transfer Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000002401 inhibitory effect Effects 0.000 description 1
- 238000013507 mapping Methods 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Abstract
The invention provides a hypersonic aircraft attitude control method considering input saturation, which comprises the following steps of: step 1: considering uncertainty of parameters, unmodeled dynamic state and external disturbance in a mathematical model of the unpowered reentry process of the hypersonic aircraft together as total disturbance, and establishing models of an attitude loop and an angular rate loop; step 2: designing a performance function to constrain the steady-state and transient performances of state variable tracking errors of an attitude loop and an angular rate loop of the aircraft; and step 3: converting the inequality constraint obtained in the step 2 into an equality constraint so as to facilitate the design of the controller; and 4, step 4: designing a linear extended state observer to obtain an output estimation value and a total disturbance estimation value of each loop; and 5: the controller is designed so that the tracking error of the system can converge to a predetermined region in the face of input saturation constraints. The design and parameter optimization of the linear active disturbance rejection controller of the hypersonic aircraft are realized, and the dynamic performance, the robust performance and the anti-interference performance of the hypersonic aircraft are improved.
Description
Technical Field
The invention relates to the technical field of control of hypersonic aircrafts, in particular to a hypersonic aircraft attitude control method considering input saturation.
Background
The hypersonic aircraft is an aircraft with or without wings, such as airplanes, missiles, shells and the like with flight speed of more than five times of sound speed, has important military status and wide civil prospect, and is a research hotspot in the technical field of aircraft control. The hypersonic aircraft has large flying airspace, high speed, long flying distance and high precision requirement, so the structural characteristics, the flying characteristics, the dynamic characteristics and the like of the hypersonic aircraft are more complex than those of a common aircraft.
The strong nonlinearity, strong coupling, fast time variation and uncertain characteristics of the hypersonic aircraft provide greater challenges for the design of a hypersonic aircraft control system. The traditional PID control is widely applied to control of the hypersonic flight vehicle due to simple structure, but the PID controller is poor in robustness and difficult to adapt to the fast time-varying characteristic and high-precision requirement of the hypersonic flight vehicle. Nowadays, some more complex modern control algorithms are also used in the controller design of the hypersonic aircraft to obtain the ideal performance, such as sliding mode variable structure controller, robust adaptive controller, predictive controller, etc. The control algorithm uses certain model information, and the algorithm design process is complex, so that the control algorithm is difficult to be widely applied to flight experiments of hypersonic aircrafts. In addition, most of the existing research methods do not consider the input saturation problem of the hypersonic flight vehicle, and if the problem is not considered explicitly in the design process of the controller, the performance of the controller is reduced, and even the stability of a closed-loop system is damaged. Meanwhile, due to the nonlinear characteristic of input saturation, the influence of the input saturation is difficult to overcome through a traditional linear control algorithm, so that the design of a high-performance feedback controller for a high-speed-of-sound aircraft with input saturation is a very challenging task.
In the design process of a controller of a practical system, the state quantity is expected to converge to the expected track at a faster speed (such as an exponential speed); the state quantity can not generate too high overshoot in the convergence process; furthermore, during steady state, the state quantities should remain bounded at all times under the influence of disturbances. Therefore, if the boundary of the convergence trajectory of the state quantity can be reasonably designed, and the controller is designed to ensure that the state quantity strictly converges within the boundary, the performance of the system state in the transient state and the steady state can be ensured, and the preset performance control algorithm is generated at the discretion. The preset performance means that the tracking error is guaranteed to be converged in a preset optional small area, meanwhile, the convergence speed and the overshoot are guaranteed to meet preset conditions, transient and steady-state performance is required to be met simultaneously, and the aim of improving the performance of the system is directly taken. The preset performance control method comprises the steps of firstly constructing an equivalent model by using a performance function and error transformation, and then designing a controller aiming at the equivalent model so as to ensure that the system meets the preset requirements on accuracy, rapidity and stability.
The complicated flight environment of the hypersonic aircraft makes the hypersonic aircraft highly nonlinear and uncertain, and how to realize tracking control on attitude and angular rate under the condition that an aircraft model cannot be accurately known is another serious challenge to the design of the hypersonic aircraft controller. In recent years, due to the self-learning and self-adaptive capabilities of neural networks, the application and research of neural networks in nonlinear systems are increasingly wider. The structural form of the neural network multiple input and multiple output also makes the recognition of the unknown nonlinear part of the controlled object easy to realize. Fuzzy systems are another effective way to implement online identification of models. The general approximation property of neural network/fuzzy systems is only valid over a given bounded region.
In summary, it is urgently needed to design an attitude tracking control method for a hypersonic aircraft, so that the attitude and the angular rate of the aircraft can meet the preset requirements of rapidity, accuracy and stability under the conditions of input saturation, nonlinearity and uncertainty.
Disclosure of Invention
The invention aims to provide a hypersonic aircraft attitude control method considering input saturation, so that the hypersonic aircraft can track the attitude and the angular rate under the conditions of model uncertainty, external disturbance and input saturation, and the tracking performance meets the preset requirements on rapidity, accuracy and stability.
The invention adopts the following specific technical scheme:
the invention provides a hypersonic aircraft attitude control method considering input saturation, which comprises the following steps:
step 1: the parameter uncertainty, unmodeled dynamic state and external disturbance of a mathematical model of the unpowered reentry process of the hypersonic aircraft are taken together as total disturbance, mathematical models of an attitude loop and an angular rate loop of the hypersonic aircraft are established, and the mathematical models of the loops are written into a form suitable for the design of a linear active disturbance rejection controller;
step 2: according to the mathematical models of the attitude loop and the angular rate loop in the step 1, introducing a performance function to constrain the steady-state and transient performances of the state variable tracking errors of the attitude loop and the angular rate loop of the aircraft, so as to obtain inequality constraints;
and step 3: and (3) designing a controller according to the inequality constraint obtained in the step (2). In the design process of the controller, the inequality constraint (b.1) is directly processed with great difficulty, so that the inequality constraint is firstly considered to be converted into an equality constraint, and the converted equivalent system is processed;
and 4, step 4: designing a Linear Extended State Observer (Linear Extended State Observer-LESO) according to the mathematical models of the attitude loop and the angular rate loop in the step 1, selecting proper gains of the Linear Extended State Observer, and acquiring output estimation values and total disturbance estimation values of all loops;
and 5: according to the output estimation value and the total disturbance estimation value obtained in the step 4, aiming at the mathematical models of the attitude loop and the angular rate loop in the step 1, a control algorithm is designed, so that under the condition of facing input saturation constraint (a.2), the tracking error e of the system1、e2Can converge into a predetermined region (b.1).
Preferably, the expressions of the mathematical models of the attitude loop and the angular rate loop in the form suitable for the design of the linear active disturbance rejection controller in the step 1 are as shown in formulas (1) and (2):
wherein: x is the number of1=[α β μ]T,x2=[p q r]TThe state of the system, wherein α, β and mu are respectively the attack angle, the sideslip angle and the roll angle of the aircraft, p, q and r are respectively the roll rate, the yaw rate and the pitch rate, h1(t)、h2(t) total disturbances of the attitude loop and the angular rate loop, respectively, including model parameter uncertainty, unmodeled dynamics and external disturbances; delta is [ delta ]eδaδr]TIs a control input to the system, where δe、δa、δrRespectively representing the control surface deflection angles of an elevator, a rudder and an aileron, and the expression is as follows:
wherein: deltac=[δec,δac,δrc]TIs the control input signal to be designed, δmax∈(0,∞)、δminE (0, ∞) is the upper and lower bounds, g, respectively, for the known rudder surface deflection angle10、g20Are parameters to be designed.
Preferably, the attitude loop in step 1 corresponds to three state variables of an attack angle, a sideslip angle and a roll angle of the aircraft, and the angular rate loop in step 1 corresponds to three state variables of a roll rate, a yaw rate and a pitch rate of the aircraft.
Preferably, in said step 2, definition e1=[e11,e12,e13]T=x1-x1d,e2=[e21,e22,e23]T=x2-x2dTracking errors of the attitude loop and angular rate loop, respectively, where x1dIs a state variable x1Reference input of, x2dIs a state variable x2According to the preset performance control method, the specified tracking error needs to satisfy the following constraint:
wherein: kappaij∈(0,1]For the parameter to be designed, t ∈ [0, ∞), ρij(t) is a smooth, bounded, positive and strictly decreasing performance function, in general, the performance function ρij(t) may be designed in the form of:
wherein: k is a radical ofij,c>0,ρij,0Greater than 0, and rho is selectedij,0So that-pij,0<eij(0)<ρij,0。
Preferably, in step 3, the following error conversion function epsilon is definedij(t):
εij(t)=Φ(zij(t)) (6)
Wherein: phi (-) is a smooth function that increases strictly monotonically, such thatHerein, the form of the conversion function is designed to:
according to formula (6):
wherein:
let gamma bei=diag(γi1,γi2,γi3),ηi=diag(ηi1,ηi2,ηi3) Then, then
Preferably, in the step 4, a linear extended state observer shown in formulas (12) and (13) is designed, and an output estimation value and a total disturbance estimation value of each loop are obtained;
wherein β11、β12、β21、β22Is the gain of a linear extended state observer, z11=[z11,1,z11,2,z11,3]TIs an estimate of the attitude loop output, z12=[z12,1,z12,2,z12,3]TIs an estimate of the total disturbance of the attitude loop, eE1=[eE1,1,eE1,2,eE1,3]TIs the estimation error of the attitude loop, z21=[z21,1,z21,2,z21,3]TIs an estimate of the output of the angular rate loop, z22=[z22,1,z22,2,z22,3]TIs an estimate of the total disturbance of the angular rate loop, eE2=[eE2,1,eE2,2,eE2,3]TIs the estimation error of the angular rate loop.
Preferably, in step 5, the controller design process is as follows:
the following virtual control law can be designed for the attitude loop
Wherein: c. C1=diag(c11,c12,c13) Is the gain of the virtual control law.
In order to realize the compensation of the total disturbance of the attitude loop, the final control law of the system is designed into the following form:
regardless of input saturation (3), the diagonal rate loop can be designed as the following virtual control law
Wherein: c. C2=diag(c21,c22,c23) Is the gain of the virtual control law.
Pair realization by dynamic surface control algorithmThe following first-order low-pass filter is selected as a filter form:
wherein: v. of2Is x2dThe differential signal of (2). Equation (16) can be rewritten as follows:
α2=v2-γ2e2-c2ε2η2(18)
to achieve compensation for the total disturbance of the angular rate loop, the control input to be designed for the system can be written as follows:
due to the limitation of input saturation (3), this leads to designInput quantity delta ofcThere is a deviation from the actual control quantity δ, and therefore, the following auxiliary system is introduced to compensate for the deviation:
wherein:for the anti-saturation compensation parameter, tanh (. cndot.) epsilon (-1,1) is a hyperbolic tangent function,are parameters to be designed.
Then the control input delta is designed as shown in equation (21) taking into account the input saturationc:
At this time, virtual control law α2Can be written as
The invention also provides a hypersonic aircraft attitude control system considering input saturation, and the hypersonic aircraft attitude control method considering input saturation is adopted.
The technical scheme of the invention has the following beneficial effects:
(1) the invention provides a hypersonic aircraft attitude control method considering input saturation, which can realize the rapid tracking of attitude and angular rate under the conditions of model uncertainty, external disturbance and input saturation of a hypersonic aircraft, and the tracking performance meets the preset requirements of rapidity, accuracy and stability.
(2) The embodiment of the invention aims at the unpowered reentry process of a hypersonic aircraft with saturated input, adopts a linear extended state observer to realize the estimation of an unknown part of a system, introduces a preset performance control algorithm to constrain the tracking errors of an attitude loop and an angular rate loop of the system, ensures that the tracking errors of the attitude loop and the angular rate loop are converged into a preset region, performs error conversion through a nonlinear mapping function, converts a constrained system into an error system in an unconstrained form, then designs a disturbance compensation controller aiming at a new unconstrained system based on a frame of a backstepping method, reduces the influence of the saturation characteristic of an aircraft executing mechanism on a closed-loop control system by introducing an auxiliary system, and realizes the tracking control of the attitude loop and the angular rate loop. The invention ensures the dynamic performance, stability and robustness of the control system by introducing the preset performance control algorithm.
(3) The embodiment of the invention introduces the auxiliary system to compensate the influence of input saturation, thereby effectively improving the input saturation suppression capability of the system; the uncertainty of the system is estimated by adopting the linear extended state observer, the design idea is simple compared with that a neural network and a fuzzy system are used for identifying nonlinearity and an interference observer is used for observing interference, and the defect that the neural network and the fuzzy system are only effective on some tight sets is not considered; the introduction of the preset performance control method can ensure that the steady-state tracking error converges to a preset region, and simultaneously, the convergence speed and the overshoot meet the preset conditions, thereby ensuring the convergence of the attitude and angular rate steady-state errors and simultaneously realizing the transient performance requirements of the convergence speed, the overshoot and the like.
In addition to the objects, features and advantages described above, other objects, features and advantages of the present invention are also provided. The present invention will be described in further detail below with reference to the drawings.
Drawings
The accompanying drawings, which are incorporated in and constitute a part of this application, illustrate embodiments of the invention and, together with the description, serve to explain the invention and not to limit the invention. In the drawings:
fig. 1 is a schematic block diagram of a hypersonic aircraft attitude control method considering input saturation according to embodiment 1 of the present invention;
fig. 2 is a flowchart of a method for controlling an attitude of a hypersonic aircraft considering input saturation according to embodiment 1 of the present invention.
Detailed Description
The following is a detailed description of embodiments of the invention, but the invention can be implemented in many different ways, as defined and covered by the claims.
Example 1:
a hypersonic aircraft attitude control method considering input saturation comprises the following steps:
step 1: the method comprises the steps of considering parameter uncertainty, unmodeled dynamic state and external disturbance in a hypersonic aircraft unpowered reentry process mathematical model together as total disturbance, establishing mathematical models of an attitude loop and an angular rate loop of the hypersonic aircraft, and writing the mathematical models of the loops into a form suitable for the design of a linear active disturbance rejection controller; specifically, mathematical models of the attitude loop and the angular rate loop are written into a form suitable for the design of the linear active disturbance rejection controller.
The mathematical model of the unpowered reentry process of the hypersonic aircraft can be written as shown in the following formula (a):
wherein α, β, mu and gamma are respectively the attack angle, the sideslip angle, the roll angle and the track angle of the aircraft, p, q and r are respectively the roll angular velocity, the yaw angular velocity and the pitch angular velocity, M is the mass of the aircraft wing, g is the gravity acceleration, S is the reference area of the aircraft wing, I is the reference area of the aircraft wingx、Iy、IzIs the primary moment of inertia of the aircraft; l, D, Y are respectively the drag, lateral and lift forces of the aircraft, l, m, n are respectively the roll, yaw and pitch moments,v is the velocity of the hypersonic aircraft, b is the span length, c is the mean aerodynamic chord length,is a dynamic pressure; cL、CD、CY、Cl、Cm、CnIs the aerodynamic coefficient, the calculation formula is shown as the formula (a.1), deltae、δa、δrThe rudder surface deflection angles of the elevator, the rudder and the ailerons are respectively shown as a formula (a.2);
wherein: delta is the control input to the system, deltac=[δec,δac,δrc]TIs the control input signal to be designed, δmax∈(0,∞)、δminE (0, ∞) is the upper and lower bounds, respectively, for which the rudder surface deflection angle is known.
Formula (a) is abbreviated to the forms of formulae (a.3) and (a.4):
wherein x is1=[α β μ]T,x2=[p q r]T,δ=[δeδaδr]T;f1(x1)、f2(x1,x2)、g11(x1)、g12(x1) And g2(x1) Is represented by formula (a.5):
wherein: cD,α、CL,α、CY,β、Cl,β、Cl,δe、Cl,δa、Cl,δr、Cl,p、Cl,q、Cm,β、Cm,p、Cm,q、Cn,α、 Cn,rIs the aerodynamic derivative.
The attitude loop and the angular rate loop can form a cascade system, the attitude loop is used as an outer ring of the cascade system and used for controlling the attitude angle of the hypersonic aircraft and eliminating the deviation of an aircraft control system, the angular rate loop is used as an inner ring of the cascade system and used for quickly compensating or inhibiting the influence of external disturbance, and meanwhile, the output of the inner ring is ensured to quickly and accurately track the output signal x of an outer ring controller2dFor convenience of controller design, equations (a.3) and (a.4) are abbreviated as the forms shown in equations (a.6) and (a.7):
wherein: h is1(t)=f1(x1)+g12(x1)δ+(g11(x1)-g10)x2Is the total disturbance of the attitude loop, including uncertainty of model parameters in the attitude loop, unmodeled dynamics and external disturbance; h is2(t)=f2(x1,x2)+(g2(x1)-g20) δ is the total disturbance of the angular rate loop, including uncertainty of model parameters in the angular rate loop, unmodeled dynamics, and external disturbances; because of g11And g2Related to aerodynamic parameters, not exact values, although there are related parameters that can be referenced, and therefore g11、g2Taking the reference pneumatic parameter g10、g20As an estimate thereof.
In the attitude loop in the step 1, the hypersonic aerocraft has three state variables of an attack angle, a sideslip angle and a roll angle, and in the angular rate loop in the step 1, the hypersonic aerocraft has three state variables of a rolling angular velocity, a yaw angular velocity and a pitch angular velocity.
Step 2: and (3) according to the mathematical models of the attitude loop and the angular rate loop in the step (1), introducing a performance function to constrain the steady-state and transient performances of the state variable tracking errors of the attitude loop and the angular rate loop of the aircraft, and obtaining an inequality constraint. The method specifically comprises the following steps:
definition e1=[e11,e12,e13]T=x1-x1d,e2=[e21,e22,e23]T=x2-x2dIs the tracking error of the attitude loop and angular rate loop, where x1dIs a state variable x1Reference input of, x2dIs a state variable x2According to the preset performance control method, the specified tracking error needs to satisfy the following constraint:
wherein: kappaij∈(0,1]For the parameter to be designed, t ∈ [0, ∞), ρij(t) is a smooth, bounded, positive and strictly decreasing performance function, in general, the performance function ρij(t) may be designed in the form of:
wherein: k is a radical ofij,c>0,ρij,0Greater than 0, and rho is selectedij,0So that-pij,0<eij(0)<ρij,0。
When inequality (b.1) is satisfied, eij(0) For example, ≧ 0, the tracking error curve is limited to- κijρij(t) and ρij(t) in the region surrounded by the first and second coupling functions, andijthe decreasing nature of (t) indicates that the tracking error will be at the function-kijρij(t) and ρij(t) rapidly converges to a small domain of 0. Constant rhoij,∞Representing an upper bound, p, of a predetermined steady state errorij(t) the decay rate is the tracking error eij(t) lower bound of convergence rate, while maximum overshoot of tracking error is not greater than kijρij,0. The steady-state and transient performance of the tracking error can be limited by selecting an appropriate performance function.
And step 3: and (3) designing a controller according to the inequality constraint obtained in the step (2). In the design process of the controller, the inequality constraint (b.1) is directly processed with great difficulty, so that the inequality constraint is firstly considered to be converted into an equality constraint, and the converted equivalent system is processed, so that the following error conversion function epsilon is definedij(t):
εij(t)=Φ(zij(t)) (c.1)
Wherein: phi (-) is a smooth function that increases strictly monotonically, such thatHerein, the form of the design transfer function is:
then:
according to formula (c.1):
wherein:
let gamma bei=diag(γi1,γi2,γi3),ηi=diag(ηi1,ηi2,ηi3) Then, then
And 4, step 4: designing a Linear Extended State Observer (Linear Extended State Observer-LESO) according to the mathematical models of the attitude loop and the angular rate loop in the step 1, selecting a proper gain of the Linear Extended State Observer, and acquiring an output estimation value and a total disturbance estimation value of the attitude loop and an output estimation value and a total disturbance estimation value of the angular rate loop;
wherein β11、β12、β21、β22For the gain of the linear extended state observer, the bandwidth ω of the linear extended state observer can be usedoi=[ωo1,i,ωo2,i,ωo3,i]TIs shown as z11=[z11,1,z11,2,z11,3]TIs an estimate of the attitude loop output, z12=[z12,1,z12,2,z12,3]TIs an estimate of the total disturbance of the attitude loop, eE1=[eE1,1,eE1,2,eE1,3]TIs the estimation error of the attitude loop, z21=[z21,1,z21,2,z21,3]TIs an estimate of the output of the angular rate loop, z22=[z22,1,z22,2,z22,3]TIs an estimate of the total disturbance of the angular rate loop, eE2=[eE2,1,eE2,2,eE2,3]TIs the estimation error of the angular rate loop.
To simplify the parameter adjustment process, the gain of the linear extended state observer is designed as the following expression (d.3):
s2+β1s+β2=(s+ωo)2......(d.4)
wherein: omegaoIs the bandwidth of a linear expansion state function, β1=[β11,β21],β2=[β12,β22],ωo=[ωo1,ωo2]T. Thus, the gain of the linear extended state observer can be determined by the bandwidth ωoDetermination of ωoIs the only parameter to be adjusted in the linear extended state observer.
And 5: according to the output estimated values of the attitude loop and the angular rate loop obtained in the step 4And a total disturbance estimated value, aiming at the mathematical models of the attitude loop and the angular rate loop in the step 1, designing a control algorithm to ensure that the tracking error e of the system is under the condition of facing the input saturation constraint (a.2)1、e2Can converge into a predetermined region (b.1).
Designing a controller for an attitude loop, and defining an error surface:
according to equation (c.7), consider the lyapunov function as follows:
then:
Wherein: c. C1=diag(c11,c12,c13) Is the gain of the virtual control law.
In order to realize the compensation of the total disturbance of the attitude loop, the final control law of the system is designed into the following form:
controller design is carried out on the angular rate loop, and an error surface is defined:
the controller design is performed without considering the input saturation constraint (a.2):
according to equation (c.7), consider the lyapunov function as follows:
then:
Wherein: c. C2=diag(c21,c22,c23) Is the gain of the virtual control law.
Pair realization by dynamic surface control algorithmThe following first-order low-pass filter is selected as a filter form:
wherein: v. of2Is x2dThe differential signal of (2). Equation (e.9) may be rewritten as follows:
α2=v2-γ2e2-c2ε2η2(e.11)
to achieve compensation for the total disturbance of the angular rate loop, the control input to be designed for the system can be written as follows:
due to the limitation of input saturation (a.2), the designed input quantity delta is causedcThere is a deviation from the actual control quantity δ, and therefore, the following auxiliary system is introduced to compensate for the deviation:
wherein:for the anti-saturation compensation parameter, tanh (. cndot.) epsilon (-1,1) is a hyperbolic tangent function,are parameters to be designed.
the control input delta is designed according to equation (e.14)cComprises the following steps:
at this time, virtual control law α2Can be written as
The embodiment of the invention aims at the unpowered reentry process of a hypersonic aircraft with input saturation, a preset performance control function is adopted to constrain the tracking errors of a system attitude loop and an angular rate loop, so that the tracking errors of the system can be converged into a preset region, an error conversion function is adopted to convert a system with constraint into an unconstrained form for facilitating the design of a controller, then a linear expansion state observer is designed to realize the estimation of an unknown part of the system, a disturbance compensation controller is designed based on a frame of a backstepping method, and an auxiliary system is utilized to reduce the influence of the saturation characteristic of an aircraft executing mechanism on a closed-loop control system, so that the tracking control of the attitude loop and the angular rate loop is realized. The introduction of the preset performance control algorithm improves the dynamic performance and robustness of the whole control system, the uncertainty of the system is estimated by adopting the linear extended state observer, and compared with the design idea of identifying nonlinearity by using a neural network and a fuzzy system and observing interference by using an interference observer, the design idea is simple, and the defect that the neural network and the fuzzy system are only effective on some tight sets is not considered.
The above description is only a preferred embodiment of the present invention and is not intended to limit the present invention, and various modifications and changes may be made by those skilled in the art. Any modification, equivalent replacement, or improvement made within the spirit and principle of the present invention should be included in the protection scope of the present invention.
Claims (8)
1. A hypersonic aircraft attitude control method considering input saturation is characterized by comprising the following steps:
step 1: the parameter uncertainty, unmodeled dynamic state and external disturbance of a mathematical model of the unpowered reentry process of the hypersonic aircraft are taken together as total disturbance, mathematical models of an attitude loop and an angular rate loop of the hypersonic aircraft are established, and the mathematical models of the loops are written into a form suitable for the design of a linear active disturbance rejection controller;
step 2: according to the mathematical models of the attitude loop and the angular rate loop in the step 1, introducing a performance function to constrain the steady-state and transient performances of the state variable tracking errors of the attitude loop and the angular rate loop of the aircraft, so as to obtain inequality constraints;
and step 3: performing corresponding conversion according to the inequality constraint obtained in the step 2 so as to facilitate subsequent controller design;
and 4, step 4: designing a Linear Extended State Observer (Linear Extended State Observer-LESO) according to the mathematical models of the attitude loop and the angular rate loop in the step 1, selecting proper gains of the Linear Extended State Observer, and acquiring output estimation values and total disturbance estimation values of all loops;
and 5: and (3) designing a control algorithm aiming at the mathematical models of the attitude loop and the angular rate loop in the step (1) according to the output estimation value and the total disturbance estimation value obtained in the step (4), so that the tracking error of the system can be converged into a preset area under the condition of facing input saturation constraint.
2. The attitude control method of hypersonic flight vehicle considering input saturation as claimed in claim 1, wherein the expressions of the mathematical models of attitude loop and angular rate loop suitable for the design form of linear active disturbance rejection controller in step 1 are as follows (1) and (2):
wherein: x is the number of1=[α β μ]T,x2=[p q r]T,δ=[δeδaδr]Tα, β and mu are respectively the attack angle, the sideslip angle and the roll angle of the aircraft, p, q and r are respectively the roll angular velocity, the yaw angular velocity and the pitch angular velocity, h1(t)、h2(t) is the total disturbance of the attitude loop and angular rate loop, including model parameter uncertainty, unmodeled dynamics and external disturbances, respectively; g10、g20Is a parameter to be designed; deltae、δa、δrRespectively representing the control surface deflection angles of an elevator, a rudder and an aileron, and the expression is as follows:
wherein: deltac=[δec,δac,δrc]TIs the control input signal to be designed, δmax∈(0,∞)、δminE (0, ∞) is the upper and lower bounds, respectively, for which the rudder surface deflection angle is known.
3. The method as claimed in claim 1, wherein the attitude loop of step 1 corresponds to three state variables of the aircraft, namely, the angle of attack, the sideslip angle and the roll angle, and the angular rate loop of step 1 corresponds to three state variables of the aircraft, namely, the roll rate, the yaw rate and the pitch rate.
4. The hypersonic aircraft attitude control method taking input saturation into account as claimed in claim 2, wherein in said step 2, e is defined1=[e11,e12,e13]T=x1-x1d,e2=[e21,e22,e23]T=x2-x2dTracking errors of the attitude loop and angular rate loop, respectively, where x1dIs a state variable x1Reference input of, x2dIs a state variable x2According to the preset performance control method, the specified tracking error needs to satisfy the following constraint:
wherein: kappaij∈(0,1]For the parameter to be designed, t ∈ [0, ∞), ρij(t) is a smooth, bounded, positive and strictly decreasing performance function, the performance function ρij(t) is designed in the form of:
5. The method for controlling the attitude of a hypersonic aircraft considering input saturation according to claim 4, characterized in that in step 3, the following error transfer function ε is definedij(t):
εij(t)=Φ(zij(t)) (6)
Wherein: phi (-) is a smooth function that increases strictly monotonically, such thatThe form of the transfer function is designed as:
according to formula (6):
wherein: epsiloni=[εi1,εi2,εi3]T,γi=diag(γi1,γi2,γi3),ηi=diag(ηi1,ηi2,ηi3),
6. The method for controlling the attitude of a hypersonic aircraft considering input saturation according to claim 5, characterized in that in the step 4, a linear extended state observer is designed as shown in formulas (12) and (13):
wherein β11、β12、β21、β22Is the gain of a linear extended state observer, z11=[z11,1,z11,2,z11,3]TIs an estimate of the attitude loop output, z12=[z12,1,z12,2,z12,3]TIs an estimate of the total disturbance of the attitude loop, eE1=[eE1,1,eE1,2,eE1,3]TIs the estimation error of the attitude loop, z21=[z21,1,z21,2,z21,3]TIs an estimate of the output of the angular rate loop, z22=[z22,1,z22,2,z22,3]TIs an estimate of the total disturbance of the angular rate loop, eE2=[eE2,1,eE2,2,eE2,3]TIs the estimation error of the angular rate loop.
7. The hypersonic aircraft attitude control method taking input saturation into account as claimed in claim 6, wherein in said step 5, the controller design process is as follows:
the following virtual control law can be designed for the attitude loop
Wherein: c. C1=diag(c11,c12,c13) Is the gain of the virtual control law.
In order to realize the compensation of the total disturbance of the attitude loop, the final control law of the system is designed into the following form:
due to the limitation of input saturation (3), the designed input quantity delta is causedcThere is a deviation from the actual control quantity δ, and therefore, the following auxiliary system is introduced to compensate for the deviation:
wherein:for the anti-saturation compensation parameter, tanh (. cndot.) epsilon (-1,1) is a hyperbolic tangent function,are parameters to be designed.
Then virtual control law α for input saturation2Is designed into
To achieve compensation of the total disturbance of the angular rate loop, the system has to be designed with a control input δcThe design is as follows:
wherein: c. C2=diag(c21,c22,c23) Is the gain of the virtual control law;
pair realization by dynamic surface control algorithmThe following first-order low-pass filter is selected as a filter form:
wherein: v. of2Is x2dThe differential signal of (a); then equation (17) is rewritten as follows:
the formula (19) is substituted for the formula (3) to obtain the actual control law δ of the whole system.
8. An attitude control system of a hypersonic aerocraft considering input saturation, which is characterized in that the attitude control method of the hypersonic aerocraft considering input saturation is adopted, and the attitude control system is as claimed in any one of claims 1 to 7.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010201787.3A CN111290421A (en) | 2020-03-20 | 2020-03-20 | Hypersonic aircraft attitude control method considering input saturation |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010201787.3A CN111290421A (en) | 2020-03-20 | 2020-03-20 | Hypersonic aircraft attitude control method considering input saturation |
Publications (1)
Publication Number | Publication Date |
---|---|
CN111290421A true CN111290421A (en) | 2020-06-16 |
Family
ID=71027676
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010201787.3A Pending CN111290421A (en) | 2020-03-20 | 2020-03-20 | Hypersonic aircraft attitude control method considering input saturation |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111290421A (en) |
Cited By (13)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111766890A (en) * | 2020-07-24 | 2020-10-13 | 中南大学 | Spacecraft performance-guaranteeing attitude control method independent of neural network approximation |
CN111831002A (en) * | 2020-07-10 | 2020-10-27 | 中国人民解放军海军工程大学 | Hypersonic aircraft attitude control method based on preset performance |
CN112363393A (en) * | 2020-10-27 | 2021-02-12 | 华中科技大学 | Model-free self-adaptive preset performance control method for unmanned ship power positioning |
CN112792808A (en) * | 2020-12-24 | 2021-05-14 | 珞石(山东)智能科技有限公司 | Industrial robot online track planning method and device based on variable structure filter |
CN113359789A (en) * | 2021-05-14 | 2021-09-07 | 重庆大学 | Inversion control method and device for asymmetric dynamic constraint of aircraft |
CN113534842A (en) * | 2021-07-29 | 2021-10-22 | 电子科技大学 | Unmanned aerial vehicle control method based on active disturbance rejection |
CN113885552A (en) * | 2021-09-01 | 2022-01-04 | 中国人民解放军海军工程大学 | Preset performance control method and system for hypersonic aircraft |
CN114153144A (en) * | 2021-11-01 | 2022-03-08 | 天津大学 | Elastic hypersonic aircraft control method with limited input and disturbance input |
CN115712240A (en) * | 2022-10-27 | 2023-02-24 | 中南大学 | Ballistic trajectory control method, device and medium for large-sector-angle launch and large-falling-angle attack |
CN115755590A (en) * | 2023-01-09 | 2023-03-07 | 北京航空航天大学 | Anti-interference guidance control system and method for hypersonic aircraft |
CN116414152A (en) * | 2023-06-12 | 2023-07-11 | 中国空气动力研究与发展中心空天技术研究所 | Reentry vehicle transverse and lateral rapid maneuver control method, system, terminal and medium |
CN116483103A (en) * | 2023-03-28 | 2023-07-25 | 西北工业大学 | Hypersonic aircraft attitude control method based on disturbance observer |
CN116610137A (en) * | 2023-07-19 | 2023-08-18 | 北京航空航天大学 | Hypersonic aircraft strong disturbance rejection control method based on disturbance prediction |
Citations (15)
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 |
US20150108269A1 (en) * | 2012-12-07 | 2015-04-23 | Richard H. Lugg | Hypersonic aircraft |
CN105843080A (en) * | 2016-06-01 | 2016-08-10 | 南京航空航天大学 | Intelligent nonlinear control system for hypersonic morphing aircraft |
CN106444799A (en) * | 2016-07-15 | 2017-02-22 | 浙江工业大学 | Quadrotor unmanned plane control method based on fuzzy expansion state observer and adaptive sliding formwork |
CN106773691A (en) * | 2016-12-19 | 2017-05-31 | 西北工业大学 | Hypersonic aircraft self adaptation time-varying default capabilities control method based on LS SVM |
CN106842912A (en) * | 2016-11-30 | 2017-06-13 | 南京航空航天大学 | The hypersonic anti-rudder face saturation robust control method of motor-driven flight |
CN107272719A (en) * | 2017-06-29 | 2017-10-20 | 南京航空航天大学 | Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor |
US20180107173A1 (en) * | 2016-10-17 | 2018-04-19 | Linestream Technologies | Application-specification-oriented control design |
CN109062055A (en) * | 2018-09-10 | 2018-12-21 | 南京航空航天大学 | A kind of Near Space Flying Vehicles control system based on Back-stepping robust adaptive dynamic surface |
CN109189087A (en) * | 2018-08-20 | 2019-01-11 | 哈尔滨工业大学 | A kind of adaptive fusion method of VTOL Reusable Launch Vehicles |
CN109725644A (en) * | 2019-01-22 | 2019-05-07 | 湖南云顶智能科技有限公司 | A kind of hypersonic aircraft linear optimization control method |
CN110244751A (en) * | 2019-05-24 | 2019-09-17 | 北京控制工程研究所 | A kind of hypersonic aircraft attitude-adaptive recursion control method and system |
CN110377045A (en) * | 2019-08-22 | 2019-10-25 | 北京航空航天大学 | A kind of aircraft complete section face control method based on Anti-Jamming Technique |
CN110488852A (en) * | 2019-08-28 | 2019-11-22 | 北京航空航天大学 | A kind of hypersonic aircraft complete section surface self-adaption control method |
CN110851912A (en) * | 2019-08-14 | 2020-02-28 | 湖南云顶智能科技有限公司 | Multi-target pneumatic design method for hypersonic aircraft |
-
2020
- 2020-03-20 CN CN202010201787.3A patent/CN111290421A/en active Pending
Patent Citations (15)
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 |
US20150108269A1 (en) * | 2012-12-07 | 2015-04-23 | Richard H. Lugg | Hypersonic aircraft |
CN105843080A (en) * | 2016-06-01 | 2016-08-10 | 南京航空航天大学 | Intelligent nonlinear control system for hypersonic morphing aircraft |
CN106444799A (en) * | 2016-07-15 | 2017-02-22 | 浙江工业大学 | Quadrotor unmanned plane control method based on fuzzy expansion state observer and adaptive sliding formwork |
US20180107173A1 (en) * | 2016-10-17 | 2018-04-19 | Linestream Technologies | Application-specification-oriented control design |
CN106842912A (en) * | 2016-11-30 | 2017-06-13 | 南京航空航天大学 | The hypersonic anti-rudder face saturation robust control method of motor-driven flight |
CN106773691A (en) * | 2016-12-19 | 2017-05-31 | 西北工业大学 | Hypersonic aircraft self adaptation time-varying default capabilities control method based on LS SVM |
CN107272719A (en) * | 2017-06-29 | 2017-10-20 | 南京航空航天大学 | Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor |
CN109189087A (en) * | 2018-08-20 | 2019-01-11 | 哈尔滨工业大学 | A kind of adaptive fusion method of VTOL Reusable Launch Vehicles |
CN109062055A (en) * | 2018-09-10 | 2018-12-21 | 南京航空航天大学 | A kind of Near Space Flying Vehicles control system based on Back-stepping robust adaptive dynamic surface |
CN109725644A (en) * | 2019-01-22 | 2019-05-07 | 湖南云顶智能科技有限公司 | A kind of hypersonic aircraft linear optimization control method |
CN110244751A (en) * | 2019-05-24 | 2019-09-17 | 北京控制工程研究所 | A kind of hypersonic aircraft attitude-adaptive recursion control method and system |
CN110851912A (en) * | 2019-08-14 | 2020-02-28 | 湖南云顶智能科技有限公司 | Multi-target pneumatic design method for hypersonic aircraft |
CN110377045A (en) * | 2019-08-22 | 2019-10-25 | 北京航空航天大学 | A kind of aircraft complete section face control method based on Anti-Jamming Technique |
CN110488852A (en) * | 2019-08-28 | 2019-11-22 | 北京航空航天大学 | A kind of hypersonic aircraft complete section surface self-adaption control method |
Non-Patent Citations (3)
Title |
---|
HAOJIAN XU: "Adaptive Sliding Mode Control Design for a Hypersonic Flight Vehicle", 《OURNAL OF GUIDANCE, CONTROL, AND DYNAMICS》 * |
张科: "基于LESO的高超声速飞行器动态面控制", 《西北工业大学学报》 * |
李小兵: "高超声速飞行器保预设性能的反演控制方法", 《国防科技大学学报》 * |
Cited By (20)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111831002A (en) * | 2020-07-10 | 2020-10-27 | 中国人民解放军海军工程大学 | Hypersonic aircraft attitude control method based on preset performance |
CN111766890A (en) * | 2020-07-24 | 2020-10-13 | 中南大学 | Spacecraft performance-guaranteeing attitude control method independent of neural network approximation |
CN111766890B (en) * | 2020-07-24 | 2021-09-14 | 中南大学 | Spacecraft performance-guaranteeing attitude control method independent of neural network approximation |
CN112363393A (en) * | 2020-10-27 | 2021-02-12 | 华中科技大学 | Model-free self-adaptive preset performance control method for unmanned ship power positioning |
CN112363393B (en) * | 2020-10-27 | 2023-08-01 | 华中科技大学 | Model-free self-adaptive preset performance control method for unmanned ship dynamic positioning |
CN112792808A (en) * | 2020-12-24 | 2021-05-14 | 珞石(山东)智能科技有限公司 | Industrial robot online track planning method and device based on variable structure filter |
CN113359789A (en) * | 2021-05-14 | 2021-09-07 | 重庆大学 | Inversion control method and device for asymmetric dynamic constraint of aircraft |
CN113534842A (en) * | 2021-07-29 | 2021-10-22 | 电子科技大学 | Unmanned aerial vehicle control method based on active disturbance rejection |
CN113885552A (en) * | 2021-09-01 | 2022-01-04 | 中国人民解放军海军工程大学 | Preset performance control method and system for hypersonic aircraft |
CN113885552B (en) * | 2021-09-01 | 2023-09-29 | 中国人民解放军海军工程大学 | Preset performance control method and system for hypersonic aircraft |
CN114153144A (en) * | 2021-11-01 | 2022-03-08 | 天津大学 | Elastic hypersonic aircraft control method with limited input and disturbance input |
CN114153144B (en) * | 2021-11-01 | 2023-08-22 | 天津大学 | Elastic hypersonic aircraft control method with limited input and disturbance input |
CN115712240A (en) * | 2022-10-27 | 2023-02-24 | 中南大学 | Ballistic trajectory control method, device and medium for large-sector-angle launch and large-falling-angle attack |
CN115755590A (en) * | 2023-01-09 | 2023-03-07 | 北京航空航天大学 | Anti-interference guidance control system and method for hypersonic aircraft |
CN116483103A (en) * | 2023-03-28 | 2023-07-25 | 西北工业大学 | Hypersonic aircraft attitude control method based on disturbance observer |
CN116483103B (en) * | 2023-03-28 | 2023-12-01 | 西北工业大学 | Hypersonic aircraft attitude control method based on disturbance observer |
CN116414152B (en) * | 2023-06-12 | 2023-08-15 | 中国空气动力研究与发展中心空天技术研究所 | Reentry vehicle transverse and lateral rapid maneuver control method, system, terminal and medium |
CN116414152A (en) * | 2023-06-12 | 2023-07-11 | 中国空气动力研究与发展中心空天技术研究所 | Reentry vehicle transverse and lateral rapid maneuver control method, system, terminal and medium |
CN116610137A (en) * | 2023-07-19 | 2023-08-18 | 北京航空航天大学 | Hypersonic aircraft strong disturbance rejection control method based on disturbance prediction |
CN116610137B (en) * | 2023-07-19 | 2023-09-15 | 北京航空航天大学 | Hypersonic aircraft strong disturbance rejection control method based on disturbance prediction |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111290421A (en) | Hypersonic aircraft attitude control method considering input saturation | |
Sun et al. | Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles | |
CN111367182A (en) | Hypersonic aircraft anti-interference backstepping control method considering input limitation | |
CN109189087B (en) | Self-adaptive fault-tolerant control method for vertical take-off and landing reusable carrier | |
CN107065539B (en) | Control surface fault self-adaptive fault-tolerant control method of flying wing layout aircraft | |
CN105607473B (en) | The attitude error Fast Convergent self-adaptation control method of small-sized depopulated helicopter | |
CN107562068B (en) | Dynamic surface output regulation control method for attitude of four-rotor aircraft | |
Shen et al. | Prescribed performance dynamic surface control for trajectory tracking of quadrotor UAV with uncertainties and input constraints | |
CN108594837A (en) | Model-free quadrotor drone contrail tracker and method based on PD-SMC and RISE | |
CN110244751B (en) | Attitude self-adaptive recursion control method and system for hypersonic aircraft | |
CN111831002B (en) | Hypersonic aircraft attitude control method based on preset performance | |
CN111045440B (en) | Hypersonic aircraft nose-down section rapid rolling control method | |
CN110362110B (en) | Fixed self-adaptive neural network unmanned aerial vehicle track angle control method | |
Li et al. | Finite-time control for quadrotor based on composite barrier Lyapunov function with system state constraints and actuator faults | |
CN111077897B (en) | Improved nonlinear PID four-rotor aircraft control method | |
Gai et al. | Adaptive neural network dynamic inversion with prescribed performance for aircraft flight control | |
CN114721266B (en) | Self-adaptive reconstruction control method under condition of structural failure of control surface of airplane | |
CN115793696A (en) | Hypersonic aircraft attitude control method, system, electronic equipment and medium | |
CN108459611B (en) | Attitude tracking control method of near space vehicle | |
Liu et al. | Antisaturation fixed-time attitude tracking control based low-computation learning for uncertain quadrotor UAVs with external disturbances | |
Cao et al. | Discrete-time incremental backstepping controller for unmanned aircrafts subject to actuator constraints | |
CN116339140B (en) | Composite fault-tolerant control method based on instantaneous active disturbance rejection and adaptive dynamic inversion | |
CN110347036B (en) | Unmanned aerial vehicle autonomous wind-resistant intelligent control method based on fuzzy sliding mode control | |
CN116560232A (en) | RBF neural network-based adaptive inversion control method for variant aircraft | |
CN114003053B (en) | Fixed wing unmanned aerial vehicle autopilot self-adaptive control system based on ArduPilot |
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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20200616 |
|
WD01 | Invention patent application deemed withdrawn after publication |