CN107272719A - Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor - Google Patents
Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor Download PDFInfo
- Publication number
- CN107272719A CN107272719A CN201710514169.2A CN201710514169A CN107272719A CN 107272719 A CN107272719 A CN 107272719A CN 201710514169 A CN201710514169 A CN 201710514169A CN 107272719 A CN107272719 A CN 107272719A
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mover
- mtr
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 45
- 230000033001 locomotion Effects 0.000 title claims abstract description 34
- 230000008878 coupling Effects 0.000 claims abstract description 92
- 238000010168 coupling process Methods 0.000 claims abstract description 92
- 238000005859 coupling reaction Methods 0.000 claims abstract description 92
- 238000013461 design Methods 0.000 claims abstract description 35
- 230000003044 adaptive effect Effects 0.000 claims abstract description 19
- 239000011159 matrix material Substances 0.000 claims description 75
- 230000008569 process Effects 0.000 claims description 10
- 230000008859 change Effects 0.000 claims description 7
- 238000013507 mapping Methods 0.000 claims description 7
- 239000013598 vector Substances 0.000 claims description 7
- 230000017105 transposition Effects 0.000 claims description 6
- 238000004422 calculation algorithm Methods 0.000 claims description 5
- 230000006978 adaptation Effects 0.000 claims description 4
- 230000000694 effects Effects 0.000 claims description 4
- 238000013178 mathematical model Methods 0.000 claims description 4
- 238000005096 rolling process Methods 0.000 claims description 4
- 244000089409 Erythrina poeppigiana Species 0.000 claims description 3
- 235000009776 Rathbunia alamosensis Nutrition 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 3
- 230000003028 elevating effect Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 101100248300 Mus musculus Rhbdf2 gene Proteins 0.000 claims description 2
- 230000002411 adverse Effects 0.000 claims description 2
- 238000013016 damping Methods 0.000 claims description 2
- 238000000926 separation method Methods 0.000 claims description 2
- 238000009795 derivation Methods 0.000 abstract description 3
- 238000005516 engineering process Methods 0.000 abstract description 2
- 238000000556 factor analysis Methods 0.000 abstract 1
- 238000004519 manufacturing process Methods 0.000 abstract 1
- 238000004088 simulation Methods 0.000 description 6
- 238000011160 research Methods 0.000 description 4
- 230000004044 response Effects 0.000 description 4
- 238000009825 accumulation Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 235000009421 Myristica fragrans Nutrition 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000013528 artificial neural network Methods 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000005764 inhibitory process Effects 0.000 description 1
- 239000001115 mace Substances 0.000 description 1
- 238000005312 nonlinear dynamic Methods 0.000 description 1
- 230000005624 perturbation theories Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0841—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability to prevent a coupling between different modes
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
Abstract
The invention discloses a kind of hypersonic aircraft attitude motion Robust coordinated control method based on coordinating factor analysis method, belong to aircraft manufacturing technology field.The close coupling problem that this method is moved first against attitude of flight vehicle, resolves into angular movement coupling, inertia coupling by the coupling of attitude mode and is manipulated with rudder face and couple three kinds of forms.Secondly, three kinds of coordinating factors have been separately designed to three of the above coupled mode.Then attitude system is divided into fast loop and slow loop, and separately designs the Robust adaptive controller in two loops.Coordinating factor is finally combined into derivation with robust controller and coordinates torque, torque will be coordinated and be assigned to rudder face, realized and coordinated by control surface deflection.This method effectively raises the control efficiency of rudder face, especially control surface deflection number of times and reduced, and has saved energy.
Description
Technical Field
The invention discloses a coordination factor-based hypersonic aircraft attitude motion coordination control method, and belongs to the technical field of spacecraft attitude control.
Background
The hypersonic aircraft has important military strategic significance and is a killer mace weapon for 21 century sky battle. At present, the research of hypersonic aircrafts is generally regarded by countries all over the world. However, control of the aircraft is also challenging due to fast and large-span flight. Hypersonic velocity is a hot point of research at present due to the characteristics of strong coupling and strong nonlinearity.
In recent years, a plurality of valuable scientific achievements are obtained in the aspect of attitude motion control of the hypersonic aircraft, and a plurality of students carry out corresponding work aiming at the problem of strong coupling of the attitude motion of the hypersonic aircraft. The learners adopt a neural network self-adaptive technology based on feedback linearization, and provide an online real-time self-adaptive attitude controller. However, feedback linearization relies on the accuracy of the system model, and thus it is difficult to ensure control accuracy when the model is uncertain. The optimal dynamic inverse control method is also proposed by scholars and applied to attitude control, however, when external interference exists in the system, the method is difficult to ensure good control. Subsequently, many scholars have proposed nonlinear control methods. The method comprises the steps that a sliding mode method is used for controlling the aircraft, two sliding mode controllers based on a single ring and an inner ring are designed, and researches show that the sliding mode method has good robustness to parameter uncertainty and external disturbance, but the strong coupling problem is difficult to process. Then, some scholars adopt a layered control idea to process the strong coupling problem of the hypersonic velocity attitude motion based on a nonlinear method, and some scholars adopt a decoupling method to process the strong coupling problem, wherein the method comprises the step of designing an inner-outer loop decoupling controller by adopting a singular value perturbation theory. Although the method realizes the coordination of the attitude motion at a certain degree and lays a foundation for subsequent work, due to the complexity of nonlinear dynamics of the hypersonic aerocraft, the results clearly provide a coordination mechanism to actively link, inhibit or utilize a coupling effect. The main problem of strong coupling of attitude motion of the hypersonic aircraft is the mutual influence among variables, some coupling influences are beneficial to the control of the aircraft, some coupling accumulation is fatal to the control of the aircraft, and long-time coupling accumulation can cause instability of the attitude of the aircraft. Based on the above analysis, it is necessary to research a new control method to deal with the strong coupling problem of the attitude motion of the hypersonic aircraft.
Disclosure of Invention
In order to overcome the defects of the existing coordination control method, the invention provides a coordination factor-based attitude motion coordination control method for a hypersonic aircraft. Firstly, based on a mathematical model of an attitude system, coupling between attitude motions is decomposed into angular motion coupling, inertia coupling and control surface manipulation coupling. And then respectively designing a coordination factor for the coupling modes, combining the coordination factor with a designed robust controller to deduce a coordination moment, and distributing the moment into a control plane deflection instruction to realize coordination. Finally, the validity of the method is verified through simulation, and the method is proved to have a better application prospect.
The invention adopts the following technical scheme for solving the technical problems:
a coordinated factor-based hypersonic aircraft attitude motion coordination control method comprises the following steps:
step 1) performing coupling analysis on an attitude model of the hypersonic aircraft, and decomposing a strong coupling problem among attitude motions into three forms of angular motion coupling, inertial coupling and control surface control coupling; based on the three coupling forms, feeding back the corresponding state variable to the corresponding control surface loop design coordination factor;
step 2) decomposing the attitude system into a slow loop and a fast loop based on a time scale separation principle; designing a slow-loop robust controller and a fast-loop robust controller respectively based on a sliding mode method and a projection mapping method;
and 3) combining the coordination factor with a robust controller to derive a coordination moment, distributing the coordination moment into a control plane instruction by using a control plane distribution matrix, and realizing the coordination of the attitude motion by using the coordinated deflection of the control plane.
The specific process of the step 1) comprises the following steps:
step 1-1), establishing a mathematical model of a hypersonic aircraft attitude system;
whereinDenotes the derivative of Ω, Ω denotes the system slow loop state variable, Ω ═ α, μ]Tα, μ is the angle of attack, sideslip angle, roll angle, respectively;derivative representing omegaThe number, ω, represents the system fast loop state variable, ω ═ p, q, r]TP, q, r are roll angle rate, pitch angle rate, yaw rate, respectively; mcIndicating a fast-loop moment, Mc=gfu, wherein gf∈R3×3Is a control plane distribution matrix of a fast loop of an attitude system, u ═ 2e,a,r]TWhereine,a,rThe left elevator auxiliary wing rudder, the right elevator auxiliary wing rudder and the rudder are respectively arranged; f. ofs=[fα,fβ,fμ]T,ff=[fp,fq,fr]T,
Wherein M and V are the mass and the speed of the aircraft respectively; q is dynamic pressure; s, c and b are respectively a reference area, a reference length and a reference width; cL,αCoefficient of lift due to angle of attack α, CY,βIs the sideslip coefficient caused by sideslip angle β, g is the coefficient of gravity of the earth, Cl,β,Cl,p,Cl.rIs the lift coefficient, C, caused by β, p, rm,α,Cm,qFor the basic pitching moment coefficient and the pitching moment coefficient caused by q, CD,αCoefficient of drag, C, due to angle of attack αn,β,Cn,p,Cn,rr is the yaw moment coefficient, X, caused by β, p, rcgThe distance from the center of mass to the center of the reference moment,matrix coefficients are assigned to the fast loops. I isxxIs the product of inertia about the x-axis, IyyIs the product of inertia about the y-axis, IzzIn order to be the product of inertia about the z-axis,is IxxThe derivative of (a) of (b),is IyyThe derivative of (a) of (b),is IzzDerivative of fs,ff,gs,gfAs an attitude system state matrix,/aero,maero,naeroRepresenting three-channel moment;
step 1-2) carrying out coupling analysis on the established attitude system model, decomposing the coupling of the attitude into attitude angular motion coupling, inertia coupling and control surface manipulation coupling,
1) attitude angle coupling model:
in the attitude system model established in the step 1-1), the coupling relation of the attitude angles is described as follows:
whereinRespectively expressed as slow loop state variables attack angle, sideslip angle andattitude angle coupling of roll angle;
2) inertial coupling
In the attitude system model established in the step 1-1), the inertial coupling is described as follows:
wherein f isp,fq,frRepresenting the inertial coupling caused by p, q, r in a fast loop system;
3) control surface steering coupling
In the attitude system model established in the step 1-1), the control surface manipulation coupling is described as follows:
wherein g islFor the roll channel steering coupling, gmFor the pitch channel steering coupling, gnFor the purpose of the yaw-channel coupling,roll moment coefficients caused by the auxiliary wing rudder and the rudder of the right elevator,the pitch moment coefficient caused by the right elevator auxiliary wing rudder,the coefficient of the pitch moment caused by the rudder,the yaw moment coefficient caused by the right elevating auxiliary wing rudder,yaw moment coefficient caused by rudder;
Gf,a matrix is assigned to the control surface,respectively the lateral force coefficient caused by the left elevator, the lateral force coefficient caused by the right elevator aileron and the lateral force coefficient caused by the rudder,the yaw moment coefficient, the pitch moment coefficient, the roll moment coefficient and the resistance coefficient caused by the left elevator, the drag coefficient caused by the right elevator aileron,for the coefficient of resistance caused by the rudder,a lift coefficient is induced for the left elevator,for the coefficient of lift caused by the rudder,for the yaw moment coefficient caused by the right elevator aileron,for the yaw moment coefficient caused by the rudder,matrix parameters are allocated to the control surfaces of the pitch channels,matrix parameters are allocated to the control surfaces of the yaw channel,distributing matrix parameters for the control surface of the rolling channel;
step 1-3) designing a coordination factor;
for 1) attitude angle coupling in step 1-2),setting 0, expressed as psina-rcos α ═ 0, yields r ═ ptan α, and feeds back r ═ ptan α to the rudder loop, so the coordination factor is designed to be 0Wherein k is1The more than 0 is the design parameter,is the first component of the rudder coordination factor;
in the step 1-2), the coupling relation of the attack angle and the roll angle is described as p-sigma r < p ≤ pcos alpha + rsin alpha < p + rhor, and the adjustment factor for feeding beta back to the rudder loop is designed as follows:
where | sina | ≠ Δα,k2,k3A parameter greater than zero is designed for the design,is the second component of the rudder coordination factor;
for the inertial coupling of 2) in the step 1-2), feeding back beta and r to an aileron loop, feeding back beta and q to a rudder loop, and feeding back alpha and p to an elevator loop to increase damping moment and stability moment; the design of the coordination factor is as follows:
wherein λe,λa,Respectively feeding back the corresponding state variables to the coordination factors, k, of the left elevator rudder, the right elevator aileron rudder and the rudder4,k5,k6,k7,k8,k9A design parameter greater than zero;
for the control surface steering coupling of 3) in the step 1-2), the steering coupling degree of the auxiliary wing rudder and the rudder is defined as:
wherein,
wherein,the three-channel moment coefficient change increment coefficient caused by rudder deflection,is a three-channel moment coefficient change increment coefficient, S, caused by the deflection of the right elevon ruddercwr,ScwExpressed as rudder area and vertical fin area; s, L reference area and reference length; y iscwrThe distance between the center of the rudder surface and the longitudinal axis, chi is the sweepback angle, ξ is a correction factor, and S is satisfiedcwr≤S,Scw≤S,ycwrL is more than or equal to L,0 is more than ξ and less than or equal to 1, cos χ is more than 0 and less than or equal to 1, n is the relative execution efficiency of the ailerons, ηk,The ratio of the heel to the tip and the ratio of the stem to the aspect ratio of the exposed wing are respectively;f, slightly comparing the exposed wing with the root; the control surface coordination strategy is designed asa=ErE is more than 0 and less than or equal to 1, and E is the coupling degree of the rudder and the right auxiliary elevator wing rudder.
The specific process of the step 2) comprises the following steps:
step 2-1) introducing uncertain parameter vectors
Representing the system model in the step 1-1) as
Wherein D represents an external disturbance,
θ1=CL,α,θ2=CY,β,θ3=[CY,βCL,α]T,
wherein C isL,α,CY,β,CY,β,CL,α,Cn,β,Cn,p,Cn,r,Cm,α,Cm,q,CD,α,Cl,β,Cl,r,Cl,pIs an aircraft aerodynamic parameter.
Step 2-2) projection mapping algorithm
ΘΩ,ΘωRespectively expressed as uncertain parameter vectors thetaΩ,θωIs expressed as:
ΘΩ={θΩ∈R4|θΩi min≤θΩi≤θΩi max,i=1,…,4},
Θω={θω∈R17|θωi min≤θωi≤θωi max,i=1,…,17}
wherein theta isΩi,θΩi min,θΩi maxIs the component of the slow loop state variable, the minimum value of the component and the maximum value of the component, thetaωi,θωi min,θωi maxThe component of the fast loop state variable, the minimum value of the component and the maximum value of the component are obtained; order toDenoted by thetaΩIs determined by the estimated value of (c),representing the estimation error, thetaωLike thetaΩAccording to the projection mapping algorithm, the self-adaptation law of uncertain parameters is
WhereinFast and slow loop adaptive functions, 0 as diagonal matrix, tau as adaptive function, and projection operatorIs defined as
Whereinθimax,θiminFor the estimated value component of the state variable, the maximum value of the state variable component and the minimum value of the state variable component, it is clear that, for the adaptation function tau,
whereinFor adaptive estimation, θmin,θmaxIn order to estimate the minimum and maximum values,in order to transpose the estimation error,-1is the inverse of the parameter-diagonal matrix,is a design parameter;
step 2-3) design of robust controller of attitude angle
Defining a tracking error e1=Ω-ΩcThe sliding mode function is designed as
Wherein K is diag { K ═ d { (K) }1,K2,K3},KiThe design parameters are expressed more than 0, i is 1,2 and 3, sigma is a sliding mode function, and the first derivative of the sliding mode function is obtained
To obtainIs adaptive toWherein, κ1>0,1∈R4×4,λΩ=diag{λ1,λ2,λ3,λ4With } > 0 as controller parameter, gs,f1Ψ is a system coefficient matrix ΨTIs a transposed matrix of Ψ, e1In order to be an error, the error is,the slow loop tracks the derivative of the instruction,is an estimate of the state variable of the slow loop,the estimation error is a sliding mode function;
step 2-4) design of attitude angular rate controller
Definition error e2=ω-ωcDerived from the error
Virtual controllerSeen as a perturbation, to obtainWhereinΞTThe method is characterized by comprising the following steps of (1) transposing a system matrix of a system fast loop; the attitude angular rate loop control is designed asWhereinIs a fast loop system state matrix gfThe adverse effect of xiTFor transposition of the system matrix, θωIs a fast loop state variable, gfIs a system state matrix, McTo control the torque, D is an external disturbance,derivative of the slow-loop controller, κ2For controlling design parameters, for observingThe output of the device is used for outputting,is a transpose of the matrix of the slow loop state system,defining the observation error by observer estimationIs adaptive to law ofWherein κ2>0,2∈R17×17>0,λω∈R17 ×17The parameter > 0 is the parameter of the controller,to estimate the error, the observer is designed as
Wherein,
q1(e),q2(e),…,qn(e) are observer parameters.
The specific process of the step 3) comprises the following steps:
attitude angular rate loop controller McAnd control plane allocation matrix gfThe coordinated moment is denoted as Mc=gfTherein, wherein
WhereinMatrix parameters are allocated to the control surfaces of the pitch channels,is inclined toThe aeronautical channel control surface is distributed with matrix parameters,assigning a matrix parameter, λ, to the control surface of the roll channele,λa,λrIs a coordination factor; the control plane command is obtained as gf -1·Mc。
When the coordination strategy adopts the auxiliary wing rudder and the rudder to coordinate and deflect to realize yawing moment and rolling moment, the elevator rudder deflects to realize pitching moment, and the control surface coordination design is as follows:
coe=e,coa=Er,cor=r。
the invention has the following beneficial effects:
1. the controller adds the coordination factor, and the performance is better than that of the controller without the coordination factor. The coordination controller has the advantages of reduced vibration times, small tracking overshoot of the attitude angle, stable tracking and corresponding rapidness.
2. The controller adds a coordination factor and the attitude angular rate becomes stable and fast accordingly.
3. The controller adds the coordination factor, the control efficiency of the control surface is effectively improved, particularly the deflection times of the control surface are reduced, and the energy is saved.
Drawings
FIG. 1 is a schematic diagram of an aircraft attitude motion coordination mechanism.
FIG. 2 is a graph of a comparison of the respective simulations of attitude angle with and without a coordination factor, wherein (a) is a comparison of an angle of attack tracking curve, (b) is a comparison of a sideslip tracking curve, and (c) is a comparison of a roll tracking curve.
Fig. 3 is a simulation comparison graph of the attitude angular rate with and without the coordination factor, wherein (a) is a roll angular rate response comparison graph, and (b) is a pitch angular rate response comparison graph. (c) Is a plot of yaw rate response versus.
FIG. 4 is a plot of control plane deflection with and without the addition of a coordination factor versus (a) aileron deflection versus (b) elevator deflection versus (c) rudder deflection versus.
Detailed Description
The invention is described in further detail below with reference to the accompanying drawings.
In FIG. 1, a fast loop torque command M is derived by designing the fast loop control lawcAnd combines with the designed coordination factor (19) to derive coordination moment, and the coordination moment is finally distributed into a control surface coordination command through a fast loop control surface distribution matrixe,a,rAnd finally realizing the coordinated control among the attitude motions of the hypersonic aircraft through the coordinated deflection of the control surface. Fig. 2, fig. 3 and fig. 4 are simulation verifications, and it can be obtained through simulation diagram analysis and comparison that the addition of the coordination factor can effectively improve the control effect of the controller, and has an obvious effect on the inhibition of coupling.
The hypersonic aircraft attitude system model is as follows:
whereinDenotes the derivative of Ω, Ω denotes the system slow loop state variable, Ω ═ α, μ]Tα, μ is the angle of attack, sideslip angle, roll angle, respectively;denotes the derivative of ω, ω denotes the system fast loop state variable, ω ═ p, q, r]TP, q, r are roll angle rate, pitch angle rate, yaw rate, respectively; mcIndicating a fast-loop moment, Mc=gfu, wherein gf∈R3×3Is a control plane distribution matrix of a fast loop of an attitude system, u ═ 2e,a,r]TWhereine,a,rThe left elevator auxiliary wing rudder, the right elevator auxiliary wing rudder and the rudder are respectively arranged; f. ofs=[fα,fβ,fμ]T,ff=[fp,fq,fr]T,
Wherein M and V are the mass and the speed of the aircraft respectively;is dynamic pressure; s, c and b are respectively a reference area, a reference length and a reference width; cL,αCoefficient of lift due to angle of attack α, CY,βIs the sideslip coefficient caused by sideslip angle β, g is the coefficient of gravity of the earth, Cl,β,Cl,p,Cl.rIs the lift coefficient, C, caused by β, p, rm,α,Cm,qFor the basic pitching moment coefficient and the pitching moment coefficient caused by q, CD,αCoefficient of drag, C, due to angle of attack αn,β,Cn,p,Cn,rr is the yaw moment coefficient, X, caused by β, p, rcgThe distance from the center of mass to the center of the reference moment,matrix coefficients are assigned to the fast loops. I isxxIs the product of inertia about the x-axis, IyyIs the product of inertia about the y-axis, IzzIn order to be the product of inertia about the z-axis,is IxxThe derivative of (a) of (b),is IyyThe derivative of (a) of (b),is IzzDerivative of fs,ff,gs,gfAs an attitude system state matrix,/aero,maero,naeroRepresenting three channel moments. As can be seen from the attitude system mathematical model, the attitude motion coupling can be decomposed into attitude angle coupling, inertial coupling and control surface manipulation coupling.
The attitude angle coupling can be described as:
whereinAttitude angle couplings, represented as slow loop state variables, angle of attack, sideslip, and roll angle, respectively.
The inertial coupling can be described as:
wherein f isp,fq,frRepresenting the inertial coupling caused by p, q, r in a fast loop system.
The control surface steering coupling can be described as:
wherein g islFor the roll channel steering coupling, gmFor the pitch channel steering coupling, gnFor the purpose of the yaw-channel coupling,roll moment coefficients caused by the auxiliary wing rudder and the rudder of the right elevator,the pitch moment coefficient caused by the right elevator auxiliary wing rudder,the coefficient of the pitch moment caused by the rudder,the yaw moment coefficient caused by the right elevating auxiliary wing rudder,rudder induced yaw moment coefficient.
Gf,A matrix is assigned to the control surface,respectively the lateral force coefficient caused by the left elevator, the lateral force coefficient caused by the right elevator aileron and the lateral force coefficient caused by the rudder,the yaw moment coefficient, the pitch moment coefficient, the roll moment coefficient and the resistance coefficient caused by the left elevator, the drag coefficient caused by the right elevator aileron,for the coefficient of resistance caused by the rudder,a lift coefficient is induced for the left elevator,for the coefficient of lift caused by the rudder,for the yaw moment coefficient caused by the right elevator aileron,for the yaw moment coefficient caused by the rudder,assigning matrix parameters, g, to the control surfaces of the pitch channelsq,e,gq,a,gq,rMatrix parameters are allocated to the control surfaces of the yaw channel,and distributing matrix parameters to the control surfaces of the rolling channels.
In the formula (7), the rate of change of the side slip angle is made 0, that isCan be set to 0, then
psina-rcosα=0 (12)
It is possible to derive r ═ pta, which is fed back to the rudder loop, so that the coordination factor is designed as
Wherein k is1The more than 0 is the design parameter,the first component of the rudder coordination factor.
The coupling relation of the attack angle and the roll angle can be described as p-sigma r < p ≦ pcos alpha + rsin alpha < p + rho r, and if beta is fed back to the rudder loop, the coordination factor is designed as follows:
where | sina | ≠ Δα,k2,k3A parameter greater than zero is designed for the design,the second component of the rudder coordination factor.
In equation (8), the coordination factor for feeding β, r back to the aileron loop, β, q back to the rudder loop, and α, p back to the elevator loop is designed as:
wherein λe,λa,λr3Respectively feeding back the corresponding state variables to the coordination factors, k, of the left elevator rudder, the right elevator aileron rudder and the rudder4,k5,k6,k7,k8,k9A design parameter greater than zero.
For the rudder surface steering coupling in equation (9), the degree of rudder surface steering coupling to the aileron is defined:
wherein,
wherein,the three-channel moment coefficient change increment coefficient caused by rudder deflection,is a three-channel moment coefficient change increment coefficient, S, caused by the deflection of the right elevon ruddercwr,ScwExpressed as rudder area and vertical fin area; s, L reference area and reference length; y iscwrThe distance between the center of the rudder surface and the longitudinal axis, chi is the sweepback angle, ξ is a correction factor, and S is satisfiedcwr≤S,Scw≤S,ycwrL is more than or equal to L,0 is more than ξ and less than or equal to 1, cos χ is more than 0 and less than or equal to 1, n is the relative execution efficiency of the ailerons, ηk,The ratio of the exposed wing to the tip of the foot, the ratio of the stem to the tip of the foot, and the ratio of the exposed wing to the root of the foot,the control surface coordination strategy is designed as
a=Er,0<E≤1 (18)
And E is the coupling degree of the rudder and the right auxiliary elevator wing rudder. Considering equations (13), (14) and (15), the coordination factor of the attitude motion of the hypersonic aircraft is:
wherein λe,λr,λaThe coordination factors fed back to the left elevator, the rudder and the right auxiliary elevator wing rudder for the corresponding state variables
Introducing uncertain vector vectors, and establishing a posture system model from the following steps:
wherein D represents an external disturbance,
θ1=CL,α,θ2=CY,β,θ3=[CY,βCL,α]T,
wherein C isL,α,CY,β,CY,β,CL,α,Cn,β,Cn,p,Cn,r,Cm,α,Cm,q,CD,α,Cl,β,Cl,r,Cl,pIs an aircraft aerodynamic parameter.
Definition of thetaΩ,ΘωRespectively expressed as uncertain parameter vectors thetaΩ,θωCan be expressed as:
wherein theta isΩi,θΩi min,θΩi maxIs the component of the slow loop state variable, the minimum value of the component and the maximum value of the component, thetaωi,θωi min,θωi maxThe fast loop state variable is a component, a minimum value of the component and a maximum value of the component. Order toDenoted by thetaΩIs determined by the estimated value of (c),representing the estimation error, thetaωLike thetaΩAccording to the projection mapping algorithm, the self-adaptation law of uncertain parameters is
WhereinFast and slow loop adaptive functions, 0 as diagonal matrix, tau as adaptive function, and projection operatorWhereinFor projection operator, define as
Whereinθimax,θiminThe estimated value component of the state variable, the maximum value of the state variable component, and the minimum value of the state variable component. Obviously, for the adaptation function τ
WhereinFor adaptive estimation, θmin,θmaxIn order to estimate the minimum and maximum values,in order to transpose the estimation error,-1τ is the adaptive function for the design parameter, which is the inverse of the parameter diagonal matrix.
Defining a tracking error e1=Ω-ΩcWherein Ω iscFor the attitude angle command signal, the sliding mode function is designed as
Wherein K is diag { K ═ d { (K) }1,K2,K3},KiAnd > 0, i ═ 1,2 and 3, expressed as design parameters, and σ is a sliding mode function. The first derivative of the sliding mode function can be obtained
To obtain
Wherein g iss,f1Ψ is a system coefficient matrix ΨTIs a transposed matrix of Ψ, K is a design parameter matrix, κ1> 0 is a controller parameter, e1In order to be an error, the error is,the slow loop tracks the derivative of the instruction,is an estimated value of a state variable of a slow loop, and the adaptive law of the estimated value is designed as
Wherein1∈R4×4,λΩ=diag{λ1,λ2,λ3,λ4With 0 denotes a design parameter matrix,for estimating the error, as a sliding mode function, Ψ is a slow loop system coefficient matrix. Considering the Lyapunov function
Where σ is a sliding mode function, σTIn order to plan a transposition of the meter function,the slow loop estimation error matrix is transposed,for adaptive design of the inverse matrix of the parameter matrix, the derivation of (30) can be obtained
The combination of (28) and (29) can be obtained
Wherein κ1>0,1∈R4×4,λΩ=diag{λ1,λ2,λ3,λ4With 0 denotes a design parameter matrix,to estimate the error, σ is a sliding-mode function, σTIn order to plan a transposition of the meter function,slow loop estimation error matrix transposition, gs,f1Ψ is a system coefficient matrix ΨTIs a transposed matrix of Ψ, e2Is an error, gsIs a slow loop state system matrix.
Definition error e2=ω-ωc,ωcFor the attitude angular rate command signal, the error is derived
Wherein xiTFor transposition of the system matrix, θωIs a fast loop state variable, gfIs a system state matrix, McTo control the torque, D is an external disturbance,the derivative of the slow loop controller. Virtual controllerSeen as a perturbation, can yieldWherein,the attitude angular rate loop control is designed as
WhereinIs a fast loop system state matrix gfInverse of (a), kappa2In order to control the design parameters of the device,in order to be the output of the observer,the other parameters are consistent with the above for the transpose of the slow loop state system matrix.Defining the observation error by observer estimationIs adaptive to law of
Wherein κ2>0,2∈R17×17>0,λω∈R17×17The more than 0 is the design parameter,to estimate the error.The observer is designed as
Wherein,
q1(e),q2(e),…,qn(e) are observer parameters.
And (3) proving that: the Lyapunov function is considered to be selected as follows
Wherein e is2In order to be an error, the error is,for transposing errors, θωIn order to be a fast-loop state variable,in order to estimate the error, the error is estimated,is composed ofThe transpose of (a) is performed,in order to observe the error, the error is observed,in order to transpose the observation error,for the transpose matrix of the adaptive parameter, the derivative of the Lyapunov function for the time t can be obtained
WhereinFor the derivation of the slow loop Lyapunov function over time t,the error is transposed and the phase of the error is reversed,the derivative of the error is a function of,is composed ofThe transpose of (a) is performed,in order to be a fast-loop adaptation function,to be a transpose of the observed error,the derivative of the observer output is obtained by substituting equations (32), (34) and (35) into equation (38)
Let L (e) ═ c > 1, Q (e) ═ ce, then can obtain
Where c is the observer design parameter, and the other parameters are consistent with the foregoing.
The Lyapunov function is uniformly bounded according to the formula (40), so that the designed control law ensures that the controlled system is uniformly bounded.
The robust coordination control of the attitude motion is to combine an attitude angular rate loop controller M after introducing a coordination factor (19)cAnd control plane allocation matrix gfThe coordination moment is calculated, the coordination moment is distributed into a control plane instruction, coordination is realized through control plane deflection, and the robust coordination control scheme is shown in fig. 1. In FIG. 1, a fast loop torque command M is derived by designing the fast loop control lawcAnd combines with the designed coordination factor (19) to derive coordination moment, and the coordination moment is finally distributed into a control surface coordination command through a fast loop control surface distribution matrixe,a,rAnd finally realizing the coordinated control among the attitude motions of the hypersonic aircraft through the coordinated deflection of the control surface. The coordinated torque may be expressed as
Mc=gf· (41)
Wherein
WhereinMatrix parameters are allocated to the control surfaces of the pitch channels,matrix parameters are allocated to the control surfaces of the yaw channel,assigning a matrix parameter, λ, to the control surface of the roll channele,λa,λrThe coordination factor designed in the foregoing. The control surface command can be obtained
=gf -1·Mc(43)
When the coordination strategy adopts the auxiliary wing rudder and the rudder to coordinate and deflect to realize yaw moment and roll moment, the elevator rudder deflects to realize pitch moment, and the coordination of the control surface can be designed as
coe=e,coa=Er,cor=r(44)
To prove the effectiveness of the controller, we select a hypersonic aircraft attitude system model described by equation (1), and the basic parameters of the model are as follows: m is 54013lb, Ma8, 13398ft/s, 68898ft, 280000 lb. The design parameters are selected as follows: k is a radical ofi=1,i=1…7,K1=K2=K3=4,κ1=κ2The initial condition is set to α for the command signal for the attitude angle, where α is 1 °, β is 5 °, μ is 0 °, and p is q is r is 0 °/sc=5°,βc=0°,μc4 deg. is equal to. The disturbance D is selected from D (t) ([ 0.5sin (1.5t) 0.5cos (2t) 0.5sin (2t)]TThe simulation results are shown in fig. 2, fig. 3 and fig. 4, when the coordination factor (14) is not added in fig. 2- (a), the overshoot of α is 35%, and after the coordination factor (14) is added, the overshoot is 10%, after the coordination factor (14) is added in fig. 2- (b), the overshoot of β is smaller than that of the uncoordinated factor, after the coordination factor is added in the fast loop (15), the jitter amplitude of the tracking curve of fig. 3- (a) p, the tracking curve of 3- (b) q and the tracking curve of 3- (c) r is obviously reduced, the variation range of the attitude angular rate and the jitter amplitude are smaller than those of the response curve under the action of the uncoordinated controller, and the process of the attitude angular rate approaching balance is smoother and faster due to the coordination controller, in fig. 4, the coordination factor (18) is added to improve the control efficiency of the control of the attitude system and the maneuverability of hypersonic aircraft.
Claims (5)
1. A coordinated factor-based hypersonic aircraft attitude motion coordination control method is characterized by comprising the following steps: the method comprises the following steps:
step 1) performing coupling analysis on an attitude model of the hypersonic aircraft, and decomposing a strong coupling problem among attitude motions into three forms of angular motion coupling, inertial coupling and control surface control coupling; based on the three coupling forms, feeding back the corresponding state variable to the corresponding control surface loop design coordination factor;
step 2) decomposing the attitude system into a slow loop and a fast loop based on a time scale separation principle; designing a slow-loop robust controller and a fast-loop robust controller respectively based on a sliding mode method and a projection mapping method;
and 3) combining the coordination factor with a robust controller to derive a coordination moment, distributing the coordination moment into a control plane instruction by using a control plane distribution matrix, and realizing the coordination of the attitude motion by using the coordinated deflection of the control plane.
2. The coordinated factor-based hypersonic aircraft attitude motion coordination control method according to claim 1, characterized in that the specific process of step 1) comprises the following steps:
step 1-1), establishing a mathematical model of a hypersonic aircraft attitude system;
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>f</mi> <mi>s</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>s</mi> </msub> <mi>&omega;</mi> </mtd> </mtr> <mtr> <mtd> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>f</mi> <mi>f</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>f</mi> </msub> <msub> <mi>M</mi> <mi>c</mi> </msub> </mtd> </mtr> </mtable> </mfenced>
whereinDenotes the derivative of Ω, Ω denotes the system slow loop state variable, Ω ═ α, μ]Tα, μ pointsRespectively, an attack angle, a sideslip angle and a roll angle;denotes the derivative of ω, ω denotes the system fast loop state variable, ω ═ p, q, r]TP, q, r are roll angle rate, pitch angle rate, yaw rate, respectively; mcIndicating a fast-loop moment, Mc=gfu, wherein gf∈R3×3Is a control plane distribution matrix of a fast loop of an attitude system, u ═ 2e,a,r]TWhereine,a,rThe left elevator auxiliary wing rudder, the right elevator auxiliary wing rudder and the rudder are respectively arranged; f. ofs=[fα,fβ,fμ]T,ff=[fp,fq,fr]T,
<mrow> <msub> <mi>f</mi> <mi>&alpha;</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <mi>M</mi> <mi>V</mi> <mi> </mi> <mi>cos</mi> <mi>&beta;</mi> </mrow> </mfrac> <mrow> <mo>(</mo> <mo>-</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>L</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> <mo>+</mo> <mi>M</mi> <mi>g</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&gamma;</mi> <mi>cos</mi> <mi>&mu;</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>f</mi> <mi>&beta;</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <mi>M</mi> <mi>V</mi> </mrow> </mfrac> <mrow> <mo>(</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>Y</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <mi>&beta;</mi> <mo>+</mo> <mi>M</mi> <mi>g</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&gamma;</mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&mu;</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>f</mi> <mi>&mu;</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mrow> <mi>M</mi> <mi>V</mi> </mrow> </mfrac> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>Y</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <mi>&beta;</mi> <mi>tan</mi> <mi>&gamma;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&mu;</mi> <mo>+</mo> <mfrac> <mn>1</mn> <mrow> <mi>M</mi> <mi>V</mi> </mrow> </mfrac> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>L</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> </mrow>
<mrow> <mo>(</mo> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&gamma;</mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&mu;</mi> <mo>+</mo> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&beta;</mi> <mo>)</mo> <mo>-</mo> <mfrac> <mi>g</mi> <mi>V</mi> </mfrac> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&gamma;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&mu;</mi> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&beta;</mi> </mrow>
<mrow> <msub> <mi>g</mi> <mi>s</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mo>-</mo> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&alpha;</mi> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&beta;</mi> </mrow> </mtd> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&alpha;</mi> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&beta;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>sin</mi> <mi>&alpha;</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <mi>cos</mi> <mi>&alpha;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mi>cos</mi> <mi>&alpha;</mi> <mi>s</mi> <mi>e</mi> <mi>c</mi> <mi>&beta;</mi> </mrow> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>sin</mi> <mi>&alpha;</mi> <mi>sec</mi> <mi>&beta;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
<mrow> <msub> <mi>f</mi> <mi>p</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mfrac> <mrow> <mo>(</mo> <msub> <mi>l</mi> <mrow> <mi>a</mi> <mi>e</mi> <mi>r</mi> <mi>o</mi> </mrow> </msub> <mo>+</mo> <mo>(</mo> <mrow> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mrow> <mo>)</mo> <mi>q</mi> <mi>r</mi> <mo>-</mo> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> <mi>p</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>f</mi> <mi>q</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mfrac> <mrow> <mo>(</mo> <msub> <mi>m</mi> <mrow> <mi>a</mi> <mi>e</mi> <mi>r</mi> <mi>o</mi> </mrow> </msub> <mo>+</mo> <mo>(</mo> <mrow> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mrow> <mo>)</mo> <mi>p</mi> <mi>r</mi> <mo>-</mo> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> <mi>q</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>f</mi> <mi>r</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mfrac> <mrow> <mo>(</mo> <msub> <mi>n</mi> <mrow> <mi>a</mi> <mi>e</mi> <mi>r</mi> <mi>o</mi> </mrow> </msub> <mo>+</mo> <mo>(</mo> <mrow> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mrow> <mo>)</mo> <mi>p</mi> <mi>q</mi> <mo>-</mo> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> <mi>r</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>g</mi> <mi>f</mi> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>g</mi> <mi>l</mi> <mi>p</mi> </msubsup> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msubsup> <mi>g</mi> <mi>m</mi> <mi>q</mi> </msubsup> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <msubsup> <mi>g</mi> <mi>n</mi> <mi>r</mi> </msubsup> </mtd> </mtr> </mtable> </mfenced> </mrow>
<mrow> <msub> <mi>l</mi> <mrow> <mi>a</mi> <mi>e</mi> <mi>r</mi> <mi>o</mi> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>b</mi> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <mi>&beta;</mi> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>,</mo> <mi>p</mi> </mrow> </msub> <mi>p</mi> <mi>b</mi> <mo>/</mo> <mn>2</mn> <mi>V</mi> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>.</mo> <mi>r</mi> </mrow> </msub> <mi>r</mi> <mi>b</mi> <mo>/</mo> <mn>2</mn> <mi>V</mi> <mo>)</mo> </mrow> <mo>,</mo> </mrow>1
<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>m</mi> <mrow> <mi>a</mi> <mi>e</mi> <mi>r</mi> <mi>o</mi> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>c</mi> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>m</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>m</mi> <mo>,</mo> <mi>q</mi> </mrow> </msub> <mi>q</mi> <mi>c</mi> <mo>/</mo> <mn>2</mn> <mi>V</mi> <mo>)</mo> </mrow> <mo>+</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>D</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> <mi>sin</mi> <mi>&alpha;</mi> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>L</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> <mi>cos</mi> <mi>&alpha;</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> </mtable> <mo>,</mo> </mrow>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>n</mi> <mrow> <mi>a</mi> <mi>e</mi> <mi>r</mi> <mi>o</mi> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>b</mi> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <mi>&beta;</mi> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>p</mi> </mrow> </msub> <mi>p</mi> <mi>b</mi> <mo>/</mo> <mn>2</mn> <mi>V</mi> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>r</mi> </mrow> </msub> <mi>r</mi> <mi>b</mi> <mo>/</mo> <mn>2</mn> <mi>V</mi> <mo>)</mo> </mrow> <mo>+</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>Y</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <mi>&beta;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced>
Wherein M and V are the mass and the speed of the aircraft respectively;is dynamic pressure; s, c and b are respectively a reference area, a reference length and a reference width; cL,αCoefficient of lift due to angle of attack α, CY,βIs the sideslip coefficient caused by sideslip angle β, g is the coefficient of gravity of the earth, Cl,β,Cl,p,Cl.rIs the lift coefficient, C, caused by β, p, rm,α,Cm,qFor the basic pitching moment coefficient and the pitching moment coefficient caused by q, CD,αCoefficient of drag, C, due to angle of attack αn,β,Cn,p,Cn,rr is the yaw moment coefficient, X, caused by β, p, rcgThe distance from the center of mass to the center of the reference moment,distributing matrix coefficients for the fast loop; i isxxIs the product of inertia about the x-axis, IyyIs the product of inertia about the y-axis, IzzIn order to be the product of inertia about the z-axis,is IxxThe derivative of (a) of (b),is IyyThe derivative of (a) of (b),is IzzDerivative of fs,ff,gs,gfAs an attitude system state matrix,/aero,maero,naeroRepresenting three-channel moment;
step 1-2) carrying out coupling analysis on the established attitude system model, decomposing the coupling of the attitude into attitude angular motion coupling, inertia coupling and control surface manipulation coupling,
1) attitude angle coupling model:
in the attitude system model established in the step 1-1), the coupling relation of the attitude angles is described as follows:
<mrow> <mover> <mi>&alpha;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mo>-</mo> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&beta;</mi> <mrow> <mo>(</mo> <mi>p</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&alpha;</mi> <mo>+</mo> <mi>r</mi> <mi> </mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&alpha;</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <mover> <mi>&beta;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mi>p</mi> <mi> </mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&alpha;</mi> <mo>-</mo> <mi>r</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&alpha;</mi> </mrow>
<mrow> <mover> <mi>&mu;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mi>sec</mi> <mi>&beta;</mi> <mrow> <mo>(</mo> <mi>p</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&alpha;</mi> <mo>+</mo> <mi>r</mi> <mi> </mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&alpha;</mi> <mo>)</mo> </mrow> </mrow>
whereinRespectively representing the attitude angle coupling of the state variables of the slow loop, such as the attack angle, the sideslip angle and the roll angle;
2) inertial coupling
In the attitude system model established in the step 1-1), the inertial coupling is described as follows:
<mrow> <msub> <mi>f</mi> <mi>p</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> <mo>)</mo> </mrow> <mi>q</mi> <mi>r</mi> <mo>-</mo> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> <mi>p</mi> </mrow>
<mrow> <msub> <mi>f</mi> <mi>q</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> <mo>)</mo> </mrow> <mi>p</mi> <mi>r</mi> <mo>-</mo> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> <mi>q</mi> </mrow>
<mrow> <msub> <mi>f</mi> <mi>r</mi> </msub> <mo>=</mo> <mrow> <mo>(</mo> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> <mo>)</mo> </mrow> <mi>p</mi> <mi>q</mi> <mo>-</mo> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>x</mi> <mi>z</mi> </mrow> </msub> <mi>p</mi> </mrow>
wherein f isp,fq,frRepresenting the inertial coupling caused by p, q, r in a fast loop system;
3) control surface steering coupling
In the attitude system model established in the step 1-1), the control surface manipulation coupling is described as follows:
<mrow> <msub> <mi>g</mi> <mi>l</mi> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>b</mi> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>g</mi> <mi>m</mi> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>c</mi> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>m</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>m</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mi>g</mi> <mi>n</mi> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>b</mi> <mrow> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>)</mo> </mrow> </mrow>
wherein g islFor the roll channel steering coupling, gmFor the pitch channel steering coupling, gnFor the purpose of the yaw-channel coupling,roll moment coefficients caused by the auxiliary wing rudder and the rudder of the right elevator,the pitch moment coefficient caused by the right elevator auxiliary wing rudder,the coefficient of the pitch moment caused by the rudder,the yaw moment coefficient caused by the right elevating auxiliary wing rudder,yaw moment coefficient caused by rudder;
<mrow> <msub> <mi>G</mi> <mrow> <mi>f</mi> <mo>,</mo> <mi>&delta;</mi> </mrow> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow>
<mrow> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SbC</mi> <mrow> <mi>l</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> </mrow>
<mrow> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SbC</mi> <mrow> <mi>l</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> </mrow>
<mrow> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SbC</mi> <mrow> <mi>l</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> </mrow>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>ScC</mi> <mrow> <mi>m</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>D</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mi>sin</mi> <mi>&alpha;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>L</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mi>cos</mi> <mi>&alpha;</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>ScC</mi> <mrow> <mi>m</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mo>(</mo> <msub> <mi>C</mi> <mrow> <mi>D</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mi>sin</mi> <mi>&alpha;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <msub> <mi>C</mi> <mrow> <mi>L</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mi>cos</mi> <mi>&alpha;</mi> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mrow> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>ScC</mi> <mrow> <mi>m</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>D</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mi>sin</mi> <mi>&alpha;</mi> </mrow>
<mrow> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SbC</mi> <mrow> <mi>n</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>Y</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> </mrow>
<mrow> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SbC</mi> <mrow> <mi>n</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>Y</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> </mrow>
<mrow> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>=</mo> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SbC</mi> <mrow> <mi>n</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msub> <mi>SC</mi> <mrow> <mi>Y</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> </mrow>
Gf,a matrix is assigned to the control surface,respectively a left elevatorThe coefficient of the induced sidestand, the coefficient of the lateral force induced by the right elevator aileron and the coefficient of the lateral force induced by the rudder,the yaw moment coefficient, the pitch moment coefficient, the roll moment coefficient and the resistance coefficient caused by the left elevator, the drag coefficient caused by the right elevator aileron,for the coefficient of resistance caused by the rudder,a lift coefficient is induced for the left elevator,for the coefficient of lift caused by the rudder,for the yaw moment coefficient caused by the right elevator aileron,for the yaw moment coefficient caused by the rudder,assigning matrix parameters, g, to the control surfaces of the pitch channelsq,e,gq,a,gq,rMatrix parameters are allocated to the control surfaces of the yaw channel,for the control surface of the rolling channelMatching matrix parameters;
step 1-3) designing a coordination factor;
for 1) attitude angle coupling in step 1-2),setting 0, expressed as psina-rcos α ═ 0, yields r ═ ptan α, and feeds back r ═ ptan α to the rudder loop, so the coordination factor is designed to be 0Wherein k is1The more than 0 is the design parameter,is the first component of the rudder coordination factor;
in the step 1-2), the coupling relation of the attack angle and the roll angle is described as p-sigma r < p ≤ pcos alpha + rsin alpha < p + rhor, and the adjustment factor for feeding beta back to the rudder loop is designed as follows:
<mrow> <msub> <mi>&lambda;</mi> <msub> <mi>r</mi> <mn>2</mn> </msub> </msub> <mo>=</mo> <msub> <mi>k</mi> <mn>2</mn> </msub> <mi>&beta;</mi> <mo>+</mo> <msub> <mi>k</mi> <mn>3</mn> </msub> <mfrac> <mrow> <mi>p</mi> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mi>cos</mi> <mi>&alpha;</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mi>sin</mi> <mi>&alpha;</mi> <mo>+</mo> <msub> <mi>&Delta;</mi> <mi>&alpha;</mi> </msub> </mrow> </mfrac> </mrow>
where | sina | ≠ Δα,k2,k3A parameter greater than zero is designed for the design,is the second component of the rudder coordination factor;
for the inertial coupling of 2) in the step 1-2), feeding back beta and r to an aileron loop, feeding back beta and q to a rudder loop, and feeding back alpha and p to an elevator loop to increase damping moment and stability moment; the design of the coordination factor is as follows:
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <msub> <mi>&lambda;</mi> <mi>e</mi> </msub> <mo>=</mo> <msub> <mi>k</mi> <mn>4</mn> </msub> <mi>&alpha;</mi> <mo>+</mo> <msub> <mi>k</mi> <mn>5</mn> </msub> <mi>p</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&lambda;</mi> <mi>a</mi> </msub> <mo>=</mo> <msub> <mi>k</mi> <mn>6</mn> </msub> <mi>&beta;</mi> <mo>+</mo> <msub> <mi>k</mi> <mn>7</mn> </msub> <mi>r</mi> </mtd> </mtr> <mtr> <mtd> <msub> <mi>&lambda;</mi> <msub> <mi>r</mi> <mn>3</mn> </msub> </msub> <mo>=</mo> <msub> <mi>k</mi> <mn>8</mn> </msub> <mi>&beta;</mi> <mo>+</mo> <msub> <mi>k</mi> <mn>9</mn> </msub> <mi>q</mi> </mtd> </mtr> </mtable> </mfenced>3
wherein λe,λa,Are respectively in corresponding statesThe variable is fed back to the coordination factor, k, of the left elevator, the right elevator aileron rudder and the rudder4,k5,k6,k7,k8,k9A design parameter greater than zero;
for the control surface steering coupling of 3) in the step 1-2), the steering coupling degree of the auxiliary wing rudder and the rudder is defined as:
<mrow> <mi>E</mi> <mo>=</mo> <mfrac> <msubsup> <mi>C</mi> <mi>x</mi> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </msubsup> <msubsup> <mi>C</mi> <mi>x</mi> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </msubsup> </mfrac> <mo>&times;</mo> <mn>100</mn> <mi>%</mi> </mrow>
wherein,
<mrow> <msubsup> <mi>C</mi> <mi>x</mi> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </msubsup> <mo>=</mo> <mfrac> <mrow> <msub> <mi>S</mi> <mrow> <mi>c</mi> <mi>w</mi> <mi>r</mi> </mrow> </msub> <msub> <mi>S</mi> <mrow> <mi>c</mi> <mi>w</mi> </mrow> </msub> </mrow> <msup> <mi>S</mi> <mn>2</mn> </msup> </mfrac> <mfrac> <msub> <mi>y</mi> <mrow> <mi>c</mi> <mi>w</mi> <mi>r</mi> </mrow> </msub> <mi>L</mi> </mfrac> <mi>&xi;</mi> <mi>cos</mi> <mi>&chi;</mi> </mrow>
<mrow> <msubsup> <mi>C</mi> <mi>x</mi> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </msubsup> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <mo>&lsqb;</mo> <mi>n</mi> <mfrac> <mrow> <mo>(</mo> <msub> <mi>&eta;</mi> <mi>k</mi> </msub> <mo>+</mo> <mn>1</mn> <mo>)</mo> <msup> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mover> <mi>D</mi> <mo>&OverBar;</mo> </mover> <mo>)</mo> </mrow> <mn>2</mn> </msup> </mrow> <mrow> <msub> <mi>&eta;</mi> <mi>k</mi> </msub> <mo>+</mo> <mn>1</mn> <mo>-</mo> <mn>2</mn> <mover> <mi>D</mi> <mo>&OverBar;</mo> </mover> </mrow> </mfrac> <mo>&lsqb;</mo> <mover> <mi>D</mi> <mo>&OverBar;</mo> </mover> <mo>+</mo> <mrow> <mo>(</mo> <mn>1</mn> <mo>-</mo> <mover> <mi>D</mi> <mo>&OverBar;</mo> </mover> <mo>)</mo> </mrow> <mi>f</mi> <mo>&rsqb;</mo> <mo>&rsqb;</mo> </mrow>
wherein,the three-channel moment coefficient change increment coefficient caused by rudder deflection,is a three-channel moment coefficient change increment coefficient, S, caused by the deflection of the right elevon ruddercwr,ScwExpressed as rudder area and vertical fin area; s, L reference area and reference length; y iscwrThe distance between the center of the rudder surface and the longitudinal axis, chi is the sweepback angle, ξ is a correction factor, and S is satisfiedcwr≤S,Scw≤S,ycwrL is more than or equal to L,0 is more than ξ and less than or equal to 1, cos χ is more than 0 and less than or equal to 1, n is the relative execution efficiency of the ailerons, ηk,The ratio of the heel to the tip and the ratio of the stem to the aspect ratio of the exposed wing are respectively;f, slightly comparing the exposed wing with the root; the control surface coordination strategy is designed asa=ErE is more than 0 and less than or equal to 1, and E is the coupling degree of the rudder and the right auxiliary elevator wing rudder.
3. The coordinated control method for the attitude and motion of the hypersonic aircraft based on the coordination factor as claimed in claim 1, wherein the specific process of the step 2) comprises the following steps:
step 2-1) introducing uncertain parameter vectors
Representing the system model in the step 1-1) as
<mrow> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mi>f</mi> <mn>1</mn> </msub> <mo>+</mo> <msup> <mi>&Psi;</mi> <mi>T</mi> </msup> <msub> <mi>&theta;</mi> <mi>&Omega;</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>s</mi> </msub> <mi>&omega;</mi> </mrow>
<mrow> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msup> <mi>&Xi;</mi> <mi>T</mi> </msup> <msub> <mi>&theta;</mi> <mi>&omega;</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>f</mi> </msub> <msub> <mi>M</mi> <mi>c</mi> </msub> <mo>+</mo> <mi>D</mi> </mrow>
Wherein D represents an external disturbance,
<mrow> <msub> <mi>&theta;</mi> <mi>&Omega;</mi> </msub> <mo>=</mo> <msubsup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>&theta;</mi> <mn>1</mn> <mi>T</mi> </msubsup> </mtd> <mtd> <msubsup> <mi>&theta;</mi> <mn>2</mn> <mi>T</mi> </msubsup> </mtd> <mtd> <msubsup> <mi>&theta;</mi> <mn>3</mn> <mi>T</mi> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mrow> <mn>4</mn> <mo>&times;</mo> <mn>1</mn> </mrow> <mi>T</mi> </msubsup> <mo>,</mo> <msub> <mi>&theta;</mi> <mi>&omega;</mi> </msub> <mo>=</mo> <msubsup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msubsup> <mi>&theta;</mi> <mn>4</mn> <mi>T</mi> </msubsup> </mtd> <mtd> <msubsup> <mi>&theta;</mi> <mn>5</mn> <mi>T</mi> </msubsup> </mtd> <mtd> <msubsup> <mi>&theta;</mi> <mn>6</mn> <mi>T</mi> </msubsup> </mtd> </mtr> </mtable> </mfenced> <mrow> <mn>17</mn> <mo>&times;</mo> <mn>1</mn> </mrow> <mi>T</mi> </msubsup> </mrow>
θ1=CL,α,θ2=CY,β,θ3=[CY,βCL,α]T,
<mrow> <msub> <mi>&theta;</mi> <mn>4</mn> </msub> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mrow> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>p</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>n</mi> <mo>,</mo> <mi>r</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>Y</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> <mo>,</mo> </mrow>
<mrow> <msub> <mi>&theta;</mi> <mn>5</mn> </msub> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mrow> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>m</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>m</mi> <mo>,</mo> <mi>q</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>D</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>L</mi> <mo>,</mo> <mi>&alpha;</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> <mo>,</mo> </mrow>
<mrow> <msub> <mi>&theta;</mi> <mn>6</mn> </msub> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <msub> <mi>I</mi> <mrow> <mi>y</mi> <mi>y</mi> </mrow> </msub> <mo>-</mo> <msub> <mi>I</mi> <mrow> <mi>z</mi> <mi>z</mi> </mrow> </msub> </mrow> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mover> <mi>I</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>,</mo> <mi>&beta;</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>,</mo> <mi>p</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mfrac> </mtd> <mtd> <mfrac> <msub> <mi>C</mi> <mrow> <mi>l</mi> <mo>,</mo> <mi>r</mi> </mrow> </msub> <msub> <mi>I</mi> <mrow> <mi>x</mi> <mi>x</mi> </mrow> </msub> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> <mo>,</mo> </mrow>
<mrow> <mi>&Psi;</mi> <mo>=</mo> <msub> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&Psi;</mi> <mn>1</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <msub> <mi>&psi;</mi> <mn>2</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>2</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>2</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>&Psi;</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mrow> <mn>4</mn> <mo>&times;</mo> <mn>3</mn> </mrow> </msub> <mo>,</mo> <mi>&Xi;</mi> <mo>=</mo> <msub> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>&Xi;</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>5</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>5</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>6</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>&Xi;</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>6</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mn>0</mn> <mrow> <mn>6</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mn>0</mn> <mrow> <mn>6</mn> <mo>&times;</mo> <mn>1</mn> </mrow> </msub> </mtd> <mtd> <msub> <mi>&Xi;</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> <mrow> <mn>17</mn> <mo>&times;</mo> <mn>3</mn> </mrow> </msub> </mrow>
<mrow> <msub> <mi>&Psi;</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> </mrow> <mrow> <mi>M</mi> <mi>V</mi> <mi> </mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&beta;</mi> </mrow> </mfrac> <mo>,</mo> <msub> <mi>&Psi;</mi> <mn>2</mn> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>&beta;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&beta;</mi> </mrow> <mrow> <mi>M</mi> <mi>V</mi> </mrow> </mfrac> <mo>,</mo> </mrow>4
<mrow> <msub> <mi>&Psi;</mi> <mn>3</mn> </msub> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>&beta;</mi> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&gamma;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&mu;</mi> <mi>c</mi> <mi>o</mi> <mi>s</mi> <mi>&beta;</mi> </mrow> <mrow> <mi>M</mi> <mi>V</mi> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mrow> <mo>(</mo> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&gamma;</mi> <mi>s</mi> <mi>i</mi> <mi>n</mi> <mi>&mu;</mi> <mo>+</mo> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mi>&beta;</mi> <mo>)</mo> </mrow> </mrow> <mrow> <mi>M</mi> <mi>V</mi> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> </mrow>
<mrow> <msub> <mi>&Xi;</mi> <mn>1</mn> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>q</mi> <mi>r</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>p</mi> </mrow> </mtd> <mtd> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>b</mi> <mi>&beta;</mi> </mrow> </mtd> <mtd> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msup> <mi>Sb</mi> <mn>2</mn> </msup> <mi>p</mi> </mrow> <mrow> <mn>2</mn> <mi>V</mi> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msup> <mi>Sb</mi> <mn>2</mn> </msup> <mi>r</mi> </mrow> <mrow> <mn>2</mn> <mi>V</mi> </mrow> </mfrac> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> <mo>,</mo> </mrow>
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>&Xi;</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>&lsqb;</mo> <mtable> <mtr> <mtd> <mrow> <mi>p</mi> <mi>r</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>q</mi> </mrow> </mtd> <mtd> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>c</mi> </mrow> </mtd> </mtr> </mtable> </mrow> </mtd> </mtr> <mtr> <mtd> <mtable> <mtr> <mtd> <mfrac> <mrow> <msup> <mi>qSc</mi> <mn>2</mn> </msup> <mi>q</mi> </mrow> <mrow> <mn>2</mn> <mi>V</mi> </mrow> </mfrac> </mtd> <mtd> <mrow> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi> </mi> <mi>sin</mi> <mi>&alpha;</mi> </mrow> </mtd> <mtd> <mrow> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi> </mi> <mi>cos</mi> <mi>&alpha;</mi> <msup> <mo>&rsqb;</mo> <mi>T</mi> </msup> </mrow> </mtd> </mtr> </mtable> </mtd> </mtr> </mtable> </mfenced>
<mrow> <msub> <mi>&Xi;</mi> <mn>3</mn> </msub> <mrow> <mo>(</mo> <mi>x</mi> <mo>)</mo> </mrow> <mo>=</mo> <msup> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <mi>p</mi> <mi>q</mi> </mrow> </mtd> <mtd> <mrow> <mo>-</mo> <mi>r</mi> </mrow> </mtd> <mtd> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>b</mi> <mi>&beta;</mi> </mrow> </mtd> <mtd> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msup> <mi>Sb</mi> <mn>2</mn> </msup> <mi>p</mi> </mrow> <mrow> <mn>2</mn> <mi>V</mi> </mrow> </mfrac> </mtd> <mtd> <mfrac> <mrow> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <msup> <mi>Sb</mi> <mn>2</mn> </msup> <mi>r</mi> </mrow> <mrow> <mn>2</mn> <mi>V</mi> </mrow> </mfrac> </mtd> <mtd> <mrow> <msub> <mi>X</mi> <mrow> <mi>c</mi> <mi>g</mi> </mrow> </msub> <mover> <mi>q</mi> <mo>&OverBar;</mo> </mover> <mi>S</mi> <mi>&beta;</mi> </mrow> </mtd> </mtr> </mtable> </mfenced> <mi>T</mi> </msup> </mrow>
<mrow> <msub> <mi>f</mi> <mn>1</mn> </msub> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mfrac> <mrow> <mi>g</mi> <mi> </mi> <mi>cos</mi> <mi>&gamma;</mi> <mi>cos</mi> <mi> </mi> <mi>u</mi> </mrow> <mrow> <mi>V</mi> <mi> </mi> <mi>cos</mi> <mi>&beta;</mi> </mrow> </mfrac> </mtd> </mtr> <mtr> <mtd> <mfrac> <mrow> <mi>g</mi> <mi> </mi> <mi>cos</mi> <mi>&gamma;</mi> <mi>sin</mi> <mi> </mi> <mi>u</mi> </mrow> <mi>V</mi> </mfrac> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mfrac> <mrow> <mi>g</mi> <mi> </mi> <mi>cos</mi> <mi>&gamma;</mi> <mi>cos</mi> <mi> </mi> <mi>u</mi> <mi> </mi> <mi>tan</mi> <mi>&beta;</mi> </mrow> <mi>V</mi> </mfrac> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow>
wherein C isL,α,CY,β,CY,β,CL,α,Cn,β,Cn,p,Cn,r,Cm,α,Cm,q,CD,α,Cl,β,Cl,r,Cl,pIs an aircraft aerodynamic parameter;
step 2-2) projection mapping algorithm
ΘΩ,ΘωRespectively expressed as uncertain parameter vectors thetaΩ,θωIs expressed as:
ΘΩ={θΩ∈R4|θΩi min≤θΩi≤θΩi max,i=1,…,4},
Θω={θω∈R17|θωimin≤θωi≤θωimax,i=1,…,17}
wherein theta isΩi,θΩi min,θΩi maxIs the component of the slow loop state variable, the minimum value of the component and the maximum value of the component, thetaωi,θωi min,θωi maxThe component of the fast loop state variable, the minimum value of the component and the maximum value of the component are obtained; order toDenoted by thetaΩIs determined by the estimated value of (c),representing the estimation error, thetaωLike thetaΩAccording to the projection mapping algorithm, the self-adaptation law of uncertain parameters is
<mrow> <msub> <mover> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>&CenterDot;</mo> </mover> <mi>&Omega;</mi> </msub> <mo>=</mo> <msub> <mi>Proj</mi> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> </msub> <mrow> <mo>(</mo> <mi>&Gamma;</mi> <mi>&tau;</mi> <mo>)</mo> </mrow> </mrow>
<mrow> <msub> <mover> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>&CenterDot;</mo> </mover> <mi>&omega;</mi> </msub> <mo>=</mo> <msub> <mi>Proj</mi> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> </msub> <mrow> <mo>(</mo> <mi>&Gamma;</mi> <mi>&tau;</mi> <mo>)</mo> </mrow> </mrow>
Wherein Fast and slow loop adaptive functions, 0 as diagonal matrix, tau as adaptive function, and projection operatorIs defined as
Whereinθimax,θiminIs the estimated value component of the state variable, the most of the state variable componentsThe large value and the minimum value of the state variable component are, obviously, for the adaptation function tau,
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <msub> <mi>P</mi> <mn>1</mn> </msub> </mtd> <mtd> <mrow> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>&Subset;</mo> <mi>&Theta;</mi> <mo>=</mo> <mo>{</mo> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>|</mo> <msub> <mi>&theta;</mi> <mrow> <mi>m</mi> <mi>i</mi> <mi>n</mi> </mrow> </msub> <mo>&le;</mo> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mo>&le;</mo> <msub> <mi>&theta;</mi> <mrow> <mi>m</mi> <mi>a</mi> <mi>x</mi> </mrow> </msub> <mo>}</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
<mrow> <mtable> <mtr> <mtd> <msub> <mi>P</mi> <mn>2</mn> </msub> </mtd> <mtd> <mrow> <msup> <mover> <mi>&theta;</mi> <mo>~</mo> </mover> <mi>T</mi> </msup> <mrow> <mo>(</mo> <msup> <mi>&Gamma;</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <msub> <mi>Proj</mi> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> </msub> <mo>(</mo> <mrow> <mi>&Gamma;</mi> <mi>&tau;</mi> </mrow> <mo>)</mo> <mo>-</mo> <mi>&tau;</mi> <mo>)</mo> </mrow> <mo>&le;</mo> <mn>0</mn> <mo>,</mo> <mo>&ForAll;</mo> <mi>&tau;</mi> </mrow> </mtd> </mtr> </mtable> <mo>.</mo> </mrow>
whereinFor adaptive estimation, θmin,θmaxIn order to estimate the minimum and maximum values,in order to transpose the estimation error,-1is the inverse of the parameter diagonal matrix, is the design parameter;
step 2-3) design of robust controller of attitude angle
Defining a tracking error e1=Ω-ΩcThe sliding mode function is designed as
<mrow> <mi>&sigma;</mi> <mo>=</mo> <msub> <mi>e</mi> <mn>1</mn> </msub> <mo>+</mo> <mi>K</mi> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <msub> <mi>e</mi> <mn>1</mn> </msub> <mi>d</mi> <mi>t</mi> </mrow>
Wherein K is diag { K ═ d { (K) }1,K2,K3},Ki> 0, i-1, 2,3, denotesDesigning parameters, wherein sigma is a sliding mode function, and solving a first derivative of the sliding mode function to obtain
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>&sigma;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <msub> <mover> <mi>e</mi> <mo>&CenterDot;</mo> </mover> <mn>1</mn> </msub> <mo>+</mo> <msub> <mi>Ke</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <msub> <mi>f</mi> <mn>1</mn> </msub> <mo>+</mo> <msup> <mi>&Psi;</mi> <mi>T</mi> </msup> <msub> <mi>&theta;</mi> <mi>&Omega;</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>s</mi> </msub> <mi>&omega;</mi> <mo>-</mo> <msub> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>c</mi> </msub> <mo>+</mo> <msub> <mi>Ke</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <msub> <mi>f</mi> <mn>1</mn> </msub> <mo>+</mo> <msup> <mi>&Psi;</mi> <mi>T</mi> </msup> <msub> <mi>&theta;</mi> <mi>&Omega;</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>s</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mn>2</mn> </msub> <mo>+</mo> <msub> <mi>&omega;</mi> <mi>c</mi> </msub> <mo>)</mo> </mrow> <mo>-</mo> <msub> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>c</mi> </msub> <mo>+</mo> <msub> <mi>Ke</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced>
To obtain Is adaptive toWherein, κ1>0,1∈R4×4,λΩ=diag{λ1,λ2,λ3,λ4With } > 0 as controller parameter, gs,f1Ψ is a system coefficient matrix ΨTIs a transposed matrix of Ψ, e1In order to be an error, the error is,the slow loop tracks the derivative of the instruction,is an estimate of the state variable of the slow loop,to estimateError is counted and is a sliding mode function;
step 2-4) design of attitude angular rate controller
Definition error e2=ω-ωcDerived from the error
<mrow> <msub> <mover> <mi>e</mi> <mo>&CenterDot;</mo> </mover> <mn>2</mn> </msub> <mo>=</mo> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>-</mo> <msub> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>c</mi> </msub> <mo>=</mo> <msup> <mi>&Xi;</mi> <mi>T</mi> </msup> <msub> <mi>&theta;</mi> <mi>&omega;</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>f</mi> </msub> <msub> <mi>M</mi> <mi>c</mi> </msub> <mo>+</mo> <mi>D</mi> <mo>-</mo> <msub> <mover> <mi>&omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>c</mi> </msub> </mrow>
Virtual controllerSeen as a perturbation, to obtainWhereinΞTThe method is characterized by comprising the following steps of (1) transposing a system matrix of a system fast loop; the attitude angular rate loop control is designed asWhereinIs a fast loop system state matrix gfThe adverse effect of xiTFor transposition of the system matrix, θωIs a fast loop state variable, gfIs a system state matrix, McTo control the torque, D is an external disturbance,derivative of the slow-loop controller, κ2For controlling design parameters, for observingThe output of the device is used for outputting,is a transpose of the matrix of the slow loop state system,defining the observation error by observer estimation Is adaptive to law ofWherein κ2>0,2∈R17×17>0,λω∈R17×17The parameter > 0 is the parameter of the controller,to estimate the error, the observer is designed as
<mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mrow> <mover> <mi>d</mi> <mo>^</mo> </mover> <mo>=</mo> <mi>z</mi> <mo>+</mo> <mi>Q</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>)</mo> </mrow> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>z</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mo>=</mo> <mo>-</mo> <mi>L</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>)</mo> </mrow> <mi>z</mi> <mo>-</mo> <mi>L</mi> <mrow> <mo>(</mo> <mi>e</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msup> <mi>&Xi;</mi> <mi>T</mi> </msup> <msub> <mover> <mi>&theta;</mi> <mo>^</mo> </mover> <mi>&omega;</mi> </msub> <mo>+</mo> <msub> <mi>g</mi> <mi>f</mi> </msub> <mi>M</mi> <mo>+</mo> <mi>Q</mi> <mo>(</mo> <mi>e</mi> <mo>)</mo> </mrow> <mo>)</mo> </mrow> </mtd> </mtr> </mtable> </mfenced>
Wherein,
q1(e),q2(e),...,qn(e) are observer parameters.
4. The coordinated factor-based hypersonic aircraft attitude and motion coordination control method according to claim 1, characterized in that the specific process of the step 3) comprises the following steps:
attitude angular rate loop controller McAnd control plane allocation matrix gfThe coordinated moment is denoted as Mc=gfTherein, wherein
<mfenced open = "" close = ""> <mtable> <mtr> <mtd> <mrow> <msub> <mi>g</mi> <mrow> <mi>&Gamma;</mi> <mi>f</mi> <mi>&delta;</mi> </mrow> </msub> <mo>=</mo> <msub> <mi>g</mi> <mrow> <mi>f</mi> <mi>&delta;</mi> </mrow> </msub> <mo>+</mo> <mi>&Gamma;</mi> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mrow> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>&lambda;</mi> <mi>e</mi> </msub> </mrow> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>p</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <mi>&delta;</mi> <mi>e</mi> </mrow> </msub> </mtd> <mtd> <mrow> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <mi>&delta;</mi> <mi>a</mi> </mrow> </msub> <mo>+</mo> <msub> <mi>&lambda;</mi> <mi>a</mi> </msub> </mrow> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>q</mi> <mo>,</mo> <mi>&delta;</mi> <mi>r</mi> </mrow> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>e</mi> </msub> </mrow> </msub> </mtd> <mtd> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>a</mi> </msub> </mrow> </msub> </mtd> <mtd> <mrow> <msub> <mi>g</mi> <mrow> <mi>r</mi> <mo>,</mo> <msub> <mi>&delta;</mi> <mi>r</mi> </msub> </mrow> </msub> <mo>+</mo> <msub> <mi>&lambda;</mi> <mi>r</mi> </msub> </mrow> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> </mtable> </mfenced>
WhereinAssigning matrix parameters, g, to the control surfaces of the pitch channelsq,e,gq,a,gq,rMatrix parameters are allocated to the control surfaces of the yaw channel,assigning a matrix parameter, λ, to the control surface of the roll channele,λa,λrIs a coordination factor; the control plane command is obtained as gf -1·Mc。
5. The coordinated control method for the attitude motion of the hypersonic aerocraft based on the coordination factor as claimed in claim 4, wherein when the coordination strategy adopts the auxiliary wing rudder and the rudder to coordinate and deflect to realize the yaw moment and the roll moment, the elevator rudder deflects to realize the pitch moment, the control plane coordination design is as follows:
coe=e,coa=Er,cor=r。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710514169.2A CN107272719B (en) | 2017-06-29 | 2017-06-29 | Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710514169.2A CN107272719B (en) | 2017-06-29 | 2017-06-29 | Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107272719A true CN107272719A (en) | 2017-10-20 |
CN107272719B CN107272719B (en) | 2019-09-20 |
Family
ID=60070864
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710514169.2A Active CN107272719B (en) | 2017-06-29 | 2017-06-29 | Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107272719B (en) |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110007683A (en) * | 2019-03-13 | 2019-07-12 | 成都飞机工业(集团)有限责任公司 | A kind of control method of the anti-cross wind landing of low aspect ratio all-wing aircraft unmanned plane |
CN111176325A (en) * | 2020-01-06 | 2020-05-19 | 南京航空航天大学 | Air-breathing hypersonic unmanned aerial vehicle coordinated region analysis method |
CN111290421A (en) * | 2020-03-20 | 2020-06-16 | 湖南云顶智能科技有限公司 | Hypersonic aircraft attitude control method considering input saturation |
CN111427267A (en) * | 2020-04-01 | 2020-07-17 | 山东创惠电子科技有限责任公司 | High-speed aircraft attack angle tracking method adopting force and moment adaptive estimation |
CN114003053A (en) * | 2021-11-02 | 2022-02-01 | 东南大学 | Fixed wing unmanned aerial vehicle autopilot adaptive control system based on ArduPilot |
CN114281092A (en) * | 2021-12-23 | 2022-04-05 | 北京航空航天大学 | Hypersonic aircraft coordination attitude control method based on sliding mode disturbance observer |
CN114408162A (en) * | 2022-01-26 | 2022-04-29 | 沃飞长空科技(成都)有限公司 | Control surface reconstruction method and system and readable storage medium |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103425135A (en) * | 2013-07-30 | 2013-12-04 | 南京航空航天大学 | Near space vehicle robust control method with input saturation |
CN103853157A (en) * | 2014-03-19 | 2014-06-11 | 湖北蔚蓝国际航空学校有限公司 | Aircraft attitude control method based on self-adaptive sliding mode |
CN104155983A (en) * | 2014-08-08 | 2014-11-19 | 北京航天自动控制研究所 | Crosslinking impact assessment method for aerodynamic coupling property between aircraft attitude movement channels |
CN106406096A (en) * | 2016-10-26 | 2017-02-15 | 北京航空航天大学 | Coupling utilization coordination control method suitable for transversal and lateral maneuvering of aircraft |
-
2017
- 2017-06-29 CN CN201710514169.2A patent/CN107272719B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103425135A (en) * | 2013-07-30 | 2013-12-04 | 南京航空航天大学 | Near space vehicle robust control method with input saturation |
CN103853157A (en) * | 2014-03-19 | 2014-06-11 | 湖北蔚蓝国际航空学校有限公司 | Aircraft attitude control method based on self-adaptive sliding mode |
CN104155983A (en) * | 2014-08-08 | 2014-11-19 | 北京航天自动控制研究所 | Crosslinking impact assessment method for aerodynamic coupling property between aircraft attitude movement channels |
CN106406096A (en) * | 2016-10-26 | 2017-02-15 | 北京航空航天大学 | Coupling utilization coordination control method suitable for transversal and lateral maneuvering of aircraft |
Non-Patent Citations (2)
Title |
---|
程路: "近空间飞行器鲁棒自适应协调控制研究", 《信息科技辑》 * |
鲍文等: "高超声速飞行器/超燃冲压发动机一体化协调控制方法研究", 《第三届高超声速科技学术会议》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110007683A (en) * | 2019-03-13 | 2019-07-12 | 成都飞机工业(集团)有限责任公司 | A kind of control method of the anti-cross wind landing of low aspect ratio all-wing aircraft unmanned plane |
CN110007683B (en) * | 2019-03-13 | 2022-07-15 | 成都飞机工业(集团)有限责任公司 | Control method for anti-crosswind landing of small-aspect-ratio flying-wing unmanned aerial vehicle |
CN111176325A (en) * | 2020-01-06 | 2020-05-19 | 南京航空航天大学 | Air-breathing hypersonic unmanned aerial vehicle coordinated region analysis method |
CN111176325B (en) * | 2020-01-06 | 2021-05-28 | 南京航空航天大学 | Air-breathing hypersonic unmanned aerial vehicle coordinated region analysis method |
CN111290421A (en) * | 2020-03-20 | 2020-06-16 | 湖南云顶智能科技有限公司 | Hypersonic aircraft attitude control method considering input saturation |
CN111427267A (en) * | 2020-04-01 | 2020-07-17 | 山东创惠电子科技有限责任公司 | High-speed aircraft attack angle tracking method adopting force and moment adaptive estimation |
CN111427267B (en) * | 2020-04-01 | 2022-08-30 | 山东创惠电子科技有限责任公司 | High-speed aircraft attack angle tracking method adopting force and moment adaptive estimation |
CN114003053A (en) * | 2021-11-02 | 2022-02-01 | 东南大学 | Fixed wing unmanned aerial vehicle autopilot adaptive control system based on ArduPilot |
CN114003053B (en) * | 2021-11-02 | 2023-12-01 | 东南大学 | Fixed wing unmanned aerial vehicle autopilot self-adaptive control system based on ArduPilot |
CN114281092A (en) * | 2021-12-23 | 2022-04-05 | 北京航空航天大学 | Hypersonic aircraft coordination attitude control method based on sliding mode disturbance observer |
CN114408162A (en) * | 2022-01-26 | 2022-04-29 | 沃飞长空科技(成都)有限公司 | Control surface reconstruction method and system and readable storage medium |
CN114408162B (en) * | 2022-01-26 | 2023-07-28 | 四川傲势科技有限公司 | Control surface reconstruction method, control surface reconstruction system and readable storage medium |
Also Published As
Publication number | Publication date |
---|---|
CN107272719B (en) | 2019-09-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107272719B (en) | Hypersonic aircraft attitude motion control method for coordinating based on coordinating factor | |
CN110928310B (en) | Unmanned ship navigation following fixed time formation control method | |
CN108710303B (en) | Spacecraft relative attitude control method containing multi-source disturbance and actuator saturation | |
CN110347170B (en) | Reusable carrier reentry segment robust fault-tolerant guidance control system and working method | |
CN109782795B (en) | Transverse control method and control system for coupled surface-symmetric hypersonic aircraft | |
Liu et al. | Output feedback control for aircraft at high angle of attack based upon fixed-time extended state observer | |
CN102880060B (en) | Self-adaptive index time varying slip form posture control method of reentry flight vehicle | |
CN105278545A (en) | Active-disturbance-rejection trajectory linearization control method suitable for hypersonic velocity maneuvering flight | |
CN103913991A (en) | High-speed axisymmetric aircraft composite control method | |
CN105334735A (en) | Flying wing layout unmanned aerial vehicle control law based on angular rate | |
CN104589349A (en) | Combination automatic control method with single-joint manipulator under mixed suspension microgravity environments | |
CN107491088B (en) | Airship track control method with saturated input | |
CN105912009A (en) | Four-rotor aircraft control method based on pole allocation and fuzzy active disturbance rejection control technology | |
CN106406325A (en) | Feedback linearization control method of quad-rotor unmanned aerial vehicle based on fuzzy extended state observer | |
CN105116914B (en) | A kind of stratospheric airship analytic modell analytical model predicted path tracking and controlling method | |
CN104331084A (en) | Pneumatic rudder deflection range calculation method based on direction rudder roll control strategy | |
CN111290278B (en) | Hypersonic aircraft robust attitude control method based on prediction sliding mode | |
Lee et al. | Multi-input noncertainty-equivalent adaptive control of an aeroelastic system | |
Wang et al. | Three-dimensional integrated guidance and control with input saturation and impact angle constraints | |
Dai et al. | Asymmetric integral barrier Lyapunov function-based dynamic surface control of a state-constrained morphing waverider with anti-saturation compensator | |
CN105182990A (en) | Robust control method of three-DOF model helicopter with output limits | |
CN111007877A (en) | Global robust self-adaptive trajectory tracking control method of four-rotor aircraft | |
Yamasaki et al. | Integrated guidance and autopilot for a path-following UAV via high-order sliding modes | |
CN116088311A (en) | Unmanned helicopter second-order uncertain sliding mode control method based on adaptive neural network extended state observer | |
Prach et al. | Development of a state dependent riccati equation based tracking flight controller for an unmanned aircraft |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |