Guidance and control integrated design method under general view field constraint, equipment and medium

By constructing an integrated model of missile-target relative kinematics and dynamic equations and guidance control, combining state-related Riccati equations and control obstacle functions, the problem of large angle of attack interception/strike under the field of view constraint of seeker is solved, and high Accurate guidance control ensures the missile's efficient interception/strike capability under limited field of view.

CN118938675APending Publication Date: 2024-11-12BEIHANG UNIV +1
View PDF 0 Cites 2 Cited by

Patent Information

Application Number
CN202410997407.X
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Filing Date
2024-07-24
Publication Date
2024-11-12

AI Technical Summary

Technical Problem

The prior art is difficult to achieve high-precision guidance control for large angle of attack interception/strike scenes under the general field of view constraints of seekers, especially when the field of view range of seekers is limited and the attack angle is large, traditional methods cannot Effectively lock the target, and cannot take into account both optimality and constraint satisfaction.

Method used

By constructing missile-target relative kinematics and dynamics equations, constructing an integrated model of guidance control, and using the state-dependent Riccati equation to construct nominal control law, combining the control obstacle function and the minimum intervention framework of quadratic planning, the guidance control law is corrected. Meet the field of view constraints, realize the affine constraints of the tail rudder deflection angle, and ensure that the missile intercepts/strikes the target at the desired attack angle under the limited field of view.

Benefits of technology

Under the general field of view constraints of seeker, high-precision guidance control for large angle of attack interception/strike scenes is realized, ensuring the optimality and constraint satisfaction of the control law, avoiding the risk of sight exceeding the constraint range, and suitable for low-cost guidance Practical application scenarios of leads.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938675A_ABST
    Figure CN118938675A_ABST
Patent Text Reader

Abstract

The invention discloses a guidance and control integrated design method under general view field constraint, equipment and a medium, and relates to the field of control or adjustment of non-electrical variables, and the method comprises the steps: constructing a missile-target relative kinematics and dynamics equation, and constructing a guidance and control integrated model based on the equation by considering an attack angle and view field constraint. Constructing a nominal control law through a state correlation Riccati equation based on the model; determining a closed feedback control law based on the nominal control law; constructing a control barrier function, and determining a constraint set corresponding to the control barrier function; judging whether the view field constraint is triggered or not based on the control barrier function, and if not, taking a closed feedback control law as an integrated guidance control law to complete guidance control design; if yes, the integrated guidance control law is corrected, guidance control design is completed based on the corrected integrated guidance control law, and guidance control of a large-attack-angle interception / attack scene can be achieved at the expected attack angle under the constraint of a general view field.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present application relates to the field of control or regulation of non-electrical variables, and in particular to a guidance and control integrated design method, equipment and medium under general field of view constraints. Background Art

[0002] The integrated design of guidance and control is one of the important topics in the field of aircraft navigation, guidance and control. The traditional guidance and control method separates the design of the guidance loop and the control loop, and it is necessary to assume that the response speed of the control loop is much faster than that of the guidance loop, that is, the two loops have two different time scales. However, in the scenario of intercepting / attacking a target at a given attack angle, tactical missiles need to use very large overloads to adjust the warhead and speed direction to meet the attack angle constraint. At this point, the traditional method of designing two loops independently is no longer applicable, and it is difficult to achieve high-precision strike missions.

[0003] For low-cost seekers, the available field of view is limited, that is, the target motion information can only be captured within a bounded interval. However, when the expected attack angle is large, the curvature of the missile's flight trajectory is large, causing the missile's line of sight to exceed the available field of view of the airborne seeker, and thus failing to lock the desired interception / strike target. Most of the existing methods focus on guidance law design, such as improved bias proportional guidance, sliding mode control, and nonlinear control methods under state constraints. It should be pointed out that the above methods all have certain limitations. For example, the improved bias proportional guidance method uses a tracking method in the initial stage to limit the lead angle and uses bias proportional guidance at the end to meet the attack angle constraint. This processing method will inevitably lead to a sudden change in the guidance command at the switching moment, which is unreasonable in actual application scenarios. Although there is no switching of guidance commands in sliding mode control and nonlinear control methods under state constraints, they can only be used to intercept stationary and non-maneuvering moving targets. In addition, both methods need to assume that the available field of view of the seeker is symmetrical. However, in actual applications, the seeker may have an asymmetric field of view due to air burning, which means that the above methods are no longer feasible. More importantly, these methods only consider the guidance loop and cannot be used for large angle of attack interception / strike scenarios. Therefore, how to design an integrated guidance control law under the general field of view constraint of the seeker to achieve the desired attack angle has become a technical problem to be solved in this field. Summary of the invention

[0004] The purpose of this application is to provide a guidance and control integrated design method, equipment and medium under general field of view constraints, which can realize guidance and control of large-angle interception / strike scenarios at a desired attack angle under general field of view constraints.

[0005] To achieve the above objectives, this application provides the following solutions:

[0006] In a first aspect, the present application provides a guidance and control integrated design method under general field of view constraints, comprising:

[0007] Construct missile-target relative kinematic and dynamic equations;

[0008] Based on the missile-target relative kinematics and dynamics equations, an integrated guidance and control model is constructed taking into account the attack angle and field of view constraints;

[0009] Based on the guidance and control integrated model, a nominal control law is constructed through the state-dependent Riccati equation;

[0010] determining a closed feedback control law based on the nominal control law;

[0011] Constructing a control barrier function and determining a constraint set corresponding to the control barrier function;

[0012] Determine whether to trigger the field of view constraint based on the control obstacle function, and obtain a determination result;

[0013] When the judgment result is no, the closed feedback control law is used as the integrated guidance control law to complete the guidance control design;

[0014] When the judgment result is yes, the integrated guidance control law is corrected based on the admissible control law and the closed feedback control law until the forward invariance condition of the constraint set is met, and the corrected integrated guidance control law is obtained to complete the guidance control design.

[0015] Optionally, the missile-target relative kinematics and dynamics equations constructed include:

[0016] The missile-target relative kinematic equation is expressed as:

[0017]

[0018] The dynamic equation of the missile pitch channel is expressed as:

[0019]

[0020] Where R represents the relative distance between the missile and the target, λ represents the inertial line of sight angle, and γ M represents the heading angle of the missile, γ T Indicates the heading angle of the target, V M represents the speed of the missile, V T represents the speed of the target, a M is the missile's acceleration, a T represents the acceleration of the target, α represents the angle of attack, θ represents the pitch angle, L represents the aerodynamic lift, m represents the mass of the missile, ω zrepresents the pitch angle rotation rate, M represents the pitch rotation torque, J z represents the moment of inertia, Indicates the rate of change of *.

[0021] Optionally, the guidance and control integrated model is expressed as:

[0022]

[0023] In the formula, e λ =λ-λ d represents the inertial line of sight angle tracking error, Q represents the dynamic pressure, S represents the reference area, l represents the reference length, δ z represents the tail rudder deflection angle, represents the aerodynamic lift derivative for the angle of attack α, represents the derivative of the pitch torque with respect to the angle of attack α, The pitch torque is expressed as the pitch angle rotation rate ω z The derivative of It represents the pitch torque to the tail rudder deflection angle δ z The derivative of .

[0024] Optionally, constructing a nominal control law based on the guidance and control integrated model through a state-dependent Riccati equation specifically includes:

[0025] According to the structural form of the guidance and control integrated model, the guidance and control integrated model is parameterized by using state-related factors to transform the guidance and control integrated model into a pseudo-linear control system;

[0026] Design a formal quadratic performance index function; the formal quadratic performance index function is expressed as: Where Q(x) represents the weight matrix corresponding to the state, R(x) represents the weight matrix corresponding to the input, x represents the state in the guidance and control integrated model, J represents the quadratic performance index, u represents the admissible control law, and T represents the transpose;

[0027] Based on the pseudo-linear control system and the formal quadratic performance index function, a nominal control law is constructed using the state-dependent Riccati equation technology.

[0028] Optionally, the control barrier function is expressed as:

[0029]

[0030] The constraint set corresponding to the control barrier function is expressed as:

[0031]

[0032] In the formula, h1[1] (x) = e λ -γ M -α-η1 represents the first-order control obstacle function corresponding to constraint condition 1, η1 represents the difference between the minimum missile body sight angle and the terminal inertial sight angle representing the seeker field of view constraint interval, h1 [2] (x) represents the second-order control barrier function corresponding to constraint 1, Indicates h1 [n] The derivative of (x) with respect to time, α1(·) represents the expansion Class function, L f h1 [1] (x) indicates h1 [1] (x) Lie derivative along the vector field f, h2 [1] (x) = -e λ +γ M +α+η2 represents the first-order control obstacle function corresponding to constraint condition 2, η2 represents the difference between the maximum missile body sight angle and the terminal inertial sight angle in the seeker field of view constraint interval, and h2 [2] (x) represents the second-order control barrier function corresponding to constraint 2, Represents h2 [1] The derivative of (x) with respect to time, L f h2 [1] (x) represents h2 [1] (x) Lie derivative along the vector field f, represents the constraint set corresponding to constraint condition 1, represents the constraint set corresponding to constraint condition 2, Represents the constraint set corresponding to constraint condition 1 The constraint set corresponding to constraint 2 The intersection of .

[0033] Optionally, a minimum intervention framework of quadratic programming is used to correct the integrated guidance control law based on the admissible control law and the closed feedback control law; wherein the minimum intervention framework of quadratic programming is expressed as:

[0034]

[0035] Where u represents the admissible control law, represents the control admissible set, u * represents the modified integrated guidance control law, u ref Represents closed feedback control law, a1=L g L f h1 [1] (x) represents the Lie derivative of constraint 1 along the vector field f and the vector field g, represents the second-order Lie derivative of constraint 1 along the vector field f, represents the Lie derivative of constraint 2 along the vector field f and the vector field g, represents the second-order Lie derivative of constraint 2 along the vector field f.

[0036] In a second aspect, the present application provides a computer device, comprising: a memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the computer program to implement the steps of the guidance and control integrated design method under general field of view constraints described in any one of the above.

[0037] In a third aspect, the present application provides a computer-readable storage medium having a computer program stored thereon, which, when executed by a processor, implements the steps of the guidance and control integrated design method under general field of view constraints as described in any one of the above.

[0038] According to the specific embodiments provided in this application, this application discloses the following technical effects:

[0039] The present application provides a guidance and control integrated design method, equipment and medium under general field of view constraints, and uses the state-dependent Riccati equation to construct a nominal control law to achieve interception / strike of the target at the desired attack angle. Considering the low cost of the missile, the seeker can only capture the target motion information within a limited range. The present application mathematically describes the constraint conditions by constructing a control obstacle function, and converts the general field of view constraint satisfaction into a super-level set forward invariant defined by the obstacle function, and then converts it into an affine constraint of the control input (i.e., the tail rudder deflection angle). In order to take into account both optimality and constraint satisfaction, the present application modifies the integrated guidance control law based on the admissible control law and the closed feedback control law. Under the premise of satisfying the field of view constraint, the optimality of the control law is guaranteed as much as possible, so as to be able to achieve guidance control of large attack angle interception / strike scenarios at the desired attack angle under the general field of view constraint. BRIEF DESCRIPTION OF THE DRAWINGS

[0040] In order to more clearly illustrate the embodiments of the present application or the technical solutions in the prior art, the drawings required for use in the embodiments will be briefly introduced below. Obviously, the drawings described below are only some embodiments of the present application. For ordinary technicians in this field, other drawings can be obtained based on these drawings without paying creative work.

[0041] Figure 1 This is an application environment diagram of a guidance and control integrated design method under general field of view constraints in one embodiment of the present application;

[0042] Figure 2 A schematic diagram of a flow chart of a guidance and control integrated design method under general field of view constraints provided in one embodiment of the present application;

[0043] Figure 3 A schematic diagram of the motion trajectory of a missile and a target provided in an embodiment of the present application;

[0044] Figure 4 This is a diagram of attack angle simulation results provided by an embodiment of the present application;

[0045] Figure 5 A diagram showing the stereoscopic line of sight angle simulation results provided by an embodiment of the present application;

[0046] Figure 6 This is a diagram of the angle of attack simulation result provided by an embodiment of the present application;

[0047] Figure 7 A diagram showing the simulation results of the rudder deflection angle provided in an embodiment of the present application;

[0048] Figure 8 A schematic diagram of the structure of a computer device provided in one embodiment of the present application. DETAILED DESCRIPTION

[0049] The following will be combined with the drawings in the embodiments of the present application to clearly and completely describe the technical solutions in the embodiments of the present application. Obviously, the described embodiments are only part of the embodiments of the present application, not all of the embodiments. Based on the embodiments in the present application, all other embodiments obtained by ordinary technicians in this field without creative work are within the scope of protection of this application.

[0050] In order to make the above-mentioned objects, features and advantages of the present application more obvious and easy to understand, the present application is further described in detail below with reference to the accompanying drawings and specific implementation methods.

[0051] The guidance and control integrated design method under general field of view constraints provided in the embodiments of the present application can be applied to Figure 1In the application environment shown, the terminal 102 communicates with the server 104 through a network. The data storage system can store data that the server 104 needs to process. The data storage system can be set up separately, integrated on the server 104, or placed on the cloud or other servers. The terminal 102 can send various parameters of the missile and the target to the server 104. After receiving the various parameters of the missile and the target, the server 104 constructs the missile-target relative kinematics and dynamics equations for the various parameters of the missile and the target; based on the missile-target relative kinematics and dynamics equations, the guidance control integration model is constructed by considering the attack angle and the field of view constraint; based on the guidance control integration model, the nominal control law is constructed by the state-related Riccati equation; based on the nominal control law, the closed feedback control law is determined; a control obstacle function is constructed, and a constraint set corresponding to the control obstacle function is determined; based on the control obstacle function, whether the field of view constraint is triggered is determined to obtain a judgment result; when the judgment result is no, the closed feedback control law is used as the integrated guidance control law to complete the guidance control design; when the judgment result is yes, the integrated guidance control law is corrected based on the admissible control law and the closed feedback control law until the forward invariant condition of the constraint set is met, and the corrected integrated guidance control law is obtained to complete the guidance control design. The server 104 can feed back the obtained integrated guidance control law to the terminal 102. In addition, in some embodiments, the integrated guidance and control design method under general field of view constraints can also be implemented independently by the server 104 or the terminal 102. For example, the terminal 102 can directly complete the guidance and control for the relevant parameters of the missile and the target (such as speed, distance, acceleration, etc.), or the server 104 can obtain the missile and target parameters to be designed from the data storage system, and implement the guidance and control design for the missile and target parameters to be designed.

[0052] The terminal 102 may be, but is not limited to, various desktop computers, laptop computers, smart phones, tablet computers, IoT devices, and portable wearable devices. The IoT devices may be smart speakers, smart TVs, smart air conditioners, smart vehicle-mounted devices, etc. The portable wearable devices may be smart watches, smart bracelets, head-mounted devices, etc. The server 104 may be implemented as an independent server or a server cluster consisting of multiple servers, or may be a cloud server.

[0053] In an exemplary embodiment, the specific implementation method of the guidance and control integration design method under general field of view constraints provided in the present application includes five steps: (1) Establishing the missile-target relative kinematic and dynamic equations to characterize the relative motion relationship between the missile and the target. (2) Considering the attack angle and field of view constraints, a guidance and control integration model is given. (3) The nominal control law is designed through the state-dependent Riccati equation technology. (4) The corresponding control obstacle function is constructed according to the field of view constraint conditions. (5) The nominal control law is modified under the minimum intervention framework based on quadratic programming to achieve precise strike and interception of the target when there is a field of view constraint.

[0054] Based on the above description, if Figure 2 As shown, a guidance and control integrated design method under general field of view constraints is provided, which is executed by a computer device, specifically, it can be executed by a computer device such as a terminal or a server alone, or it can be executed by a terminal and a server together. In the embodiment of the present application, the method is applied to a server as an example for explanation, including the following steps 200 to 205. Among them:

[0055] Step 200: Construct missile-target relative kinematic and dynamic equations.

[0056] In practical applications, it is assumed that the missile and the target move in the same plane, and the moving speeds of the missile and the target are constant. The missile-target relative kinematic equation can be written as:

[0057]

[0058] Where R represents the relative distance between the missile and the target, λ represents the inertial line of sight angle, and γ M represents the heading angle of the missile, γ T Indicates the heading angle of the target, V M represents the speed of the missile, V T represents the speed of the target, a M is the missile's acceleration, a T represents the acceleration of the target, Indicates the rate of change of *.

[0059] The above formula (1) can be further written as:

[0060]

[0061] In the formula, express The rate of change.

[0062] The dynamic equation of the missile pitch channel is expressed as:

[0063]

[0064] In the formula, α represents the angle of attack, θ represents the pitch angle, L represents the aerodynamic lift, m represents the mass of the missile, ω z represents the pitch angle rotation rate, M represents the pitch rotation torque, J z represents the moment of inertia, where the aerodynamic lift L and the rotational torque M z It can be expressed as follows:

[0065]

[0066] Where Q represents dynamic pressure, S represents reference area, l represents reference length, δ z Indicates the tail rudder deflection angle. Symbol represents the aerodynamic lift derivative for the angle of attack α, and similarly, Denote the pitch torque pair α, ω respectively z , δ z The derivative of .

[0067] According to formula (3) and formula (4), the longitudinal acceleration of the missile can be deduced as:

[0068]

[0069] A necessary condition for missiles to achieve interception is to make the zero-control miss amount 0, that is, at the moment of interception, the missile's actual turning rate is 0.

[0070] In order to achieve greater killing effect and break through the enemy's defense system, the missile needs to intercept / strike the target at the desired attack angle. The attack angle is defined as the angle between the missile velocity vector direction and the target velocity vector at the moment of interception, that is, θ imp =γ Mf -γ Tf , where θ imp is the angle of attack, γ Mf and γ Tf They represent the heading angles of the missile and the target at the time of interception. When interception is achieved, the terminal inertial line of sight angle is expressed as:

[0071]

[0072] Among them, λ d represents the terminal inertial line of sight angle, K represents the speed ratio of the missile to the target, K = V T / V M .

[0073] Since the field of view of the missile-borne low-cost strapdown seeker is limited, the missile's stereoscopic line of sight angle η (η=λ-θ) needs to be kept within a given interval to achieve continuous capture of the target, that is:

[0074] ηmin ≤η≤η max (7)

[0075] Among them, η min , η max They are the endpoint values ​​of the seeker field of view constraint interval and can be positive or negative.

[0076] Based on the specific implementation description of this step, the goal of this design in the present application is to design a control law for the tail rudder deflection angle so that the missile can intercept the moving target at the desired attack angle under restricted field of view conditions.

[0077] Step 201: Based on the missile-target relative kinematics and dynamics equations, a guidance and control integration model is constructed taking into account the attack angle and field of view constraints.

[0078] In practical applications, the inertial line of sight tracking error can be defined as e λ , e λ =λ-λ d , and define the state in the guidance and control integrated model as According to the missile-target relative motion equation and the missile longitudinal dynamics equation (i.e., the dynamics equation of the missile pitch channel) in step 200, the guidance and control integrated model can be obtained. The obtained guidance and control integrated model is:

[0079]

[0080] Based on the description of the implementation process, by designing the tail rudder deflection angle δ z The stabilization system can intercept / strike the moving target at the desired angle, transforming the design problem into a system stabilization problem.

[0081] Step 202: construct a nominal control law based on the guidance and control integrated model through the state-dependent Riccati equation.

[0082] In actual application, according to the structural form of the guidance and control integrated model constructed in step 201, the state-related factors can be used to parameterize it and transform it into a pseudo-linear control system as shown in the following formula (9).

[0083]

[0084] in, represents the rate of change of state x in the guidance and control integrated model, and the matrix Represents the coefficient matrix, matrix Describe the control input matrix, u = δ z Indicates control input.

[0085] Considering that in actual engineering applications, the missile tail rudder deflection angle cannot be too large, the following secondary performance index function is designed:

[0086]

[0087] Where Q(x) and R(x) represent the weight matrices corresponding to the state and input, respectively, J represents the quadratic performance index, u represents the admissible control law, and T represents the transpose.

[0088] Next, the state-dependent Riccati equation is used to design the nominal control law for intercepting / attacking the target at the desired attack angle. Specifically, for the pseudo-linear control system and quadratic performance index function obtained above, the matrix equation shown in formula (12) is used to construct the nominal control law.

[0089] P(x)A(x)+A(x)P(x)-P(x)B(x) -1 R -1 (x)B T (x)P(x)+Q(x)=0 (11)

[0090] where P(x) is the solution to the matrix equation.

[0091] Step 203: Determine a closed feedback control law based on the nominal control law.

[0092] In the process of missile interception / target attack, the state in the pseudo-linear control system can always ensure that (A(x), B(x)) is point-wise controllable. Therefore, the determination equation of the nominal control law has a unique, symmetric positive solution. Similar to the linear time-invariant system, a closed feedback control law of the following form can be constructed:

[0093] u ref =-R(x) -1 B T (x)P(x)x (12)

[0094] In the formula, u ref represents a closed feedback control law.

[0095] Under the above nominal control law, the closed-loop system can be described as:

[0096]

[0097] Among them, the coefficient matrix A cl (x) is pointwise Hurwitz, K(x) = -R(x) -1 BT(x)P(x) represents the control gain matrix.

[0098] Based on the above description, the nominal control law achieves local asymptotic stabilization of the guidance and control integrated model, that is, it can intercept / attack mobile targets at a given attack angle. The advantage of using the state-dependent Riccati equation to construct the nominal control law is that it avoids solving the Hamilton-Jacobi-Bellman equation or using approximate methods to approximate the value function. By solving the point-state matrix equation, the closed feedback control law is constructed, which has the characteristics of being robust to parameter uncertainty and external disturbances. Since it is an equivalent description of the Hamilton-Jacobi-Bellman equation in the absence of symmetry conditions, when the system trajectory converges to the vicinity of the equilibrium point, the closed feedback control law converges to the true optimal control law, that is, it still has suboptimality.

[0099] Step 204: construct a control barrier function and determine a constraint set corresponding to the control barrier function.

[0100] Since the nominal control law constructed in step 202 does not consider the seeker field of view constraint, it cannot guarantee that the missile field of view does not exceed the constraint range during flight. Based on this, this step of the present application achieves field of view constraint satisfaction by designing a control obstacle function.

[0101] For example, define the constraint function h1 corresponding to constraint condition 1 [n] =e λ -γ M -α-η1 and constraint function h2 corresponding to constraint condition 2 [1] (x) = -e λ +γ M +α+η2, where η1=η min -λ d , η2=η max -λ d . The following closed set can be constructed from these two functions:

[0102]

[0103] In the formula, η1=η min -λ d The minimum missile body sight angle η represents the seeker field of view constraint interval min The inertial line of sight angle λ with the terminal d The difference between max -λ d The maximum missile body sight angle η represents the seeker field of view constraint interval max The inertial line of sight angle λ with the terminal d The difference, represents the constraint set corresponding to constraint condition 1, represents the constraint set corresponding to constraint condition 2, Represents the constraint set corresponding to constraint condition 1 The constraint set corresponding to constraint 2 The intersection of .

[0104] Therefore, just ensure The forward invariance can achieve the general field of view constraint satisfaction. Function h1 [1] , h2 [1] The Lie derivative of the system can be calculated as:

[0105]

[0106] Among them, L f and L g They represent the Lie derivatives of the function along the vector field f and the vector field g respectively.

[0107] Based on the above description, it can be seen that the field of view constraint has a high relative order characteristic to the control input. Therefore, it is impossible to directly construct a control law that satisfies the constraint. In order to solve this problem, the present application designs an obstacle function in the following form:

[0108]

[0109] In the formula, h1 [1] (x) = e λ -γ M -α-η1 represents the first-order control barrier function corresponding to constraint condition 1, h1 [2] (x) represents the second-order control barrier function corresponding to constraint 1, Indicates h1 [1] The derivative of (x) with respect to time, α1(·) represents the expansion Class function, L f h1 [1] (x) indicates h1 [1] (x) Lie derivative along the vector field f, h2 [1] (x) = -e λ +γ M +α+η2 represents the first-order control barrier function corresponding to the constraint condition, h2 [2] (x) represents the second-order control barrier function corresponding to constraint 2, Represents h2 [1] The derivative of (x) with respect to time, L f h2 [1] (x) represents h2 [1] (x) Lie derivative along the vector field f.

[0110] Furthermore, based on the barrier function of formula (16), the corresponding constraint set is expressed as:

[0111]

[0112] In the formula, represents the set of second-order constraints corresponding to constraint 1, represents the set of second-order constraints corresponding to constraint 2, Represents the constraint set corresponding to constraint condition 1 The constraint set corresponding to constraint 2 The intersection of .

[0113] According to the set invariance theory, for the above-defined function and the corresponding set, if there exists a Lipschitz continuous control law such that Then the collection is forward invariant, where:

[0114]

[0115] In the formula, represents the constraint set corresponding to constraint condition 1, represents the constraint set corresponding to constraint condition 2, α2(h1 [2] (x)) indicates h1 [2] Composite function of (x) and α2.

[0116] Based on the above description, if the control law satisfies the above conditions and the initial state satisfies the constraints, the state will always remain within the constraint set, which can ensure that the line of sight of the seeker will never exceed the constraint range.

[0117] Step 205: Determine whether the field of view constraint is triggered based on the control obstacle function, and obtain a determination result. When the determination result is no, the closed feedback control law is used as the integrated guidance control law to complete the guidance control design. When the determination result is yes, the integrated guidance control law is modified based on the admissible control law and the closed feedback control law until the forward invariance condition of the constraint set is met, and the modified integrated guidance control law is obtained to complete the guidance control design.

[0118] Step 204 gives the necessary conditions that the control law must satisfy under the field of view constraint of the seeker. Based on this, during the implementation of step 205, the nominal control law constructed in step 202 can be combined to design a feedback control law (i.e., integrated guidance control law) that can achieve a certain degree of optimality and ensure that the constraint is always maintained. Based on this, the main implementation ideas in the actual application process are:

[0119] When the field of view constraint is not triggered, that is, the line of sight is within the constraint range, the nominal control law in step 202 is used to determine the final integrated guidance control law. When the field of view constraint is triggered, that is, the line of sight is about to exceed the constraint range, the nominal control law is appropriately corrected to satisfy the control law within the set. In order to minimize the correction of the nominal control law, the present application adopts a minimum intervention framework based on quadratic programming. Among them, the specific form of the minimum intervention framework of quadratic programming is expressed as:

[0120]

[0121] Where u represents the admissible control law, represents the control admissible set, u * represents the modified integrated guidance control law, u ref Represents the closed feedback control law, a1=L g L f h1 [1] (x) represents the Lie derivative of constraint 1 along the vector field f and the vector field g, represents the second-order Lie derivative of constraint 1 along the vector field f, represents the Lie derivative of constraint 2 along the vector field f and the vector field g, represents the second-order Lie derivative of constraint 2 along the vector field f.

[0122] It can be seen that step 205 describes the constraint set in step 204 equivalently as an affine constraint on the control input, and the cost function represents the minimum deviation between the point state and the nominal control. Therefore, the control law obtained by quadratic programming takes into account both constraint satisfaction and optimality. Since the objective function is strictly strongly convex and the inequality constraint is linear, the closed form of the control law can be given by the Karush-Kuhn-Tucker (KKT) condition. From the KKT condition, it can be seen that the optimal solution satisfies the following conditions:

[0123]

[0124] in, or 2, indicating the trigger constraint subscript, k indicating the Lagrange multiplier, a I Indicates a1 or a2, b I Indicates b1 or b2.

[0125] Based on the above description, we discuss the following two situations depending on whether the constraint is triggered:

[0126] (1) When the field of view constraint is not triggered, a I u+b I >0, k=0. At this time, the optimal solution of the minimum intervention framework of quadratic programming is:

[0127] u * =u ref (twenty one)

[0128] It can be seen that when the line of sight meets the constraint conditions, the nominal control will not be corrected, which is in line with the design purpose. If the missile does not trigger the constraint during the entire flight, the given control law can ensure that the moving target is intercepted / struck at the desired attack angle.

[0129] (2) When the field of view constraint is triggered, a I u+b I =0, k>0. At this time, the optimal solution of the minimum intervention framework of quadratic programming is:

[0130]

[0131] Simplifying the above formula (22), we can get: This shows that when the constraint is triggered, the given control law can minimize the pointwise norm to ensure that the field of view constraint is satisfied.

[0132] Furthermore, in order to intercept / strike the target at the desired attack angle, it is also required that the stability of the closed-loop system does not conflict with the constraints, that is, the equilibrium point must be within the constraints, and:

[0133]

[0134] If the constraints in formula (23) are satisfied, the trajectory of the initial value in the area near the equilibrium point can be asymptotically stabilized by the control in formula (20), indicating that the interception / strike mission can be completed at the desired attack angle under general field of view constraints.

[0135] In summary, the overall implementation process of the guidance and control integrated design method provided by the present application can be described as follows: establish a missile-target relative kinematic model and a missile longitudinal plane dynamic model. According to the guidance and control integrated model, the state-dependent Riccati equation is used to design and implement the nominal control law for intercepting / attacking the mobile target at the desired attack angle. According to the general field of view constraint of the seeker, a constraint closed set described by an inequality is established, and the control obstacle function is constructed using the set invariance principle, and the field of view constraint is equivalently converted into a super-level set forward invariant determined by the control obstacle function.

[0136] Compared with the prior art, the present application adopts the state-dependent Riccati equation to construct the nominal control law, so as to intercept / strike the target at the desired attack angle. Considering the low cost of the missile, the seeker can only capture the target motion information within a limited range. The present application adopts the control obstacle function to mathematically describe the constraint conditions, so as to convert the general field of view constraint into the super-level set forward invariant defined by the obstacle function, and then into the affine constraint of the control input (i.e., the tail rudder deflection angle). In order to take into account both optimality and constraint satisfaction, the present application adopts the quadratic programming method to make the minimum correction to the suboptimal nominal control law. Under the premise of satisfying the field of view constraint, the optimality of the control law is guaranteed as much as possible, so that the sight angle of the missile seeker can intercept / strike the moving target at the desired attack angle while satisfying the general field of view constraint, thereby completing the combat mission with high precision.

[0137] In an exemplary embodiment, consider a missile launched from the origin with an initial heading angle of 40° and a flight speed of 500m / s. The initial interception position is a moving target 8km away from it in the horizontal direction. The target flight speed is 250m / s, and the expected attack angle is -60°. The field of view of the seeker is limited to an extremely narrow interval of the same sign [-30°, -20°], that is, the seeker can only capture the target motion information from one side within a 10° interval. Based on this, the guidance and control integrated design method provided in the present application is used to design the missile guidance control law. Among them, the simulation results of attacking stationary targets are as follows. Figures 3 to 7 shown. Figure 3 The trajectory of the missile intercepting the target is shown. Figures 4 to 7 The change curves of attack angle, seeker body sight angle, attack angle and tail rudder deflection angle are given respectively. Figure 4 and Figure 5 It can be seen that even though the initial line of sight exceeds the constraint range, the control law designed in this application can quickly adjust the seeker line of sight to a very narrow constraint range and always meet the constraint conditions during the remaining flight. This feature greatly expands the scope of application of the guidance and control integrated design method provided by this application. Figure 6 and Figure 7 It can be seen that the attack angle converges to the expected value when hitting the target, that is, a high-precision interception mission is achieved. Figure 6 and Figure 7 It can also be seen that at the moment of intercepting the target, the missile attack angle and the tail rudder deflection angle converge to near zero and there is no buffeting or mutation. This advantage makes the guidance and control integrated design method provided in this application suitable for actual application scenarios.

[0138] In an exemplary embodiment, a computer device is provided. The computer device may be a server or a terminal. The internal structure diagram thereof may be as follows: Figure 8As shown. The computer device includes a processor, a memory, an input / output interface (Input / Output, referred to as I / O) and a communication interface. Among them, the processor, the memory and the input / output interface are connected through a system bus, and the communication interface is connected to the system bus through the input / output interface. Among them, the processor of the computer device is used to provide computing and control capabilities. The memory of the computer device includes a non-volatile storage medium and an internal memory. The non-volatile storage medium stores an operating system, a computer program and a database. The internal memory provides an environment for the operation of the operating system and the computer program in the non-volatile storage medium. The database of the computer device is used to store guidance and control processing data. The input / output interface of the computer device is used to exchange information between the processor and an external device. The communication interface of the computer device is used to communicate with an external terminal through a network connection. When the computer program is executed by the processor, a guidance and control integrated design method under general field of view constraints is implemented.

[0139] Those skilled in the art will understand that Figure 8 The structure shown in the figure is only a block diagram of a part of the structure related to the solution of the present application, and does not constitute a limitation on the computer device to which the solution of the present application is applied. The specific computer device may include more or fewer components than those shown in the figure, or combine certain components, or have a different arrangement of components. In an exemplary embodiment, a computer device is provided, including a memory and a processor, wherein a computer program is stored in the memory, and the processor implements the steps in the above-mentioned method embodiments when executing the computer program.

[0140] In an exemplary embodiment, a computer-readable storage medium is provided, storing a computer program, and when the computer program is executed by a processor, the steps in the above method embodiments are implemented.

[0141] In an exemplary embodiment, a computer program product is provided, including a computer program, and when the computer program is executed by a processor, the steps in the above method embodiments are implemented.

[0142] It should be noted that the user information (including but not limited to user device information, user personal information, etc.) and data (including but not limited to data used for analysis, stored data, displayed data, etc.) involved in this application are all information and data authorized by the user or fully authorized by all parties, and the collection, use and processing of relevant data must comply with relevant regulations.

[0143] Those of ordinary skill in the art can understand that all or part of the processes in the above-mentioned embodiment methods can be completed by instructing the relevant hardware through a computer program, and the computer program can be stored in a non-volatile computer-readable storage medium. When the computer program is executed, it can include the processes of the embodiments of the above-mentioned methods. Among them, any reference to the memory, database or other medium used in the embodiments provided in the present application can include at least one of non-volatile and volatile memory. Non-volatile memory can include read-only memory (ROM), magnetic tape, floppy disk, flash memory, optical memory, high-density embedded non-volatile memory, resistive random access memory (ReRAM), magnetic random access memory (MRAM), ferroelectric random access memory (FRAM), phase change memory (PCM), graphene memory, etc. Volatile memory can include random access memory (RAM) or external cache memory, etc. By way of illustration and not limitation, RAM may be in various forms, such as static random access memory (SRAM) or dynamic random access memory (DRAM).

[0144] The database involved in each embodiment provided in this application may include at least one of a relational database and a non-relational database. The non-relational database may include a distributed database based on blockchain, etc., but is not limited thereto. The processor involved in each embodiment provided in this application may be a general-purpose processor, a central processing unit, a graphics processor, a digital signal processor, a programmable logic device, a data processing logic device based on quantum computing, etc., but is not limited thereto.

[0145] The technical features of the above embodiments may be combined arbitrarily. To make the description concise, not all possible combinations of the technical features in the above embodiments are described. However, as long as there is no contradiction in the combination of these technical features, they should be considered to be within the scope of this specification.

[0146] This article uses specific examples to illustrate the principles and implementation methods of this application. The description of the above embodiments is only used to help understand the method and core ideas of this application. At the same time, for those skilled in the art, according to the ideas of this application, there will be changes in the specific implementation methods and application scope. In summary, the content of this specification should not be understood as limiting this application.

Claims

1. A guidance and control integrated design method under general field of view constraints, characterized in that: The guidance and control integrated design method comprises: Construct missile-target relative kinematic and dynamic equations; Based on the missile-target relative kinematics and dynamics equations, an integrated guidance and control model is constructed taking into account the attack angle and field of view constraints; Based on the guidance and control integrated model, a nominal control law is constructed through the state-dependent Riccati equation; determining a closed feedback control law based on the nominal control law; Constructing a control barrier function and determining a constraint set corresponding to the control barrier function; Determine whether to trigger the field of view constraint based on the control obstacle function, and obtain a determination result; When the judgment result is no, the closed feedback control law is used as the integrated guidance control law to complete the guidance control design; When the judgment result is yes, the integrated guidance control law is corrected based on the admissible control law and the closed feedback control law until the forward invariance condition of the constraint set is met, and the corrected integrated guidance control law is obtained to complete the guidance control design.

2. The guidance and control integrated design method under general field of view constraints according to claim 1 is characterized in that: The missile-target relative kinematics and dynamics equations constructed include: The missile-target relative kinematic equation is expressed as: The dynamic equation of the missile pitch channel is expressed as: Where R represents the relative distance between the missile and the target, λ represents the inertial line of sight angle, and γ M represents the heading angle of the missile, γ T Indicates the heading angle of the target, V M represents the speed of the missile, V T represents the speed of the target, a M is the missile's acceleration, a T represents the acceleration of the target, α represents the angle of attack, θ represents the pitch angle, L represents the aerodynamic lift, m represents the mass of the missile, ω z represents the pitch angle rotation rate, M represents the pitch rotation torque, J z represents the moment of inertia, Indicates the rate of change of *.

3. The guidance and control integrated design method under general field of view constraints according to claim 2 is characterized in that: The guidance and control integrated model is expressed as: In the formula, in the formula, e λ =λ-λ d represents the inertial line of sight angle tracking error, Q represents the dynamic pressure, S represents the reference area, l represents the reference length, δ z represents the tail rudder deflection angle, represents the aerodynamic lift derivative for the angle of attack α, represents the derivative of the pitch torque with respect to the angle of attack α, The pitch torque is expressed as the pitch angle rotation rate ω z The derivative of It represents the pitch torque to the tail rudder deflection angle δ z The derivative of .

4. The guidance and control integrated design method under general field of view constraints according to claim 3 is characterized in that: Based on the guidance and control integrated model, the nominal control law is constructed by the state-dependent Riccati equation, which specifically includes: According to the structural form of the guidance and control integrated model, the guidance and control integrated model is parameterized by using state-related factors to transform the guidance and control integrated model into a pseudo-linear control system; Design a formal quadratic performance index function; the formal quadratic performance index function is expressed as: Where Q(x) represents the weight matrix corresponding to the state, R(x) represents the weight matrix corresponding to the input, x represents the state in the guidance and control integrated model, J represents the quadratic performance index, u represents the admissible control law, and T represents the transpose; Based on the pseudo-linear control system and the formal quadratic performance index function, a nominal control law is constructed using the state-dependent Riccati equation technology.

5. The guidance and control integrated design method under general field of view constraints according to claim 3 is characterized in that: The control barrier function is expressed as: The constraint set corresponding to the control barrier function is expressed as: In the formula, h1 [1] (x) = e λ -γ M -α-η1 represents the first-order control obstacle function corresponding to constraint condition 1, η1 represents the difference between the minimum missile body sight angle and the terminal inertial sight angle representing the seeker field of view constraint interval, h1 [2] (x) represents the second-order control barrier function corresponding to constraint 1, Indicates h1 [1] The derivative of (x) with respect to time, α1(·) represents the expansion Class function, L f h1 [1] (x) indicates h1 [1] (x) Lie derivative along the vector field f, h2 [1] (x) = -e λ +γ M +α+η2 represents the first-order control obstacle function corresponding to constraint condition 2, η2 represents the difference between the maximum missile body sight angle and the terminal inertial sight angle in the seeker field of view constraint interval, and h2 [2] (x) represents the second-order control barrier function corresponding to constraint 2, Represents h2 [1] The derivative of (x) with respect to time, L f h2 [1] (x) represents h2 [1] (x) Lie derivative along the vector field f, represents the constraint set corresponding to constraint condition 1, represents the constraint set corresponding to constraint condition 2, Represents the constraint set corresponding to constraint condition 1 The constraint set corresponding to constraint 2 The intersection of .

6. The guidance and control integrated design method under general field of view constraints according to claim 5 is characterized in that: The minimum intervention framework of quadratic programming is adopted to correct the integrated guidance control law based on the admissible control law and the closed feedback control law; wherein the minimum intervention framework of quadratic programming is expressed as: Where u represents the admissible control law, represents the control admissible set, u ★ represents the modified integrated guidance control law, u ref Represents closed feedback control law, a1=L g L f h1 [1] (x) represents the Lie derivative of constraint 1 along the vector field f and the vector field g, represents the second-order Lie derivative of constraint 1 along the vector field f, represents the Lie derivative of constraint 2 along the vector field f and the vector field g, represents the second-order Lie derivative of constraint 2 along the vector field f.

7. A computer device comprising: A memory, a processor, and a computer program stored in the memory and executable on the processor, wherein the processor executes the computer program to implement the guidance and control integrated design method under general field of view constraints as described in any one of claims 1-6.

8. A computer-readable storage medium having a computer program stored thereon, characterized in that: When the computer program is executed by a processor, the guidance and control integrated design method under the general field of view constraint described in any one of claims 1 to 6 is implemented.

Citation Information

Cited By

  • Decision and guidance integrated design method and system based on Nash equilibrium search strategy

    CN119596706A

  • Decision guidance integrated design method and system based on nash equilibrium search strategy

    CN119596706B