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 PDF

Info

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
Application number
CN201410578127.1A
Other languages
Chinese (zh)
Other versions
CN104267733A (en
Inventor
赵昱宇
杨宝庆
姚郁
贺风华
陈松林
马杰
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201410578127.1A priority Critical patent/CN104267733B/en
Publication of CN104267733A publication Critical patent/CN104267733A/en
Application granted granted Critical
Publication of CN104267733B publication Critical patent/CN104267733B/en
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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

Attitude control type direct lateral force and aerodynamic force composite missile attitude control method based on hybrid predictive control
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
m V · = P cos α cos β - X a - mg sin θ + F x 2 a mV θ · = P ( sin α cos γ v + cos α sin β sin γ v ) + Y a cos γ v - mg cos θ + F y z a mV cos θ ψ · V = - P ( sin α sin γ v - cos α sin β cos γ v ) - Y a sin γ v - Z a cos γ v - F z 2 a - - - ( 1 )
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
J x ω · x = ( J y - J z ) ω z ω y + M x J y ω · y = ( J z - J x ) ω x ω z + M y J z ω · z = ( J x - J y ) ω x ω y + M z - - - ( 2 )
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
M x = M ex + M x 1 a M y = M ey + M y 1 a M z = M ez + M z 1 a - - - ( 3 )
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
F x 1 a F y 1 a F z 1 a = 0 F y 1 + K F y F y 1 F z 1 + K F z F z 1 , M x 1 a M y 1 a M z 1 a = 0 M y 1 + K M y M y 1 M z 1 + K M z M z 1 - - - ( 4 )
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
α · = ω z + ω y sin α tan β - QS ( C y α α + C y δ z δ z ) cos α mV cos β - ( F y 1 + K F y F y 1 ) cos α mV cos β - G y cos α mV cos β β · = ω y cos α + QS ( C z β β + C z δ y δ y ) cos β mV + QS ( C y α α + C y δ z δ z ) sin α sin β mV + ( F y 1 + K F y F y 1 ) sin α sin β mV + ( F z 1 + K F z F z 1 ) cos β mV + G z cos β mV + G y sin α sin β mV - - - ( 5 )
Dynamic equation of angular velocity of projectile
ω · y = M y 1 J y + K M y M y 1 J y + QSLm y β β J y + QSLm y δ y δ y J y + QSLm y ω y ω y J y ω · z = M z 1 J z + K M z M z 1 J z + QSLm z α α J z + QSLm z δ z δ z J z + QSLm z ω z ω z J z - - - ( 6 )
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,yzdeflection 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:
m V · = P cos α cos β - X a - mg sin θ + F x 2 a mV θ · = P ( sin α cos γ v + cos α sin β sin γ v ) + Y a cos γ v - mg cos θ + F y 2 a mV cos θ ψ · V = - P ( sin α sin γ v - cos α sin β cos γ v ) - Y a sin γ v - Z a cos γ v - F z 2 a · - - - ( 1 )
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
J x ω · x = ( J y - J z ) ω z ω y + M x J y ω · y = ( J z - J x ) ω x ω z + M y J z ω · z = ( J x - J y ) ω x ω y + M z - - - ( 2 )
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
M x = M ex + M x 1 a M y = M ey + M y 1 a M z = M ez + M z 1 a - - - ( 3 )
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
F x 1 a F y 1 a F z 1 a = 0 F y 1 + K F y F y 1 F z 1 + K F z F z 1 , M x 1 a M y 1 a M z 1 a = 0 M y 1 + K M y M y 1 M z 1 + K M z M z 1 - - - ( 4 )
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
α · = ω z + ω y sin α tan β - QS ( C y α α + C y δ z δ z ) cos α mV cos β - ( F y 1 + K F y F y 1 ) cos α mV cos β - G y cos α mV cos β β · = ω y cos α + QS ( C z β β + C z δ y δ y ) cos β mV + QS ( C y α α + C y δ z δ z ) sin α sin β mV + ( F y 1 + K F y F y 1 ) sin α sin β mV + ( F z 1 + K F z F z 1 ) cos β mV + G z cos β mV + G y sin α sin β mV - - - ( 5 )
Dynamic equation of angular velocity of projectile
ω . y = M y 1 J y + K M y M y 1 J y + QSLm y β β J y + QSLm y δ y δ y J y + QSLm y ω y ω y J y ω . z = M z 1 J z + K M z M z 1 J z + QSLm z α α J z + QSLm z δ z δ z J z + QSLm z ω z ω z J z - - - ( 6 )
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,yzdeflection 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
F x 1 i , j F y 1 i , j F z 1 i , j = 0 F m cos ( 2 j - i * 18 π ) - F m sin ( 2 j - i * 18 ) - - - ( 7 )
Accordingly, the direct lateral moment is expressed in the elastic coordinate system as
M x 1 i , j M y 1 i , j M z 1 i , j = 0 F m l i sin ( 2 j - i * 18 π ) F m l i cos ( 2 j - i * 18 π ) - - - ( 8 )
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
F x 1 F y 1 F z 1 = 0 Σ j = j 1,1 j = j 1 , n 1 F y 1 1 , j + Σ j = j 2,1 j = j 2 , n 2 F y 1 2 , j + . . . + Σ j = j 10,1 j = j 10 , n 10 F y 1 10 , j Σ j = j 1,1 j = j 1 , n 1 F z 1 1 , j + Σ j = j 2,1 j = j 2 , n 2 F z 1 2 , j + . . . + Σ j = j 10,1 j = j 10 , n 10 F z 1 10 , j - - - ( 9 )
M x 1 M y 1 M z 1 = 0 Σ j = j 1,1 j = j 1 , n 1 F z 1 1 , j l 1 + Σ j = j 2,1 j = j 2 , n 2 F z 1 2 , j l 2 + . . . + Σ j = j 10,1 j = j 10 , n 10 F z 1 10 , j l 10 Σ j = j 1,1 j = j 1 , n 1 F y 1 1 , j l 1 + Σ j = j 2,1 j = j 2 , n 2 F y 1 2 , j l 2 + . . . + Σ j = j 10,1 j = j 10 , n 10 F y 1 10 , j l 10 - - - ( 10 )
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
F o = F m F m cos π 9 F m cos 2 π 9 F m cos 2 π 9 F m cos π 9 T - - - ( 11 )
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
F e = F m cos π 18 F m cos π 6 F m cos π 6 F m cos π 18 T - - - ( 12 )
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
F y 1 ∈ { F m , 2 F m cos π 9 , 2 F m cos 2 π 9 , 2 F m , 4 F m cos π 9 , 4 F m cos 2 π 9 }
M z 1 ∈ { F 1 l 1 + F 9 l 9 , F 3 l 3 + F 7 l 7 , F 5 l 5 } = { F 1 ( l 5 + 4 Δl ) + F 1 ( l 5 - 4 Δl ) , F 3 ( l 5 + 2 Δl ) + F 3 ( l 5 - 2 Δl ) , F 5 l 5 } = { F 5 l 5 , 2 F 1 l 5 , 2 F 3 l 5 } = F y 1 l 5 = { F m l 5 , 2 F m cos π 9 l 5 , 2 F m cos 2 π 9 l 5 , 2 F m l 5 , 4 F m cos π 9 l 5 , 4 F m cos 2 π 9 l 5 } - - - ( 14 )
Similarly, when an even-numbered cycle pulse engine is ignited, there are
F y 1 ∈ { 2 F m cos π 18 , 2 F m cos π 6 , 4 F m cos π 18 , 4 F m cos π 6 }
M z 1 ∈ { F 2 l 2 + F 10 l 10 , F 4 l 4 + F 8 l 8 , F 6 l 6 } = { F 2 ( l 6 + 4 Δl ) + F 2 ( l 6 - 4 Δl ) , F 4 ( l 6 + 2 Δl ) + F 4 ( l 6 - 2 Δl ) , F 6 l 6 } = { F 6 l 6 , 2 F 2 l 6 , 2 F 4 l 6 + = F y 1 l 6 = { 2 F m cos π 18 l 6 , 2 F m cos π 6 l 6 , 4 F m cos π 18 l 6 , 4 F m cos π 6 l 6 } - - - ( 15 )
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
U F y + = { F m , 2 F m cos π 9 , 2 F m cos π 18 , 2 F m , 4 F m cos π 9 , 4 F m cos π 18 } - - - ( 16 )
Different values of resultant moment form set
U M y + = { F m l , 2 F m cos π 9 l , 2 F m cos π 18 l , 2 F m l , 4 F m cos π 9 l , 4 F m cos π 18 l } - - - ( 17 )
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
U F y - = { - F m , - 2 F m cos π 9 , - 2 F m cos π 18 , - 2 F m , - 4 F m cos π 9 , - 4 F m cos π 18 } - - - ( 18 )
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)
α · = ω z - QS ( C y α α + C y δ z δ z ) cos α mV - ( 1 + K F y ) F y 1 cos α mV ω · z = ( 1 + K M z ) F y 1 l J z + QSL m z α α J z + QSL m z δ z δ z J z + QSL m z ω z ω z J z - - - ( 19 )
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
x · ( t ) = f ( x ) + g ( x ) u ( t ) y ( t ) = [ 1 0 ] x ( t ) - - - ( 20 )
Wherein,
f ( x ) = ω z - QSC y α α cos α mV QSL ( m z α α + m z ω z ω z ) J z , g ( x ) = - QSC y δ z cos α mV - ( 1 + K F y ) cos α mV QSLm z δ z J z ( 1 + K M z ) l J z
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:
x &CenterDot; ( t ) = a 1 x ( t ) + b 1 u ( t ) + e 1 , 1 0 x ( t ) &le; - 0.37 a 2 x ( t ) + b 2 u ( t ) + e 2 , - 0.37 < 1 0 x ( t ) &le; - 0.153 a 3 x ( t ) + b 3 u ( t ) + e 3 , - 0.153 < 1 0 x ( t ) &le; 0 a 4 x ( t ) + b 4 u ( t ) + e 4 , 0 < 1 0 x ( t ) &le; 0.153 a 5 x ( t ) + b 5 u ( t ) + e 5 , 0.153 < 1 0 x ( t ) &le; 0.37 a 6 x ( t ) + b 6 u ( t ) + e 6 , 1 0 x ( t ) > 0.37
y(t)=cx(t) (21)
wherein,
a i = &PartialD; f ( x ) &PartialD; x | x = x i 0 = a i 11 a i 12 a i 21 a i 22 , b i = g ( x i 0 ) = b i 11 b i 12 b i 21 b i 22 , e i = e i 1 e i 2
a i 11 = &PartialD; f 1 &PartialD; &alpha; | x = x i 0 = - QS mV ( &PartialD; C y &alpha; &PartialD; &alpha; | &alpha; = &alpha; i 0 &alpha; i 0 cos ( &alpha; i 0 ) + C y &alpha; ( &alpha; i 0 ) cos ( &alpha; i 0 ) - C y &alpha; ( &alpha; i 0 ) &alpha; i 0 sin ( &alpha; i 0 ) )
a i 12 = &PartialD; f 1 &PartialD; &omega; z | x = x i 0 = 1
a i 21 = &PartialD; f 2 &PartialD; &alpha; | x = x i 0 = QSL J z ( &PartialD; m z &alpha; &PartialD; &alpha; | &alpha; = &alpha; i 0 &alpha; i 0 + m z &alpha; ( &alpha; i 0 ) + &PartialD; m z &omega; z &PartialD; &alpha; | &alpha; = &alpha; i 0 &omega; zi 0 )
a i 22 = &PartialD; f 2 &PartialD; &omega; z | x = x i 0 = QSL J z m z &omega; z ( &alpha; i 0 )
b i 11 = - QS mV C y &delta; z ( &alpha; i 0 ) cos ( &alpha; i 0 )
b i 12 = - ( 1 + K F y ( &alpha; i 0 ) ) cos ( &alpha; i 0 ) mV
b i 21 = QSL J z m z &delta; z ( &alpha; i 0 )
b i 22 = ( 1 + K M z ( &alpha; i 0 ) ) l J z
e i 1 = a i 11 &alpha; i 0 + a i 12 &omega; zi 0
e i 2 = a i 21 &alpha; i 0 + a i 22 &omega; zi 0
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
x ( k + 1 ) = a ~ 1 x ( k ) + b ~ 1 u ( k ) + e ~ 1 , 1 0 x ( k ) &le; - 0.37 a ~ 2 x ( k ) + b ~ 2 u ( k ) + e ~ 2 , - 0.37 < 1 0 x ( k ) &le; - 0.153 a ~ 3 x ( k ) + b ~ 3 u ( k ) + e ~ 3 , - 0.153 < 1 0 x ( k ) &le; 0 a ~ 4 x ( k ) + b ~ 4 u ( k ) + e ~ 4 , 0 < 1 0 x ( k ) &le; 0.153 a ~ 5 x ( k ) + b ~ 5 u ( k ) + e ~ 5 , 0.153 < 1 0 x ( k ) &le; 0.37 a ~ 6 x ( k ) + b ~ 6 u ( k ) + e ~ 6 , 1 0 x ( k ) > 0.37
y ( k ) = c ~ x ( k ) - - - ( 22 )
Wherein,
a ~ 1 = 1.04 0.025 0.22 0.995 , b ~ 1 = - 0.02845 1.59 &times; 10 - 6 - 2.116 1.42 &times; 10 - 4 , e ~ 1 = - 0.0183 - 0.1123
a ~ 2 = 1.051 0.0255 0.218 0.995 , b ~ 2 = - 0.030 2 . 18 &times; 10 - 6 - 2.224 1.87 &times; 10 - 4 , e ~ 2 = - 0.0175 - 0 . 0792
a ~ 3 = 1.023 0.0252 0.248 0.9951 , b ~ 3 = - 0.030 2.68 &times; 10 - 6 - 2.228 1.23 &times; 10 - 4 , e ~ 3 = - 0.0031 - 0.0376
a ~ 4 = 0.9945 0.0248 0.2732 0.9954 , b ~ 4 = - 0.032 2.77 &times; 10 - 6 - 2.371 2.32 &times; 10 - 4 , e ~ 4 = 0 0
a ~ 5 = 0.9697 0.0245 0.2913 0.9956 , b ~ 5 = - 0.030 2.27 &times; 10 - 6 - 2 . 228 1.98 &times; 10 - 4 , e ~ 5 = - 0.0053 0.0454
a ~ 6 = 0.9594 0.0244 0.3137 0.9959 , b ~ 6 = - 0.029 1.91 &times; 10 - 6 - 2.224 1.73 &times; 10 - 4 , e ~ 6 = - 0.0169 - 0.1193
c ~ = 1 0
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
{ 1 0 x ( k ) + 0.37 &le; 0 } &DoubleLeftRightArrow; { &delta; 1 ( k ) = 1 }
{ 1 0 x ( k ) + 0.153 &le; 0 } &DoubleLeftRightArrow; { &delta; 2 ( k ) = 1 }
{ 1 0 x ( k ) &le; 0 } &DoubleLeftRightArrow; { &delta; 3 ( k ) = 1 }
{ 1 0 x ( k ) - 0.153 &le; 0 } &DoubleLeftRightArrow; { &delta; 4 ( k ) = 1 }
{ 1 0 x ( k ) - 0.37 &le; 0 } &DoubleLeftRightArrow; { &delta; 5 ( k ) = 1 } - - - ( 23 )
Equation (23) may be translated into an equivalent hybrid logical inequality constraint:
1 0 x ( k ) + 0.37 &GreaterEqual; &epsiv; + ( m 1 - &epsiv; ) &delta; 1 ( k ) 1 0 x ( k ) + 0.37 &le; M 1 ( 1 - &delta; 1 ( k ) ) 1 0 x ( k ) + 0.153 &GreaterEqual; &epsiv; + ( m 2 - &epsiv; ) &delta; 2 ( k ) 1 0 x ( k ) + 0.153 &le; M 2 ( 1 - &delta; 2 ( k ) ) 1 0 x ( k ) &GreaterEqual; &epsiv; + ( m 3 - &epsiv; ) &delta; 3 ( k ) 1 0 x ( k ) &le; M 3 ( 1 - &delta; 3 ( k ) ) 1 0 x ( k ) - 0.153 &GreaterEqual; &epsiv; + ( m 4 - &epsiv; ) &delta; 4 ( k ) 1 0 x ( k ) - 0.153 &le; M 4 ( 1 - &delta; 4 ( k ) ) 1 0 x ( k ) - 0.37 &GreaterEqual; &epsiv; + ( m 5 - &epsiv; ) &delta; 5 ( k ) 1 0 x ( k ) - 0.37 &le; M 5 ( 1 - &delta; 5 ( k ) ) - - - ( 24 )
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
&delta; 6 = ( 1 - &delta; 1 ) &delta; 2 &delta; 7 = ( 1 - &delta; 2 ) &delta; 3 &delta; 8 = ( 1 - &delta; 3 ) &delta; 4 &delta; 9 = ( 1 - &delta; 4 ) &delta; 5 - - - ( 25 )
Then16789,1-5Corresponding to six partitions of the piecewise affine model, respectively.
Expression of equation (25) as a hybrid logical inequality constraint:
- &delta; 1 + &delta; 2 - &delta; 6 &le; 0 &delta; 1 + &delta; 6 &le; 1 - &delta; 2 + &delta; 6 &le; 0 - &delta; 2 + &delta; 3 - &delta; 7 &le; 0 &delta; 2 + &delta; 7 &le; 1 - &delta; 3 + &delta; 7 &le; 0 - &delta; 3 + &delta; 4 - &delta; 8 &le; 0 &delta; 3 + &delta; 8 &le; 1 - &delta; 4 + &delta; 8 &le; 0 - &delta; 4 + &delta; 5 - &delta; 9 &le; 0 &delta; 4 + &delta; 9 &le; 1 - &delta; 5 + &delta; 9 &le; 0 - - - ( 26 )
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
z 1 ( k ) = [ a ~ 1 ( k ) x ( k ) + b ~ 1 ( k ) u ( k ) + e ~ 1 ] &delta; 1 ( k ) z 2 ( k ) = [ a ~ 2 ( k ) x ( k ) + b ~ 2 ( k ) u ( k ) + e ~ 2 ] &delta; 6 ( k ) z 3 ( k ) = [ a ~ 3 ( k ) x ( k ) + b ~ 3 ( k ) u ( k ) + e ~ 3 ] &delta; 7 ( k ) z 4 ( k ) = [ a ~ 4 ( k ) x ( k ) + b ~ 4 ( k ) u ( k ) + e ~ 4 ] &delta; 8 ( k ) z 5 ( k ) = [ a ~ 5 ( k ) x ( k ) + b ~ 5 ( k ) u ( k ) + e ~ 5 ] &delta; 9 ( k ) z 6 ( k ) = [ a ~ 6 ( k ) x ( k ) + b ~ 6 ( k ) u ( k ) + e ~ 6 ] ( 1 - &delta; 5 ( k ) ) - - - ( 27 )
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
U F y = { 2200 , 4135,4333,4400,8269,8666 , - 2200 , - 4135 , - 4333 , - 4400 , - 8269 , - 8666 } N
Since the direct lateral force is a discrete variable, the following logical variables are introducedTo describe the direct lateral force
F y b = 2200 &delta; F 1 + 4135 &delta; F 2 + 4333 &delta; F 3 + 4400 &delta; F 4 + 8269 &delta; F 5 + 8666 &delta; F 6 - 2200 &delta; F 7 - 4135 &delta; F 8 - 4333 &delta; F 9 - 4400 &delta; F 10 - 8269 &delta; F 11 - 8666 &delta; F 12 - - - ( 29 )
In equation (29), the logical variables satisfy the following constraints:
&Sigma; i = 1 12 &delta; F i = 0 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 u1zThen the control input in equation (22) is written as
u = u 1 F y b T - - - ( 31 )
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
&Sigma; i = 1 12 &delta; F i &le; 1 - - - ( 33 )
To sum up, the obtained complete mixed logic dynamic model of the composite control missile is
x ( k + 1 ) = &Sigma; i = 1 6 z i ( k ) y ( k ) = 1 0 x ( k ) s . t . ( 24 ) , ( 26 ) , ( 28 ) , ( 29 ) , ( 33 ) - - - ( 34 ) .
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
J * = min u ( k ) , u ( k + 1 ) , &delta; ( k ) , &delta; ( k + 1 | k ) , z ( k ) , z ( k + 1 | k ) &Sigma; i = 1 N ( | | y ( k + i | k ) - y c ( k + i ) | | Q y 2 + | | u ( k + i ) | | R 2 )
s . t . MLD mode l ( 34 ) u 1 min &le; u 1 ( k ) , u 1 ( k + 1 ) &le; u 1 max x min &le; x ( k ) , x ( k + 1 ) &le; x max - - - ( 35 )
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
m V &CenterDot; = P c o s &alpha; c o s &beta; - X a - m g s i n &theta; + F x 2 a m V &theta; &CenterDot; = P ( sin&alpha;cos&gamma; v + cos&alpha;sin&beta;sin&gamma; v ) + Y a cos&gamma; v - m g c o s &theta; + F y 2 a m V cos &theta; &psi; &CenterDot; V = - P ( sin&alpha;sin&gamma; v - cos&alpha;sin&beta;cos&gamma; v ) - Y a sin&gamma; v - Z a cos&gamma; v - F z 2 a - - - ( 1 )
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
J x &omega; &CenterDot; x = ( J y - J z ) &omega; z &omega; y + M x J y &omega; &CenterDot; y = ( J z - J x ) &omega; x &omega; z + M y J z &omega; &CenterDot; z = ( J x - J y ) &omega; x &omega; y + M z - - - ( 2 )
Wherein Jx、JyAnd JzAre respectively the rotational inertia omega of the missile to the three axes of the missile coordinate systemxyzThe 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
M x = M e x + M x 1 a M y = M e y + M y 1 a M z = M e z + M z 1 a - - - ( 3 )
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
F x 1 a F y 1 a F z 1 a = 0 F y 1 + K F y F y 1 F z 1 + K F z F z 1 , M x 1 a M y 1 a M z 1 a = 0 M y 1 + K M y M y 1 M z 1 + K M z M z 1 - - - ( 4 )
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
&alpha; &CenterDot; = &omega; z + &omega; y s i n &alpha; t a n &beta; - Q S ( C y &alpha; &alpha; + C y &delta; z &delta; z ) c o s &alpha; m V cos &beta; - ( F y 1 + K F y F y 1 ) c o s &alpha; m V cos &beta; - G y c o s &alpha; m V c o s &beta; &beta; &CenterDot; = &omega; y c o s &alpha; + Q S ( C z &beta; &beta; + C z &delta; y &delta; y ) c o s &beta; m V + Q S ( C y &alpha; &alpha; + C y &delta; z &delta; z ) s i n &alpha; s i n &beta; m V + ( F y 1 + K F y F y 1 ) sin &alpha; sin &beta; m V + ( F z 1 + K F z F z 1 ) c o s &beta; m V + G z c o s &beta; m V + G y s i n &alpha; s i n &beta; m V - - - ( 5 )
Dynamic equation of angular velocity of projectile
&omega; &CenterDot; y = M y 1 J y + K M y M y 1 J y + QSLm y &beta; &beta; J y + QSLm y &delta; y &delta; y J y + QSLm y &omega; y &omega; y J y &omega; &CenterDot; z = M z 1 J z + K M z M z 1 J z + QSLm z &alpha; &alpha; J z + QSLm z &delta; z &delta; z J z + QSLm z &omega; z &omega; z J z - - - ( 6 )
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
F x 1 i , j F y 1 i , j F z 1 i , j = 0 F m cos ( 2 j - i * 18 &pi; ) - F m sin ( 2 j - i * 18 &pi; ) - - - ( 7 )
Accordingly, the direct lateral moment is expressed in the elastic coordinate system as
M x 1 i , j M y 1 i , j M z 1 i , j = 0 F m l i s i n ( 2 j - i * 18 &pi; ) F m l i cos ( 2 j - i * 18 &pi; ) - - - ( 8 )
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
F x 1 F y 1 F z 1 = 0 &Sigma; j = j 1 , 1 j = j 1 , n 1 F y 1 1 , j + &Sigma; j = j 2 , 1 j = j 2 , n 2 F y 1 2 , j + ... + &Sigma; j = j 10 , 1 j = j 10 , n 10 F y 1 10 , j &Sigma; j = j 1 , 1 j = j 1 , n 1 F z 1 1 , j + &Sigma; j = j 2 , 1 j = j 2 , n 2 F z 1 2 , j + ... + &Sigma; j = j 10 , 1 j = j 10 , n 10 F z 1 10 , j - - - ( 9 )
M x 1 M y 1 M z 1 = 0 - ( &Sigma; j = j 1 , 1 j = j 1 , n 1 F z 1 1 , j l 1 + &Sigma; j = j 2 , 1 j = j 2 , n 2 F z 1 2 , j l 2 + ... + &Sigma; j = j 10 , 1 j = j 10 , n 10 F z 1 10 , j l 10 ) &Sigma; j = j 1 , 1 j = j 1 , n 1 F y 1 1 , j l 1 + &Sigma; j = j 2 , 1 j = j 2 , n 2 F y 1 2 , j l 2 + ... + &Sigma; j = j 10 , 1 j = j 10 , n 10 F y 1 10 , j l 10 - - - ( 10 )
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
F o = F m F m c o s &pi; 9 F m c o s 2 &pi; 9 F m c o s 2 &pi; 9 F m c o s &pi; 9 T - - - ( 11 )
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
F e = F m c o s &pi; 18 F m c o s &pi; 6 F m c o s &pi; 6 F m c o s &pi; 18 T - - - ( 12 )
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
F y 1 &Element; { F m , 2 F m c o s &pi; 9 , 2 F m c o s 2 &pi; 9 , 2 F m , 4 F m c o s &pi; 9 , 4 F m c o s 2 &pi; 9 }
M z 1 &Element; { F 1 l 1 + F 9 l 9 , F 3 l 3 + F 7 l 7 , F 5 l 5 } = { F 1 ( l 5 + 4 &Delta; l ) + F 1 ( l 5 - 4 &Delta; l ) , F 3 ( l 5 + 2 &Delta; l ) + F 3 ( l 5 - 2 &Delta; l ) , F 5 l 5 } = { F 5 l 5 , 2 F 1 l 5 , 2 F 3 l 5 } = F y 1 l 5 = { F m l 5 , 2 F m cos &pi; 9 l 5 , 2 F m cos 2 &pi; 9 l 5 , 2 F m l 5 , 4 F m cos &pi; 9 l 5 , 4 F m cos 2 &pi; 9 l 5 } - - - ( 14 )
Similarly, when an even-numbered cycle pulse engine is ignited, there are
F y 1 &Element; { 2 F m c o s &pi; 18 , 2 F m c o s &pi; 6 , 4 F m c o s &pi; 18 , 4 F m c o s &pi; 6 }
M z 1 &Element; { F 2 l 2 + F 10 l 10 , F 4 l 4 + F 8 l 8 , F 6 l 6 } = { F 2 ( l 6 + 4 &Delta; l ) + F 2 ( l 6 - 4 &Delta; l ) , F 4 ( l 6 + 2 &Delta; l ) + F 4 ( l 6 - 2 &Delta; l ) , F 6 l 6 } = { F 6 l 6 , 2 F 2 l 6 , 2 F 4 l 6 } = F y 1 l 6 = { 2 F m cos &pi; 18 l 6 , 2 F m cos &pi; 6 l 6 , 4 F m cos &pi; 18 l 6 , 4 F m cos &pi; 6 l 6 } - - - ( 15 )
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
U F y + = { F m , 2 F m c o s &pi; 9 , 2 F m c o s &pi; 18 , 2 F m , 4 F m c o s &pi; 9 , 4 F m c o s &pi; 18 } - - - ( 16 )
Different values of resultant moment form set
U M y + = { F m l , 2 F m c o s &pi; 9 l , 2 F m c o s &pi; 18 l , 2 F m l , 4 F m c o s &pi; 9 l , 4 F m c o s &pi; 18 l } - - - ( 17 )
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
U F y - = { - F m , - 2 F m c o s &pi; 9 , - 2 F m c o s &pi; 18 , - 2 F m , - 4 F m c o s &pi; 9 , - 4 F m c o s &pi; 18 } - - - ( 18 )
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)
&alpha; &CenterDot; = &omega; z - Q S ( C y &alpha; &alpha; + C y &delta; z &delta; z ) cos &alpha; m V - ( 1 + K F y ) F y 1 cos &alpha; m V &omega; &CenterDot; z = ( 1 + K M z ) F y 1 l J z + QSLm z &alpha; &alpha; J z + QSLm z &delta; z &delta; z J z + QSLm z &omega; z &omega; z J z - - - ( 19 )
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
x &CenterDot; ( t ) = f ( x ) + g ( x ) u ( t ) y ( t ) = 1 0 x ( t ) - - - ( 20 )
Wherein,
f ( x ) = &omega; z - QSC y &alpha; &alpha; cos &alpha; m V Q S L ( m z &alpha; &alpha; + m z &omega; z &omega; z ) J z , g ( x ) = - QSC y &delta; z cos &alpha; m V - ( 1 + K F y ) cos &alpha; m V QSLm z &delta; z J z ( 1 + K M z ) l J z
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:
x &CenterDot; ( t ) = a 1 x ( t ) + b 1 u ( t ) + e 1 , 1 0 x ( t ) &le; - 0.37 a 2 x ( t ) + b 2 u ( t ) + e 2 , - 0.37 < 1 0 x ( t ) &le; - 0.153 a 3 x ( t ) + b 3 u ( t ) + e 3 , - 0.153 < 1 0 x ( t ) &le; 0 a 4 x ( t ) + b 4 u ( t ) + e 4 , 0 < 1 0 x ( t ) &le; 0.153 a 5 x ( t ) + b 5 u ( t ) + e 5 , 0.153 < 1 0 x ( t ) &le; 0.37 a 6 x ( t ) + b 6 u ( t ) + e 6 , 1 0 x ( t ) > 0.37 - - - ( 21 )
y(t)=cx(t)
wherein,
a i = &part; f ( x ) &part; x | x = x i 0 = a i 11 a i 12 a i 21 a i 22 , b i = g ( x i 0 ) = b i 11 b i 12 b i 21 b i 22 , e i = e i 1 e i 2
a i 11 = &part; f 1 &part; &alpha; | x = x i 0 = - Q S m V ( &part; C y &alpha; &part; &alpha; | &alpha; = &alpha; i 0 &alpha; i 0 c o s ( &alpha; i 0 ) + C y &alpha; ( &alpha; i 0 ) c o s ( &alpha; i 0 ) - C y &alpha; ( &alpha; i 0 ) &alpha; i 0 s i n ( &alpha; i 0 ) )
a i 12 = &part; f 1 &part; &omega; z | x = x i 0 = 1
a i 21 = &part; f 2 &part; &alpha; | x = x i 0 = Q S L J z ( &part; m z &alpha; &part; &alpha; | &alpha; = &alpha; i 0 &alpha; i 0 + m z &alpha; ( &alpha; i 0 ) + &part; m z &omega; z &part; &alpha; | &alpha; = &alpha; i 0 &omega; z i 0 )
a i 22 = &part; f 2 &part; &omega; z | x = x i 0 = Q S L J z m z &omega; z ( &alpha; i 0 )
b i 11 = - Q S m V C y &delta; z ( &alpha; i 0 ) c o s ( &alpha; i 0 )
b i 12 = - ( 1 + K F y ( &alpha; i 0 ) ) c o s ( &alpha; i 0 ) m V
b i 21 = Q S L J z m z &delta; z ( &alpha; i 0 )
b i 22 = ( 1 + K M z ( &alpha; i 0 ) ) l J z
e i 1 = a i 11 &alpha; i 0 + a i 12 &omega; z i 0
e i 2 = a i 21 &alpha; i 0 + a i 22 &omega; z i 0
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
x ( k + 1 ) = a ~ 1 x ( k ) + b ~ 1 u ( k ) + e ~ 1 , 1 0 x ( k ) &le; - 0.37 a ~ 2 x ( k ) + b ~ 2 u ( k ) + e ~ 2 , - 0.37 < 1 0 x ( k ) &le; - 0.153 a ~ 3 x ( k ) + b ~ 3 u ( k ) + e ~ 3 , - 0.153 < 1 0 x ( k ) &le; 0 a ~ 4 x ( k ) + b ~ 4 u ( k ) + e ~ 4 , 0 < 1 0 x ( k ) &le; 0.153 a ~ 5 x ( k ) + b ~ 5 u ( k ) + e ~ 5 , 0.153 < 1 0 x ( k ) &le; 0.37 a ~ 6 x ( k ) + b ~ 6 u ( k ) + e ~ 6 , 1 0 x ( k ) > 0.37 - - - ( 22 )
y ( k ) = c ~ x ( k )
Wherein,
a ~ 1 = 1.04 0.025 0.22 0.995 , b ~ 1 = - 0.02845 1.59 &times; 10 - 6 - 2.116 1.42 &times; 10 - 4 , e ~ 1 = - 0.0183 - 0.1123
a ~ 2 = 1.051 0.0255 0.218 0.995 , b ~ 2 = - 0.030 2.18 &times; 10 - 6 - 2.224 1.87 &times; 10 - 4 , e ~ 2 = - 0.0175 - 0.0792
a ~ 3 = 1.023 0.0252 0.248 0.9951 , b ~ 3 = - 0.030 2.68 &times; 10 - 6 - 2.228 2.23 &times; 10 - 4 , e ~ 3 = - 0.0031 - 0.0376
a ~ 4 = 0.9945 0.0248 0.2732 0.9954 , b ~ 4 = - 0.032 2.77 &times; 10 - 6 - 2.371 2.32 &times; 10 - 4 , e ~ 4 = 0 0
a ~ 5 = 0.9697 0.0245 0.2913 0.9956 , b ~ 5 = - 0.030 2.27 &times; 10 - 6 - 2.228 1.98 &times; 10 - 4 , e ~ 5 = - 0.0053 0.0454
a ~ 6 = 0.9594 0.0244 0.3137 0.9959 , b ~ 6 = - 0.029 1.91 &times; 10 - 6 - 2.224 1.73 &times; 10 - 4 , e ~ 6 = - 0.0169 0.1193
c ~ = 1 0
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
{ 1 0 x ( k ) + 0.37 &le; 0 } &DoubleLeftRightArrow; { &delta; 1 ( k ) = 1 } { 1 0 x ( k ) + 0.153 &le; 0 } &DoubleLeftRightArrow; { &delta; 2 ( k ) = 1 } { 1 0 x ( k ) &le; 0 } &DoubleLeftRightArrow; { &delta; 3 ( k ) = 1 } { 1 0 x ( k ) - 0.153 &le; 0 } &DoubleLeftRightArrow; { &delta; 4 ( k ) = 1 } { 1 0 x ( k ) - 0.37 &le; 0 } &DoubleLeftRightArrow; { &delta; 5 ( k ) = 1 } - - - ( 23 )
Equation (23) may be translated into an equivalent hybrid logical inequality constraint:
1 0 x ( k ) + 0.37 &GreaterEqual; &epsiv; + ( m 1 - &epsiv; ) &delta; 1 ( k ) 1 0 x ( k ) + 0.37 &le; M 1 ( 1 - &delta; 1 ( k ) ) 1 0 x ( k ) + 0.153 &GreaterEqual; &epsiv; + ( m 2 - &epsiv; ) &delta; 2 ( k ) 1 0 x ( k ) + 0.153 &le; M 2 ( 1 - &delta; 2 ( k ) ) 1 0 x ( k ) &GreaterEqual; &epsiv; + ( m 3 - &epsiv; ) &delta; 3 ( k ) 1 0 x ( k ) &le; M 3 ( 1 - &delta; 3 ( k ) ) 1 0 x ( k ) - 0.153 &GreaterEqual; &epsiv; + ( m 4 - &epsiv; ) &delta; 4 ( k ) 1 0 x ( k ) - 0.153 &le; M 4 ( 1 - &delta; 4 ( k ) ) 1 0 x ( k ) - 0.37 &GreaterEqual; &epsiv; + ( m 5 - &epsiv; ) &delta; 5 ( k ) 1 0 x ( k ) - 0.37 &le; M 5 ( 1 - &delta; 5 ( k ) ) - - - ( 24 )
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
&delta; 6 = ( 1 - &delta; 1 ) &delta; 2 &delta; 7 = ( 1 - &delta; 2 ) &delta; 3 &delta; 8 = ( 1 - &delta; 3 ) &delta; 4 &delta; 9 = ( 1 - &delta; 4 ) &delta; 5 - - - ( 25 )
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:
- &delta; 1 + &delta; 2 - &delta; 6 &le; 0 &delta; 1 + &delta; 6 &le; 1 - &delta; 2 + &delta; 6 &le; 0 - &delta; 2 + &delta; 3 - &delta; 7 &le; 0 &delta; 2 + &delta; 7 &le; 1 - &delta; 3 + &delta; 7 &le; 0 - &delta; 3 + &delta; 4 - &delta; 8 &le; 0 &delta; 3 + &delta; 8 &le; 1 - &delta; 4 + &delta; 8 &le; 0 - &delta; 4 + &delta; 5 - &delta; 9 &le; 0 &delta; 4 + &delta; 9 &le; 1 - &delta; 5 + &delta; 9 &le; 0 - - - ( 26 )
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
z 1 ( k ) = &lsqb; a ~ 1 ( k ) x ( k ) + b ~ 1 ( k ) u ( k ) + e ~ 1 &rsqb; &delta; 1 ( k ) z 2 ( k ) = &lsqb; a ~ 2 ( k ) x ( k ) + b ~ 2 ( k ) u ( k ) + e ~ 2 &rsqb; &delta; 6 ( k ) z 3 ( k ) = &lsqb; a ~ 3 ( k ) x ( k ) + b ~ 3 ( k ) u ( k ) + e ~ 3 &rsqb; &delta; 7 ( k ) z 4 ( k ) = &lsqb; a ~ 4 ( k ) x ( k ) + b ~ 4 ( k ) u ( k ) + e ~ 4 &rsqb; &delta; 8 ( k ) z 5 ( k ) = &lsqb; a ~ 5 ( k ) x ( k ) + b ~ 5 ( k ) u ( k ) + e ~ 5 &rsqb; &delta; 9 ( k ) z 6 ( k ) = &lsqb; a ~ 6 ( k ) x ( k ) + b ~ 6 ( k ) u ( k ) + e ~ 6 &rsqb; ( 1 - &delta; 5 ( k ) ) - - - ( 27 )
Expression of equation (27) as a hybrid logical inequality constraint:
z 1 ( k ) &GreaterEqual; &lsqb; a ~ 1 ( k ) x ( k ) + b ~ 1 ( k ) u ( k ) + e ~ 1 &rsqb; - M f 1 ( 1 - &delta; 1 ( k ) ) z 1 ( k ) &le; &lsqb; a ~ 1 ( k ) x ( k ) + b ~ 1 ( k ) u ( k ) + e ~ 1 &rsqb; - m f 1 ( 1 - &delta; 1 ( k ) ) z 1 ( k ) &GreaterEqual; m f 1 &delta; 1 ( k ) z 1 ( k ) &le; M f 1 &delta; 1 ( k ) z 2 ( k ) &GreaterEqual; &lsqb; a ~ 2 ( k ) x ( k ) + b ~ 2 ( k ) u ( k ) + e ~ 2 &rsqb; - M f 2 ( 1 - &delta; 6 ( k ) ) z 2 ( k ) &le; &lsqb; a ~ 2 ( k ) x ( k ) + b ~ 2 ( k ) u ( k ) + e ~ 2 &rsqb; - m f 2 ( 1 - &delta; 6 ( k ) ) z 2 ( k ) &GreaterEqual; m f 2 &delta; 1 ( k ) z 2 ( k ) &le; M f 2 &delta; 1 ( k ) z 3 ( k ) &GreaterEqual; &lsqb; a ~ 3 ( k ) x ( k ) + b ~ 3 ( k ) u ( k ) + e ~ 3 &rsqb; - M f 3 ( 1 - &delta; 7 ( k ) ) z 3 ( k ) &le; &lsqb; a ~ 3 ( k ) x ( k ) + b ~ 3 ( k ) u ( k ) + e ~ 3 &rsqb; - m f 3 ( 1 - &delta; 7 ( k ) ) z 3 ( k ) &GreaterEqual; m f 3 &delta; 7 ( k ) z 3 ( k ) &le; M f 3 &delta; 7 ( k ) z 4 ( k ) &GreaterEqual; &lsqb; a ~ 4 ( k ) x ( k ) + b ~ 4 ( k ) u ( k ) + e ~ 4 &rsqb; - M f 4 ( 1 - &delta; 8 ( k ) ) z 4 ( k ) &le; &lsqb; a ~ 1 ( k ) x ( k ) + b ~ 4 ( k ) u ( k ) + e ~ 4 &rsqb; - m f 4 ( 1 - &delta; 8 ( k ) ) z 4 ( k ) &GreaterEqual; m f 4 &delta; 8 ( k ) z 4 ( k ) &le; M f 4 &delta; 8 ( k ) z 5 ( k ) &GreaterEqual; &lsqb; a ~ 5 ( k ) x ( k ) + b ~ 5 ( k ) u ( k ) + e ~ 5 &rsqb; - M f 5 ( 1 - &delta; 9 ( k ) ) z 5 ( k ) &le; &lsqb; a ~ 5 ( k ) x ( k ) + b ~ 5 ( k ) u ( k ) + e ~ 5 &rsqb; - m f 5 ( 1 - &delta; 9 ( k ) ) z 5 ( k ) &GreaterEqual; m f 5 &delta; 9 ( k ) z 5 ( k ) &le; M f 5 &delta; 9 ( k ) z 6 ( k ) &GreaterEqual; &lsqb; a ~ 6 ( k ) x ( k ) + b ~ 6 ( k ) u ( k ) + e ~ 6 &rsqb; - M f 6 &delta; 5 ( k ) z 6 ( k ) &le; &lsqb; a ~ 6 ( k ) x ( k ) + b ~ 6 ( k ) u ( k ) + e ~ 6 &rsqb; - m f 6 &delta; 5 ( k ) z 6 ( k ) &GreaterEqual; m f 6 ( 1 - &delta; 5 ( k ) ) z 6 ( k ) &le; M f 6 ( 1 - &delta; 5 ( k ) ) - - - ( 28 )
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
U F y = { 2200,4135,4333,4400,8269,8666 , - 2200 , - 4135 , - 4333 , - 4400 , - 8269 , - 8666 } N
The following logic variables were introducedTo describe the direct lateral force
U F y = { 2200 , 4135 , 4333 , 4400 , 8269 , 8666 , - 2200 , - 4135 , - 4333 , - 4400 , - 8269 , - 8666 } N
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 u1zThen the control input in equation (22) is written as
u = u 1 F y b T - - - ( 31 )
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
x min &le; x ( k ) &le; x max u 1 min &le; u 1 ( k ) &le; u 1 max - - - ( 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
&Sigma; i = 1 12 &delta; F i &le; 1 - - - ( 33 )
To sum up, the obtained complete mixed logic dynamic model of the composite control missile is
x ( k + 1 ) = &Sigma; i = 1 6 z i ( k ) y ( k ) = 1 0 x ( k ) s . t . ( 24 ) , ( 26 ) , ( 28 ) , ( 29 ) , ( 33 ) - - - ( 34 ) .
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
J * = min u ( k ) , u ( k + 1 ) , &delta; ( k ) , &delta; ( k + 1 | k ) , z ( k ) , z ( k + 1 | k ) &Sigma; i = 1 N ( | | y ( k + i | k ) - y c ( k + i ) | | Q y 2 + | | u ( k + i ) | | R 2 )
s . t . M L D mod e l ( 34 ) u 1 min &le; u 1 ( k ) , u 1 ( k + 1 ) &le; u 1 m a x x m i n &le; x ( k ) , x ( k + 1 ) &le; x m a x - - - ( 35 )
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.
CN201410578127.1A 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 Active CN104267733B (en)

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)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
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

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