CN104267733B - Based on the appearance control formula direct lateral force gentle Power compound missile attitude control method mixing PREDICTIVE CONTROL - Google Patents
Based on the appearance control formula direct lateral force gentle Power compound missile attitude control method mixing PREDICTIVE CONTROL Download PDFInfo
- Publication number
- CN104267733B CN104267733B CN201410578127.1A CN201410578127A CN104267733B CN 104267733 B CN104267733 B CN 104267733B CN 201410578127 A CN201410578127 A CN 201410578127A CN 104267733 B CN104267733 B CN 104267733B
- Authority
- CN
- China
- Prior art keywords
- delta
- alpha
- missile
- omega
- attitude control
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 42
- 150000001875 compounds Chemical class 0.000 title abstract 3
- PXFBZOLANLWPMH-UHFFFAOYSA-N 16-Epiaffinine Natural products C1C(C2=CC=CC=C2N2)=C2C(=O)CC2C(=CC)CN(C)C1C2CO PXFBZOLANLWPMH-UHFFFAOYSA-N 0.000 claims abstract description 20
- 238000005312 nonlinear dynamic Methods 0.000 claims abstract description 6
- 239000002131 composite material Substances 0.000 claims description 47
- 230000008569 process Effects 0.000 claims description 13
- 230000003321 amplification Effects 0.000 claims description 12
- 238000003199 nucleic acid amplification method Methods 0.000 claims description 12
- 238000005457 optimization Methods 0.000 claims description 7
- 238000013016 damping Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 6
- 230000000694 effects Effects 0.000 claims description 5
- 238000005192 partition Methods 0.000 claims description 5
- 239000013598 vector Substances 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000003068 static effect Effects 0.000 claims description 3
- 238000005070 sampling Methods 0.000 claims description 2
- 238000010276 construction Methods 0.000 claims 1
- 238000004458 analytical method Methods 0.000 abstract description 2
- 230000004044 response Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 239000000446 fuel Substances 0.000 description 2
- 238000000418 atomic force spectrum Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000000638 solvent extraction Methods 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Based on mixing the appearance control formula direct lateral force gentle Power compound missile attitude control method of PREDICTIVE CONTROL, belong to flying vehicles control field.The present invention solves existing Methods of Attitude Control Design cannot solve model nonlinear and the problem controlling input hybrid characters simultaneously.Technical key point is: sets up the direct lateral force gentle Power compound complete Attitude control model of guided missile and direct lateral force model, and by the analysis to aerodynamic characteristic, non-linear dynamic model is converted into piecewise affine model;Utilize the equivalence of piecewise affine model and mixed logical dynamics, and consider to control the hybrid characters of input, establish complex controll guided missile mixed logical dynamics;Based on mixed logical dynamics, design explicit model Predictive control law, determine that pneumatic rudder control law and attitude control engine open rule.The inventive method is applicable to aircraft guidance control field.
Description
Technical Field
The invention relates to an attitude control type direct lateral force and aerodynamic force composite missile attitude control method, in particular to a composite missile attitude control method based on hybrid predictive control, and belongs to the field of aircraft control.
Background
With the enhancement of the maneuvering capability of the target, the missile is required to have a faster overload response speed in order to realize effective interception of the target. The traditional pure aerodynamic control missile is limited by the overload response speed, so that the requirement for accurately intercepting a high maneuvering target cannot be met. The adoption of a direct lateral force and aerodynamic force composite control technology is an effective way for improving the overload response speed of the missile, but the introduction of the direct lateral force increases the design difficulty of a missile guidance control system and is mainly embodied in the following two aspects: firstly, the direct lateral force and aerodynamic force generate complex coupling, so that the nonlinearity and uncertainty of a missile dynamics model are increased; and secondly, the discrete characteristic of direct lateral force enables the control design model to have obvious hybrid characteristic. The two points bring new challenges to missile attitude control design, and the traditional attitude control design method does not solve the two problems at the same time. At present, a two-step method is mostly adopted for the attitude control design of the direct lateral force and aerodynamic force composite missile, firstly, a nonlinear attitude control law is designed by utilizing a nonlinear control method to obtain a control moment instruction; and then, selecting a certain performance index, and obtaining an aerodynamic moment instruction and a direct lateral force moment instruction through optimization solution, so as to realize instruction distribution of aerodynamic force and direct lateral force. The method has poor control effect and limited application range because the difference of direct lateral force and aerodynamic dynamic characteristics is difficult to consider.
Disclosure of Invention
The invention aims to provide an attitude control type direct lateral force and aerodynamic force composite missile attitude control method to solve the problem that the existing attitude control design method cannot simultaneously solve model nonlinearity and control input mixed characteristics. The technical scheme adopted by the invention for solving the technical problems is as follows:
the attitude control type direct lateral force and aerodynamic force composite missile attitude control method based on hybrid predictive control is realized according to the following steps:
establishing a direct lateral force and aerodynamic force composite missile complete attitude control model and a direct lateral force model, deducing an expression of a direct lateral force in a pitching direction, and converting a missile nonlinear dynamics model into a piecewise affine model;
the process of the established direct lateral force and aerodynamic force composite missile complete attitude control model is as follows:
the gravity and aerodynamic force borne by the missile are respectively expressed on a trajectory coordinate system, and the dynamic equation of the missile mass center motion is obtained as follows
Wherein m is missile mass, P is missile tail main engine thrust, g is gravitational acceleration, and Xa、YaAnd ZaThe missile is characterized in that the missile is subjected to three components of aerodynamic force on a speed coordinate system, namely resistance, lift force and lateral force, the positive directions of the three components are respectively consistent with the positive directions of three axes of the speed coordinate system, V represents the movement speed of the missile mass center, α represents an attack angle and a sideslip angle respectively, and theta, psivBallistic dip and ballistic declination, gamma, respectivelyvIs a velocity ramp angle;the three components of the direct lateral force borne by the missile on a trajectory coordinate system;
assuming that the projectile coordinate system coincides with the main axis of inertia of the projectile, i.e. Jxy=Jyz=JzxThe kinetic equation of the missile rotating around the center of mass in the missile coordinate system is obtained as follows
Wherein Jx、JyAnd JzAre respectively the rotational inertia omega of the missile to the three axes of the missile coordinate systemx,ωy,ωzThe components of the rotating angular velocity omega of the projectile coordinate system relative to the ground coordinate system on three axes of the projectile coordinate system, Mx、MyAnd MzThe components of the moments of all external forces acting on the missile to the mass center on each axis of the missile coordinate system are respectively; mx、MyAnd MzIs shown as
In the formula Mex、MeyAnd MezAre respectively the components of the aerodynamic moment acting on the missile on each axis of a missile coordinate system,the components of the direct lateral moment acting on the missile on each axis of the missile coordinate system are respectively;
the direct lateral force resultant force and resultant moment generated by simultaneously igniting a plurality of attitude control pulse engines are expressed on a bomb coordinate system by considering the interference effect of lateral jet flow
Wherein,in order to jet the thrust amplification factor,for disturbance of the jet by a torque amplification factor, Fy1,Fz1,My1,Mz1The representation of the nominal direct lateral force resultant force and resultant moment on a projectile coordinate system is adopted;
deducing an attack angle, a sideslip angle and a projectile angular velocity dynamic equation according to the formulas (1) to (4);
dynamic equation of angle of attack and sideslip angle
Dynamic equation of angular velocity of projectile
Wherein Q is dynamic pressure, S is characteristic area, L is characteristic length,as a result of the pneumatic parameters,is the normal overload coefficient corresponding to the unit attack angle,is the normal overload coefficient corresponding to the unit elevator deflection angle,is the lateral overload factor corresponding to the unit sideslip angle,is the lateral overload coefficient corresponding to the unit rudder deflection angle,for the statically stable derivative of the yaw,in order to achieve steering efficiency of the rudder,as a function of the yaw damping moment coefficient,in order to be the derivative of the pitch static stability,in order to achieve the efficiency of the elevator steering,as a function of the pitch damping moment coefficient,y,zdeflection angles of a rudder and an elevator respectively; the formulas (5) to (6) are the attitude control models of the composite control missiles;
introducing logic variables, and constructing a complete mixed logic dynamic model of the composite control missile;
and step three, designing a composite missile attitude control law, and determining a pneumatic control law and an attitude control engine starting law.
The invention has the beneficial effects that:
compared with the existing composite missile attitude control method, the invention has the advantages that:
(1) the design of the pneumatic control law and the determination of the starting rule of the attitude control engine are completed simultaneously, and the design problem of the composite missile attitude control law is converted into the design problem of a hybrid logic dynamic system by introducing logic variables to describe a piecewise affine model and direct lateral force, and meanwhile, the problems of model nonlinearity and control input hybrid characteristic in the composite control missile attitude control design are solved.
(2) The method provided by the invention has wider application range, and when the consumption condition of the attitude control engine is considered, the number of the available engines is only required to be recalculated at each moment, and the description relation between the direct lateral force and the logic variable is changed. In addition, the method can be used for attitude control design of attitude control type composite control missiles, is also suitable for control design of other types of nonlinear missile guidance systems, and has wide application prospect.
Drawings
FIG. 1 is a flow chart of the present invention;
FIG. 2 is a definition of the principal coordinate system used in the present invention, with the center of mass of the missile as the origin O, where the ground coordinate system Oxyz, the missile coordinate system Ox1y1z1Ballistic coordinate system Ox2y2z2And a speed coordinate system Ox3y3z3α are angle of attack and sideslip angle, theta, psivTrajectory dip and trajectory deflection angles, respectively;
FIG. 3 is a layout diagram of an attitude control engine, wherein a is an odd-numbered circle of the attitude control pulse engine layout, b is an even-numbered circle of the attitude control pulse engine layout, and 1 and 2 … … 18 represent the number of the attitude control pulse engine in each circle;
FIG. 4 is a diagram of an attitude control engine in a ring direction, wherein i represents the number of a ring, the numbers 8, 9, 10, 11 and 12 represent the numbers of the attitude control pulse engine in each ring, and the distance between the section formed by the connecting line of the circle centers of the nozzles of the ith ring of the attitude control pulse engine and the center of mass of the projectile body is liThe distance between two adjacent circles is delta l, l1The distance between a section formed by a connecting line of the center of a nozzle circle of the 1 st circle of attitude control pulse engine and the center of mass of the projectile body is represented;
FIG. 5 is a schematic view of an engine sector, wherein FIG. a is a schematic view of an odd number of rotation attitude control pulse engine sectors, and FIG. b is a schematic view of an even number of rotation attitude control pulse engine sectors;
FIG. 6 is a graph of aerodynamic parameters versus angle of attack, where graph a isGraph b is the relation curve with αGraph c is the relationship curve with αGraph d is the relationship curve with αGraph e is the relation curve with αGraph f is the relationship with αCurves with α;
FIG. 7 is an angle of attack response curve, where the solid line represents the actual value of the angle of attack and the dashed line represents the commanded value of the angle of attack;
FIG. 8 is a rudder deflection angle curve;
FIG. 9 is a direct lateral force curve generated by an attitude control engine;
FIG. 10 shows different partition cases of the state space attitude control law.
Detailed Description
The first embodiment is as follows: the embodiment is understood by combining fig. 1 and fig. 2, and the attitude control method of the hybrid predictive control-based attitude-control-based direct lateral force and aerodynamic composite missile in the embodiment is realized according to the following steps:
establishing a direct lateral force and aerodynamic force composite missile complete attitude control model and a direct lateral force model, deducing an expression of a direct lateral force in a pitching direction, and converting a missile nonlinear dynamics model into a piecewise affine model through analyzing the aerodynamic characteristics of a missile body;
the process of the established direct lateral force and aerodynamic force composite missile complete attitude control model is as follows:
wherein m is missile mass, P is missile tail main engine thrust, g is gravitational acceleration, and Xa、YaAnd ZaThe missile is characterized in that the missile is subjected to three components of aerodynamic force on a speed coordinate system, namely resistance, lift force and lateral force, the positive directions of the three components are respectively consistent with the positive directions of three axes of the speed coordinate system, V represents the movement speed of the missile mass center, α represents an attack angle and a sideslip angle respectively, and theta, psivBallistic dip and ballistic declination, gamma, respectivelyvIs a velocity ramp angle;the three components of the direct lateral force borne by the missile on a trajectory coordinate system;
assuming that the projectile coordinate system coincides with the main axis of inertia of the projectile, i.e. Jxy=Jyz=JzxThe kinetic equation of the missile rotating around the center of mass in the missile coordinate system is obtained as follows
Wherein Jx、JyAnd JzAre respectively the rotational inertia omega of the missile to the three axes of the missile coordinate systemx,ωy,ωzThe components of the rotating angular velocity omega of the projectile coordinate system relative to the ground coordinate system on three axes of the projectile coordinate system, Mx、MyAnd MzThe components of the moments of all external forces acting on the missile to the mass center on each axis of the missile coordinate system are respectively; mx、MyAnd MzIs shown as
In the formula Mex、MeyAnd MezAre respectively the components of the aerodynamic moment acting on the missile on each axis of a missile coordinate system,the components of the direct lateral moment acting on the missile on each axis of the missile coordinate system are respectively;
in addition, when the attitude control engine injects the gas flow laterally, the high-speed jet flow and the incoming air flow are mutually interfered, and a lateral jet flow interference effect is formed. Thrust amplification factor using jet disturbanceAnd jet disturbance moment amplification factorTo respectively represent the ratio of jet disturbance force and moment to the net thrust and moment generated without lateral jet; therefore, the direct lateral force resultant force and resultant moment generated by simultaneously igniting a plurality of attitude control pulse engines are expressed as follows on a bomb coordinate system by considering the interference effect of the lateral jet flow
Wherein,in order to jet the thrust amplification factor,in order to jet the disturbance moment amplification factor,the representation of the nominal direct lateral force resultant force and resultant moment on a projectile coordinate system is adopted;
assuming that the quality of the guided missile at the final guide section is unchanged, and carrying out linear description on pneumatic force and moment by using pneumatic data according to the requirement of simplifying a model; because the attitude control of the intercepted missile in the atmosphere aims at establishing an attack angle and a sideslip angle to form aerodynamic lift and lateral force, in order to describe the change rule of the attack angle, the sideslip angle and the angular velocity of the missile, a dynamic equation of the attack angle, the sideslip angle and the angular velocity of the missile is deduced according to the formulas (1) to (4);
dynamic equation of angle of attack and sideslip angle
Dynamic equation of angular velocity of projectile
Wherein Q is dynamic pressure, S is characteristic area, L is characteristic length,as a result of the pneumatic parameters,is the normal overload coefficient corresponding to the unit attack angle,is the normal overload coefficient corresponding to the unit elevator deflection angle,is the lateral overload factor corresponding to the unit sideslip angle,is the lateral overload coefficient corresponding to the unit rudder deflection angle,for the statically stable derivative of the yaw,in order to achieve steering efficiency of the rudder,as a function of the yaw damping moment coefficient,in order to be the derivative of the pitch static stability,in order to achieve the efficiency of the elevator steering,as a function of the pitch damping moment coefficient,y,zdeflection angles of a rudder and an elevator respectively; the formulas (5) to (6) are the attitude control models of the composite control missiles;
introducing logic variables, and constructing a complete mixed logic dynamic model of the composite control missile based on the equivalence of the piecewise affine model and the mixed logic dynamic model;
and thirdly, designing a composite missile attitude control law based on a hybrid model predictive control theory, and determining a pneumatic control law and an attitude control engine starting law.
The second embodiment is as follows: the first difference between the present embodiment and the specific embodiment is: the specific process for establishing the direct lateral force model in the step one is as follows:
the direct lateral force is generated by an attitude control pulse engine unit fixedly arranged in front of the mass center of the projectile body, 180 attitude control pulse engines are arranged in a staggered mode and divided into 10 circles along the longitudinal axis of the projectile body, and 18 attitude control pulse engines in each circle are arranged around the projectile body; adjacent in the same circleThe interval central angle of the attitude control pulse motor is 20 degrees, i is the number of a circle, i is 1,2, …,10, j is the number of the attitude control pulse motor in each circle, and j is 1,2, …, 18; the distance between the cross section formed by the connecting line of the circle centers of the ith circle of attitude control pulse engine nozzle and the center of mass of the projectile body is liThe distance between two adjacent circles is delta l; the layout of the attitude control pulse engine set on the projectile body is shown in fig. 3 and 4.
Assuming that the steady-state thrust generated by the attitude control pulse engine in the absence of free flow is FmThe nominal direct lateral force generated for the attitude control pulse engine with number (i, j) is expressed in the projectile coordinate system as
Accordingly, the direct lateral moment is expressed in the elastic coordinate system as
Wherein, when i is odd, i*2; when i is an even number, i*=1;
The nominal direct lateral force resultant force and resultant moment generated by simultaneously igniting a plurality of attitude control pulse engines are expressed on an elastic coordinate system as
Wherein j is1,1,j1,2,…,j1,n1The number in the circle of the ignition position control pulse engine of the 1 st circle is shown, n1 shows the number of the ignition position control pulse engines of the 1 st circle, and the like; equations (9) - (10) are direct lateral force models of the composite control missile.
The third concrete implementation mode: the present embodiment differs from the first or second embodiment in that: the specific process for deriving the expression of the direct lateral force in the pitching direction in the step one is as follows:
each circle of 18 attitude control pulse engines is divided into four ignition control areas: positive and negative pitch control zones and positive and negative yaw control zones, as shown in fig. 5.
Because each attitude control engine is fixed in installation position on the missile, fixed in work period, limited in quantity and not reusable, a set of specific principles need to be followed when selecting the number, the positions and the ignition sequence of the engines. The invention makes the following assumptions that for each control area, at most 2 simultaneous ignitions are allowed in each circle, at most two circles are allowed to be simultaneously ignited, and only the attitude control pulse engine in an odd number of circles or the attitude control pulse engine in an even number of circles are allowed to be simultaneously ignited; in each ignition control area, symmetric ignition needs to be ensured when the attitude control pulse engine is ignited.
Taking a positive pitch control area as an example, a resultant force and resultant moment set of direct lateral force generated by the attitude control pulse engine is given;
the attitude control pulse motors numbered (i,1), (i,2), (i,3), (i,17), (i,18) within the odd circles generate direct lateral forces at oy1The components on the axis are represented as vectors
The attitude control pulse engines numbered (i,1), (i,2), (i,17), (i,18) within even circles generate direct lateral forces in oy1The components on the axis are represented as vectors
Setting the direct side force generated by the ith circle of attitude control pulse engine as FiRequire
F1=F9,F3=F7,F2=F10,F4=F8(13)
When the odd-number-turn pulse engine is ignited, there are
Similarly, when an even-numbered cycle pulse engine is ignited, there are
Since Δ l is small, assume l5≈l6In addition, considering the ignition efficiency of the engine to avoid excessive consumption and not allowing the ignition of the engine with low efficiency, different values of the resultant force of the direct lateral force generated by all attitude control engines in the positive pitch control area form a set
Different values of resultant moment form set
Due to the symmetry of the engine configuration, different values of the resultant force of the direct lateral force generated by all attitude control engines in the negative pitch control area form a set
In each control period, the attitude control system follows a certain control lawSelects one control force as the control input.
By the method, a set formed by different values of the resultant force of the direct lateral forces generated by all attitude control engines in the positive and negative yaw control areas can be obtained.
The fourth concrete implementation mode: the difference between this embodiment mode and one of the first to third embodiment modes is: the specific process for converting the missile nonlinear dynamics model into the piecewise affine model in the step one is as follows:
firstly, a general parameter table of the direct lateral force and aerodynamic force composite control missile is given,
TABLE 1 missile population parameters
Taking a pitch channel as an example, ignoring a gravity term at a final control section, and ignoring a coupling term for simplifying analysis, obtaining a nonlinear attitude control model of the missile pitch channel by equations (5) - (6)
Selecting system state x ═ α ωz]TThe control quantity u ═ 2zFy1]TWhen the attitude control design is carried out, the tracking condition of an attack angle command is concerned, so that the system output is selected to be y as α, and the state space of the obtained nonlinear model is described as follows
Wherein,
in the above formula, the pneumatic parametersJet disturbance amplification factorAll related to the angle of attack α, and considering that angle of attack is the determining factor affecting these parameters, FIG. 6 shows the relationship between each parameter and the angle of attack α.
The angle of attack is a main factor enabling the attitude control system to present nonlinear characteristics, according to the given pneumatic parameters and the relation curve between the amplification factor and the angle of attack, the pneumatic parameters and the amplification factor can be seen to present nonlinear relations with the angle of attack, and when the angle of attack changes in a small range, the linear relations can be approximated; dividing the device into six subareas by taking alpha as-21.25 degrees, -8.75 degrees, 0 degrees, 8.75 degrees and 21.25 degrees as dividing points, wherein each subarea can be approximately linear; in each segment, the attitude control model is linearized in sections by a small deviation linearization method;
the resulting piecewise affine model is as follows:
y(t)=cx(t) (21)
wherein,
c=[1 0]
wherein, i is 1,2, …,6, which corresponds to six subareas respectively;
taking a sampling period TsCombining the relationship between the aerodynamic parameter and the attack angle in the graph of fig. 6 to obtain a state space expression of the discrete attitude control system as 0.025s
Wherein,
k represents the kth moment, and the equation (22) is the piecewise affine model of the composite control missile.
By the method, a piecewise affine model of the yaw channel can be obtained as well.
The fifth concrete implementation mode: the difference between this embodiment and one of the first to fourth embodiments is: the concrete process for constructing the complete mixed logic dynamic model of the composite control missile is as follows:
introducing logic variablesi(k) ∈ {0,1}, i ═ 1,2, …,6, describe the demarcation points in the piecewise affine model, which satisfy the following correspondence
Equation (23) may be translated into an equivalent hybrid logical inequality constraint:
wherein m is1=-0.16,M1=0.90,m2=-0.377,M2=0.683,m3=-0.53,M3=0.53,m4=-0.683,M4=0.377,m5=-0.90,M5=0.16,=10-6;
At the same time, auxiliary logic variables are introducedi(k)∈{0,1},i is 6, …,9, and satisfies
Then1,6,7,8,9,1-5Corresponding to six partitions of the piecewise affine model, respectively.
Expression of equation (25) as a hybrid logical inequality constraint:
introducing an auxiliary continuous variable zi(k) I is 1,2, …,6, so as to unify each segment partition condition of the piecewise affine model with the corresponding state space expression, and the auxiliary continuous variables are as follows
Expression of equation (27) as a hybrid logical inequality constraint:
wherein M isf1=[0.73 10.84]T,mf1=[-0.77 -11.06]T,Mf2=[0.76 11.66]T,mf2=[-0.79 -12.56]T,Mf3=[0.77 12.73]T,mf3=[-0.78 -12.80]T,Mf4=[0.76 14.03]T,mf4=[-0.76 -14.03]T,Mf5=[0.725 12.91]T,mf5=[-0.736 -12.05]T,Mf6=[0.696 11.54]T,mf6=[-0.73 -11.30]T;
Combining parameters in the general parameter table of the direct lateral force and aerodynamic force composite control missile and formulas (16) and (17), obtaining a pitch direction direct lateral force value set as
Since the direct lateral force is a discrete variable, the following logical variables are introducedTo describe the direct lateral force
In equation (29), the logical variables satisfy the following constraints:
Where 0 describes that direct lateral forces do not work and 1 describes that direct lateral forces can only be taken togetherOne of (1);
remember u1=zThen the control input in equation (22) is written as
According to the general parameter table of the direct lateral force and aerodynamic force composite control missile, the system state and control input are constrained
xmin≤x(k)≤xmax
u1min≤u1(k)≤u1max(32)
Wherein x ismin=[-0.53 -5.22]T,xmax=[0.53 5.22]T,u1min=-0.53,u1max=0.53;
Formula (30) is described as
To sum up, the obtained complete mixed logic dynamic model of the composite control missile is
Also, by introducing logic variables, a hybrid logic dynamic model of the yaw channel can be obtained by the method.
The sixth specific implementation mode: the difference between this embodiment and one of the first to fifth embodiments is: the specific implementation process of the attitude control law of the designed composite missile in the third step is as follows:
for a composite control missile, the goal of attitude control is to quickly track the attitude control system commands while saving fuel consumption as much as possible, and then maintain the attitude stable. According to the attitude control target, the design target of the attitude control system at the current moment can be described as that on the premise of saving fuel consumption, a proper rudder deflection angle and a direct lateral force value, namely a control quantity u are searched, so that the tracking error of the attack angle in a prediction time domain is minimum, and based on the aim, a hybrid prediction control optimization problem is constructed as follows
Wherein, ycFor the angle of attack instruction, y (k + i/k) is the predicted value of the angle of attack, N is the predicted time domain, QyIs the weighting matrix of the output trace entries, R is the weighting matrix of the control entries;
for the yaw channel, a similar hybrid predictive control optimization problem can be constructed, and the design process of the attitude control law of the hybrid predictive control optimization problem is completely consistent with that of the pitch channel.
Solving the optimization problem by using a mixed integer quadratic programming method and Matlab software, namely obtaining the starting rule of a pneumatic control law and an attitude control engine, and adjusting a weighting matrix Q to distribute direct lateral force and aerodynamic forceyAnd R implementation.
FIGS. 7, 8 and 9 show the simulation results of designing attitude control laws by using the method of the present invention, and FIG. 10 shows the partitioning results of explicit control laws.
Claims (3)
1. An attitude control type direct lateral force and aerodynamic force composite missile attitude control method based on hybrid predictive control is characterized by being realized according to the following steps:
establishing a direct lateral force and aerodynamic force composite missile complete attitude control model and a direct lateral force model, deducing an expression of a direct lateral force in a pitching direction, and converting a missile nonlinear dynamics model into a piecewise affine model;
the process of the established direct lateral force and aerodynamic force composite missile complete attitude control model is as follows:
the gravity and aerodynamic force borne by the missile are respectively expressed on a trajectory coordinate system, and the dynamic equation of the missile mass center motion is obtained as follows
Wherein m is missile mass, P is missile tail main engine thrust, g is gravitational acceleration, and Xa、YaAnd ZaThe missile is characterized in that the missile is subjected to three components of aerodynamic force on a speed coordinate system, namely resistance, lift force and lateral force, the positive directions of the three components are respectively consistent with the positive directions of three axes of the speed coordinate system, V represents the movement speed of the missile mass center, α represents an attack angle and a sideslip angle respectively, and theta, psivBallistic dip and ballistic declination, gamma, respectivelyvIs a velocity ramp angle;the three components of the direct lateral force borne by the missile on a trajectory coordinate system;
assuming that the projectile coordinate system coincides with the main axis of inertia of the projectile, i.e. Jxy=Jyz=JzxThe kinetic equation of the missile rotating around the center of mass in the missile coordinate system is obtained as follows
Wherein Jx、JyAnd JzAre respectively the rotational inertia omega of the missile to the three axes of the missile coordinate systemx,ωy,ωzThe components of the rotating angular velocity omega of the projectile coordinate system relative to the ground coordinate system on three axes of the projectile coordinate system, Mx、MyAnd MzThe components of the moments of all external forces acting on the missile to the mass center on each axis of the missile coordinate system are respectively; mx、MyAnd MzIs shown as
In the formula Mex、MeyAnd MezAre respectively the components of the aerodynamic moment acting on the missile on each axis of a missile coordinate system,the components of the direct lateral moment acting on the missile on each axis of the missile coordinate system are respectively;
the direct lateral force resultant force and resultant moment generated by simultaneously igniting a plurality of attitude control pulse engines are expressed on a bomb coordinate system by considering the interference effect of lateral jet flow
Wherein,in order to jet the thrust amplification factor,for disturbance of the jet by a torque amplification factor, Fy1,Fz1,My1,Mz1The representation of the nominal direct lateral force resultant force and resultant moment on a projectile coordinate system is adopted;
deducing an attack angle, a sideslip angle and a projectile angular velocity dynamic equation according to the formulas (1) to (4);
dynamic equation of angle of attack and sideslip angle
Dynamic equation of angular velocity of projectile
Wherein Q is dynamic pressure, S is characteristic area, L is characteristic length,as a result of the pneumatic parameters,is the normal overload coefficient corresponding to the unit attack angle,is the normal overload coefficient corresponding to the unit elevator deflection angle,is the lateral overload factor corresponding to the unit sideslip angle,is the lateral overload coefficient corresponding to the unit rudder deflection angle,for the statically stable derivative of the yaw,in order to achieve steering efficiency of the rudder,as a function of the yaw damping moment coefficient,in order to be the derivative of the pitch static stability,in order to achieve the efficiency of the elevator steering,as a function of the pitch damping moment coefficient,y, zdeflection angles of a rudder and an elevator respectively; the formulas (5) to (6) are the attitude control models of the composite control missiles;
introducing logic variables, and constructing a complete mixed logic dynamic model of the composite control missile;
designing a composite missile attitude control law, and determining a pneumatic control law and an attitude control engine starting law;
the specific process for establishing the direct lateral force model in the step one is as follows:
the direct lateral force is generated by an attitude control pulse engine unit fixedly arranged in front of the mass center of the projectile body, 180 attitude control pulse engines are arranged in a staggered mode and divided into 10 circles along the longitudinal axis of the projectile body, and 18 attitude control pulse engines in each circle are arranged around the projectile body; adjacent attitude control pulse engines in the same circle are spaced by a central angle of 20 degrees, wherein i represents the number of the circle, i is 1,2, …,10, j represents the number of the attitude control pulse engines in each circle, and j is 1,2, …, 18; the distance between the cross section formed by the connecting line of the circle centers of the ith circle of attitude control pulse engine nozzle and the center of mass of the projectile body is liThe distance between two adjacent circles is △ l, and the steady-state thrust generated by the attitude control pulse engine in the absence of free flow is assumed to be FmThe nominal direct lateral force generated for the attitude control pulse engine with number (i, j) is expressed in the projectile coordinate system as
Accordingly, the direct lateral moment is expressed in the elastic coordinate system as
Wherein, when i is odd, i*2; when i is an even number, i*=1;
The nominal direct lateral force resultant force and resultant moment generated by simultaneously igniting a plurality of attitude control pulse engines are expressed on an elastic coordinate system as
Wherein j is1,1,j1,2,…,j1,n1The number in the circle of the ignition position control pulse engine of the 1 st circle is shown, n1 shows the number of the ignition position control pulse engines of the 1 st circle, and the like; the formulas (9) to (10) are direct lateral force models of the composite control missile;
the specific process of deducing the expression of the direct lateral force in the pitching direction comprises the following steps:
the attitude control pulse motors numbered (i,1), (i,2), (i,3), (i,17), (i,18) within the odd circles generate direct lateral forces at oy1The components on the axis are represented as vectors
The attitude control pulse engines numbered (i,1), (i,2), (i,17), (i,18) within even circles generate direct lateral forces in oy1The components on the axis are represented as vectors
Setting the direct side force generated by the ith circle of attitude control pulse engine as FiRequire
F1=F9,F3=F7,F2=F10,F4=F8(13)
When the odd-number-turn pulse engine is ignited, there are
Similarly, when an even-numbered cycle pulse engine is ignited, there are
Different values of the resultant force of the direct lateral force generated by all attitude control engines in the positive pitching control area form a set
Different values of resultant moment form set
Different values of the resultant force of the direct lateral force generated by all attitude control engines in the negative pitch control area form a set
In each control period, the attitude control system follows a certain control lawSelecting a control force as a control input;
the specific process for converting the missile nonlinear dynamics model into the piecewise affine model in the step one is as follows: the nonlinear attitude control model of the missile pitch channel obtained by combining the general parameter table of the direct lateral force and aerodynamic force composite control missile is shown in the formulas (5) to (6)
Selecting system state x ═ α ωz]TThe control quantity u ═ 2zFy1]TSelecting the system output as y α, and describing the state space of the obtained nonlinear model as follows
Wherein,
in the above formula, the pneumatic parametersJet disturbance amplification factorAre all related to angle of attack α;
dividing the attitude control model into six partitions by taking alpha as-21.25 degrees, -8.75 degrees, 0 degrees, 8.75 degrees and 21.25 degrees as boundary points respectively, and performing piecewise linearization on the attitude control model in each segment by using a small deviation linearization method;
the resulting piecewise affine model is as follows:
y(t)=cx(t)
wherein,
c=[1 0]
wherein, i is 1,2, …,6, which corresponds to six subareas respectively;
taking a sampling period TsCombining the relationship between the pneumatic parameters and the attack angle to obtain a state space expression of the discrete attitude control system as 0.025s
Wherein,
k represents the kth moment, and the equation (22) is the piecewise affine model of the composite control missile.
2. The hybrid predictive control-based attitude control type direct lateral force and aerodynamic force composite missile attitude control method according to claim 1, wherein the concrete process for constructing the complete hybrid logic dynamic model of the composite control missile in the step two is as follows:
introducing logic variablesi(k) ∈ {0,1}, i ═ 1,2, …,6, describe the demarcation points in the piecewise affine model, which satisfy the following correspondence
Equation (23) may be translated into an equivalent hybrid logical inequality constraint:
wherein m is1=-0.16,M1=0.90,m2=-0.377,M2=0.683,m3=-0.53,M3=0.53,m4=-0.683,M4=0.377,m5=-0.90,M5=0.16,=10-6;
At the same time, auxiliary logic variables are introducedi(k) ∈ {0,1}, i ═ 6, …,9, and satisfies
Then1,6,7,8,9,1-5The six subareas respectively correspond to the piecewise affine model;
expression of equation (25) as a hybrid logical inequality constraint:
introducing an auxiliary continuous variable zi(k) I is 1,2, …,6, so as to unify each segment partition condition of the piecewise affine model with the corresponding state space expression, and the auxiliary continuous variables are as follows
Expression of equation (27) as a hybrid logical inequality constraint:
wherein M isf1=[0.73 10.84]T,mf1=[-0.77 -11.06]T,Mf2=[0.76 11.66]T,mf2=[-0.79 -12.56]T,Mf3=[0.77 12.73]T,mf3=[-0.78 -12.80]T,Mf4=[0.76 14.03]T,mf4=[-0.76 -14.03]T,Mf5=[0.725 12.91]T,mf5=[-0.736 -12.05]T,Mf6=[0.696 11.54]T,mf6=[-0.73 -11.30]T;
Combining parameters in the general parameter table of the direct lateral force and aerodynamic force composite control missile and formulas (16) and (17), obtaining a pitch direction direct lateral force value set as
The following logic variables were introducedTo describe the direct lateral force
In equation (29), the logical variables satisfy the following constraints:
or 1 (30)
Where 0 describes that direct lateral forces do not work and 1 describes that direct lateral forces can only be taken togetherOne of (1);
remember u1=zThen the control input in equation (22) is written as
According to the general parameter table of the direct lateral force and aerodynamic force composite control missile, the system state and control input are constrained
Wherein x ismin=[-0.53 -5.22]T,xmax=[0.53 5.22]T,u1min=-0.53,u1max=0.53;
Formula (30) is described as
To sum up, the obtained complete mixed logic dynamic model of the composite control missile is
3. The hybrid predictive control-based attitude control type direct lateral force and aerodynamic force composite missile attitude control method according to claim 1, characterized in that the specific implementation process of the attitude control law of the designed composite missile in the third step is as follows:
the construction of the hybrid predictive control optimization problem is as follows
Wherein, ycFor the angle of attack instruction, y (k + i/k) is the predicted value of the angle of attack, N is the predicted time domain, QyIs the weighting matrix of the output trace entries, R is the weighting matrix of the control entries;
solving the optimization problem by using a mixed integer quadratic programming method and Matlab software, namely obtaining the starting rule of a pneumatic control law and an attitude control engine, and adjusting a weighting matrix Q to distribute direct lateral force and aerodynamic forceyAnd R implementation.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410578127.1A CN104267733B (en) | 2014-10-25 | 2014-10-25 | Based on the appearance control formula direct lateral force gentle Power compound missile attitude control method mixing PREDICTIVE CONTROL |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410578127.1A CN104267733B (en) | 2014-10-25 | 2014-10-25 | Based on the appearance control formula direct lateral force gentle Power compound missile attitude control method mixing PREDICTIVE CONTROL |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104267733A CN104267733A (en) | 2015-01-07 |
CN104267733B true CN104267733B (en) | 2016-09-14 |
Family
ID=52159261
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410578127.1A Active CN104267733B (en) | 2014-10-25 | 2014-10-25 | Based on the appearance control formula direct lateral force gentle Power compound missile attitude control method mixing PREDICTIVE CONTROL |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104267733B (en) |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106184811B (en) * | 2016-07-22 | 2018-05-22 | 北京临近空间飞行器系统工程研究所 | It is a kind of to relax the yaw aerodynamic characteristics of vehicle of steady state stability and control design case method |
CN106444807B (en) * | 2016-09-29 | 2019-04-12 | 湖北航天技术研究院总体设计所 | A kind of compound attitude control method of grid rudder and Lateral jet |
CN106950982B (en) * | 2017-02-16 | 2020-02-14 | 北京临近空间飞行器系统工程研究所 | Method for identifying high-altitude torque characteristics of attitude control power system of reentry vehicle |
CN107525441B (en) * | 2017-08-10 | 2019-02-01 | 西安理工大学 | It is a kind of for playing the device of arrow gesture stability |
CN107844128B (en) * | 2017-10-13 | 2018-11-16 | 北京航空航天大学 | A kind of hypersonic aircraft cruise section method of guidance based on compositely proportional guiding |
CN109085848B (en) * | 2018-08-02 | 2021-05-07 | 西北工业大学 | Air-air missile direct force/aerodynamic force finite time anti-saturation control method |
CN109145451B (en) * | 2018-08-22 | 2022-11-29 | 哈尔滨工业大学 | Motion behavior identification and track estimation method for high-speed gliding aircraft |
CN109189080B (en) * | 2018-11-12 | 2021-04-20 | 西北工业大学 | Distributed control method of multi-autonomous marine vehicle system based on fuzzy theory |
CN109634306B (en) * | 2018-12-28 | 2020-09-08 | 北京星际荣耀空间科技有限公司 | Aircraft control parameter determination method and device |
CN110334368B (en) * | 2019-03-29 | 2021-07-23 | 南京航空航天大学 | Flight dynamics modeling method for composite thrust configuration helicopter |
CN110750836B (en) * | 2019-10-15 | 2024-09-03 | 北京电子工程总体研究所 | Aircraft pitching damping moment calculation method based on steady-state cone movement |
CN112325713B (en) * | 2019-12-24 | 2021-09-21 | 北京理工大学 | Analysis method for pneumatic nonlinear angular motion characteristics of double spinning bombs |
CN114167883B (en) * | 2022-02-11 | 2022-04-15 | 中国空气动力研究与发展中心计算空气动力研究所 | Method for controlling attitude of high-altitude aircraft by jet flow |
CN114740884B (en) * | 2022-03-11 | 2024-06-07 | 北京航空航天大学 | Double-pulse middle guidance method and device for short-range interception |
CN116185058B (en) * | 2023-04-21 | 2023-07-07 | 东方空间技术(山东)有限公司 | Carrier rocket attitude control method and device and flight control computer |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4679439B2 (en) * | 2006-06-05 | 2011-04-27 | 三菱電機株式会社 | Satellite attitude control device |
CN104035447A (en) * | 2014-06-27 | 2014-09-10 | 金陵科技学院 | Dynamic control reallocation based unmanned aerial vehicle attitude fault-tolerance control method |
-
2014
- 2014-10-25 CN CN201410578127.1A patent/CN104267733B/en active Active
Also Published As
Publication number | Publication date |
---|---|
CN104267733A (en) | 2015-01-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104267733B (en) | Based on the appearance control formula direct lateral force gentle Power compound missile attitude control method mixing PREDICTIVE CONTROL | |
CN102706217B (en) | Method for controlling attack angle and attack time of multiple missiles | |
CN104155990B (en) | Consider the hypersonic aircraft pitch channel attitude control method of angle of attack constraint | |
CN112346359B (en) | Direct force-aerodynamic force composite control numerical simulation method based on CFD and RBD coupling | |
CN102788677A (en) | Hypersonic mach-number-variable wind tunnel nozzle | |
CN110874055B (en) | Prediction and control method for hypersonic aircraft separation process under action of two-phase flow field | |
CN104881553B (en) | Single sliding block rolls the design method of jet mould formula Moving dummy vehicle and its topology layout parameter | |
CN109085848B (en) | Air-air missile direct force/aerodynamic force finite time anti-saturation control method | |
CN104019701B (en) | A kind of forward direction utilizing direct force aerodynamic force complex controll intercepts method of guidance | |
CN106054612A (en) | BTT missile flight trajectory automatic control method | |
CN111506113A (en) | Aircraft guidance instruction calculation method, sideslip angle calculation method and guidance method | |
CN110618608B (en) | Composite guidance tracking control method and device | |
CN108646554A (en) | A kind of quick anti-interference longitudinal guidance method of the aircraft based on specified performance | |
CN114912202A (en) | Integrated coupling control method for propelling of wide-speed-range air-breathing power aircraft body | |
CN103838237A (en) | Motion control design method of hypersonic flight vehicle | |
CN113625744B (en) | Design method of anti-saturation fixed time cooperative guidance law for attacking high maneuvering target | |
Ning et al. | Adaptive reinforcement learning control for a class of missiles with aerodynamic uncertainties and unmodeled dynamics | |
CN113821057A (en) | Planetary soft landing control method and system based on reinforcement learning and storage medium | |
Li et al. | Control System Design for Guided Rocket Base on Adaptive Sliding Mode Control | |
Li et al. | Design of active disturbance rejection attitude controller for vertical launched missile | |
CN116294837B (en) | Control method for sub-missile head drop point based on perturbation guidance | |
Wei et al. | Missile guidance law with impact angle constraint and acceleration saturation | |
Fu et al. | Endoatmospheric energy management method for launch vehicle with solid rocket boosters based on changeable launch plane strategy | |
CN116991073A (en) | PGK missile arrow control method based on robust H-infinity theory | |
Wang et al. | Design of BTT control technology for cruise missile based on LQR |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |