Design method of three-dimensional sliding mode guidance law with time and angle constraints under uncontrollable speed
By designing the sliding mode surface in the pitch and yaw channels of the missile, using the sliding mode control theory and the superspiral sliding mode theory, time and angle constraints under uncontrollable speed are achieved, and the missile cannot control attacks during the final guidance stage is solved. The problem of time and angle achieves high-precision three-dimensional sliding molding guidance effect.
Patent Information
- Application Number
- CN202210600525.3
- Authority / Receiving Office
- CN · China
- Patent Type
- Patents(China)
- Current Assignee / Owner
- Filing Date
- 2022-05-30
- Publication Date
- 2024-11-05
- Estimated Expiration
- 2042-05-30
AI Technical Summary
The existing technology cannot achieve the time and angle constraints of missiles at the same time under uncontrolled speed, resulting in the inability of missiles to accurately control the attack time and angle during the final guidance stage.
A three-dimensional sliding mold guidance law for time and angle constraints under uncontrolled speed is designed. By designing rapidly converging non-singular sliding mold surfaces and superspiral sliding mold surfaces in the pitch channel and the yaw channel, the sliding mold control theory is used. and adaptive control methods, guide laws are derived to achieve the desired high and low angles of sight and azimuth angles of sight, and through the super-spiral sliding mode theory, the missile can reach the sliding mode surface, thereby achieving the desired attack time.
It is realized that the missile strikes the target at the desired time and angle in three-dimensional space. The guidance law has high accuracy and wide application range, and can accurately achieve the expected attack time and angle. The guidance law is perpendicular to the velocity direction, reducing the velocity changes of the missile.
Smart Images

Figure CN114995495B_ABST
Abstract
Description
Technical Field
[0001] The invention relates to the field of missile guidance technology, and in particular to the design of a guidance law for controlling the attack time and angle of a missile under the condition that the speed is uncontrollable. Background Art
[0002] For the existing three-dimensional guidance law, there are mainly two guidance models. The first one is based on the line-of-sight coordinate system. After the guidance instructions obtained in this model are converted to the ballistic coordinate system, there is a component in the velocity direction, which requires the aircraft to be able to control the missile speed. However, in the terminal guidance stage of the missile, the missile usually has no thrust and cannot control the missile speed. To address this problem, the second model is based on the missile lead angle coordinate system. The guidance instructions are perpendicular to the missile velocity direction, so the speed is not controlled.
[0003] Under the condition of uncontrollable speed, the three-dimensional guidance law of the missile can be divided into time constraint and angle constraint. The time constraint guidance law is based on the estimated expression of the remaining time of the missile, or based on the consistency theory, and the coordinated variables are designed for derivation. The angle constraint guidance law is derived by the relationship between the line of sight angular acceleration and the overload in the model through the sliding mode control theory, optimal control theory, adaptive control theory and other methods to derive the expression of the overload instruction. However, at present, under the condition of uncontrollable speed, there is no guidance law that can realize both time constraint and angle constraint at the same time.
[0004] Among the three-dimensional guidance laws that can currently achieve both time constraints and angle constraints, all are based on speed-controlled three-dimensional models. In the terminal guidance stage of a missile, the missile usually has no thrust and only controls the missile's attitude through aerodynamic forces. Under the condition that the speed cannot be controlled, the current guidance law can only achieve a single time constraint or an angle constraint.
[0005] In summary, the existing methods cannot simultaneously constrain time and angle under the condition of uncontrollable speed. In order to meet the guidance requirements, a three-dimensional sliding mode guidance law design method with time and angle constraints under the condition of uncontrollable speed is urgently needed. Summary of the invention
[0006] Technical issues to be solved
[0007] Aiming at the problem that the existing three-dimensional guidance law cannot simultaneously constrain the attack time and attack angle under the condition of uncontrollable speed, the present invention proposes a design method of a three-dimensional sliding mode guidance law with time and angle constraints under the condition of uncontrollable speed.
[0008] Technical Solution
[0009] The present invention designs the guidance laws for the missile pitch and yaw channels respectively:
[0010] In the pitch channel, a fast-converging non-singular sliding surface and a reaching law that varies with the missile distance are designed. The derived guidance law can achieve the desired line-of-sight elevation angle.
[0011] In the yaw channel, a special sliding surface is designed by analyzing the missile guidance conditions, and the super-helical sliding mode theory is used to ensure that the missile can reach the sliding surface, thereby achieving the desired line of sight azimuth and the desired attack time.
[0012] A method for designing a three-dimensional sliding mode guidance law with time and angle constraints under uncontrollable speed conditions, characterized in that after analyzing the missile guidance conditions, a sliding mode control method is used to design a my Used to control the missile to achieve the desired line of sight angle, a mz Used to control the missile to achieve the desired line of sight deviation angle and desired attack time;
[0013] The missile guidance model can be expressed as:
[0014]
[0015]
[0016]
[0017]
[0018]
[0019]
[0020] Among them, R is the relative distance between the projectile and the target, θ is the trajectory inclination angle, is the ballistic deflection angle, θ L The height angle of sight. is the sight azimuth, σ m represents the lead angle, θ m and is m The decomposition of the pitch and yaw channels in the line of sight coordinate system represents the lead tilt angle and lead deflection angle, γ m Represents the front roll angle, V m Indicates missile speed;
[0021] Further differentiation of the sight height angle and azimuth angle yields
[0022]
[0023]
[0024] The guidance law design method is as follows:
[0025] (1) Guidance law design for the elevation and low angles of sight
[0026] First, to achieve the desired sight line height angle, a fast-converging non-singular sliding surface is designed:
[0027]
[0028] Where x1 = θ L -θ Ld , λ, β are both constants greater than 0, α∈[-1,1]; design an adaptive reaching law as the missile distance changes:
[0029]
[0030] Among them, k1 and k2 are constants greater than 0, and k1 and k2 satisfy:
[0031]
[0032] Finally, the line of sight elevation angle guidance law can be obtained as follows:
[0033]
[0034] (2) Guidance law design in the line of sight azimuth direction
[0035] Let ξ=R / V m , e1=θ L -θ Ld , φ=t d -t-ξ, and make the following assumptions:
[0036] Assumption 1: When taking the derivative of e2, cosθ L This term varies less, so it is considered a constant;
[0037] Assumption 2: During the guidance process, the time error term φ ≥ 0 always holds true;
[0038] Design the following sliding surface:
[0039]
[0040] Take the derivative of both ends of the sliding surface s2 and substitute the formula into the equation to get:
[0041]
[0042] Design of reaching law based on super helical sliding mode control method:
[0043]
[0044]
[0045] Among them, l1 and l2 are constants greater than 0, w is an adaptive parameter of the super sliding mode to prevent the sliding surface from chattering; Substituting the above formula into the sliding surface s2, the control amount a can be obtained. mz for:
[0046]
[0047]
[0048] A computer system, characterized in that it comprises: one or more processors, and a computer-readable storage medium for storing one or more programs, wherein when the one or more programs are executed by the one or more processors, the one or more processors implement the above-mentioned method.
[0049] A computer-readable storage medium, characterized in that it stores computer-executable instructions, which are used to implement the above method when executed.
[0050] A computer program, characterized by comprising computer executable instructions, which are used to implement the above method when executed.
[0051] Beneficial Effects
[0052] The guidance law designed by the present invention is perpendicular to the speed direction, and the desired attack time and attack angle are achieved only by changing the speed direction of the missile. In the pitch channel, a fast-converging non-singular sliding mode surface and a sliding mode approaching law that changes with the missile distance are proposed to achieve the desired sight elevation angle; in the yaw channel, a special sliding mode surface is designed by analyzing its guidance conditions, and the super-helical sliding mode theory is used to ensure that the missile can reach the sliding mode surface, thereby achieving the desired sight azimuth angle and the desired attack time.
[0053] The present invention realizes that the missile strikes the target at the expected attack time and attack angle in three-dimensional space under the condition that the missile speed is uncontrollable. The guidance law has a small miss amount and can accurately achieve the expected attack time and the expected line of sight elevation angle, and there is only a small error in the line of sight azimuth.
[0054] The innovative features of the present invention are as follows:
[0055] (1) Through the sliding mode control theory, under the condition of uncontrollable speed, the sliding mode surface is designed according to the guidance conditions, and the guidance law that can hit the target at the desired time and angle at the same time is derived, which is not achieved by other methods.
[0056] (2) The present invention makes a reasonable division of labor for the three-dimensional guidance law of the missile, where a myEnsure that the missile's sight angle reaches the expected value, a mz Ensure that the missile's line of sight azimuth and attack time reach the expected values.
[0057] (3) All the results of the present invention are derived based on a three-dimensional nonlinear coupled dynamics model, without considering small angle assumptions and linearization. The guidance law has high accuracy and a wide range of applications, and can achieve all-round attacks. BRIEF DESCRIPTION OF THE DRAWINGS
[0058] The drawings are only for the purpose of illustrating particular embodiments and are not to be considered limiting of the present invention. Like reference symbols denote like components throughout the drawings.
[0059] Figure 1 : Schematic diagram of the three-dimensional guidance model;
[0060] Figure 2 : Missile three-dimensional trajectory diagram;
[0061] Figure 3 : Missile estimated remaining time curve;
[0062] Figure 4 : Lead angle variation curve;
[0063] Figure 5 : Relative speed change curve;
[0064] Figure 6 : Missile sight elevation angle change curve;
[0065] Figure 7 : Missile sight azimuth change curve;
[0066] Figure 8 : Overload variation curve of sight height angle direction;
[0067] Fig. 9 : Overload change curve of line of sight azimuth direction. DETAILED DESCRIPTION
[0068] In order to make the purpose, technical solutions and advantages of the present invention more clearly understood, the present invention is further described in detail below in conjunction with the accompanying drawings and embodiments. It should be understood that the specific embodiments described herein are only used to explain the present invention and are not intended to limit the present invention. In addition, the technical features involved in the various embodiments of the present invention described below can be combined with each other as long as they do not conflict with each other.
[0069] according to Figure 1 , M, T represent the positions of the missile and the target respectively. In the coordinate system with the Y axis pointing upward, the three-dimensional coupled guidance model of the missile can be described as:
[0070]
[0071]
[0072]
[0073]
[0074]
[0075]
[0076] Among them, R is the relative distance between the projectile and the target, θ is the trajectory inclination angle, is the ballistic deflection angle, θ L The height angle of sight. is the sight azimuth, σ m represents the lead angle, θ m and is m The decomposition of the pitch and yaw channels in the line of sight coordinate system represents the lead tilt angle and lead deflection angle, γ m Represents the front roll angle, V m Indicates the missile speed.
[0077] (1) Guidance law design for the elevation and low angles of sight
[0078] First, take the derivative of (5) and substitute (2) into it to obtain
[0079]
[0080] In order to achieve the desired sight height angle, a fast-converging non-singular sliding surface is designed:
[0081] s1=x2+λx1+βsig α (x1) (8)
[0082] Where x1 = θ L -θ Ld , θ Ld is the expected sight elevation angle, λ, β are both constants greater than 0, and α∈[-1,1]. In order to make the sight elevation angle converge quickly to the expected value and remain stable, the present invention proposes a convergence law that changes with the missile distance:
[0083]
[0084] Among them, k1 and k2 are constants greater than 0, and k1 and k2 satisfy:
[0085]
[0086] Taking the derivative of equation (8) and combining equation (7) and equation (9), we can get the guidance law of the pitch channel:
[0087]
[0088] To prove that the missile can achieve the desired sight elevation angle under this guidance law, assume the following Lyapunov function:
[0089]
[0090] Taking the derivative of the Lyapunov function, we can get:
[0091]
[0092] Simplifying the above formula, we can get:
[0093]
[0094] Integrating the above formula gives:
[0095]
[0096] Among them, s1(0) and R(0) are the sliding surface at the start time and the relative distance between the missile and the target. According to (15), there is a finite time t * Make the sliding surface s1=0.
[0097] After reaching the sliding surface, according to formula (8), the following relationship can be obtained:
[0098] x2=-λx1-βsig α (x1) (16)
[0099] In order to prove that the missile's sight elevation angle can reach the expected value, the Lyapunov function is designed as follows:
[0100]
[0101] Deriving equation (17) and substituting equation (16) into it, we can obtain:
[0102]
[0103] According to formula (18), x1 can converge to 0 in a finite time, and the convergence time T1 satisfies
[0104]
[0105] In summary, the total time for the sight line height angle to reach the expected value is the time to reach the sliding surface t * The sum of the convergence time T1 of x1 after reaching the sliding surface, Tθ = t * +T1.
[0106] (2) Guidance law design in the line of sight azimuth direction
[0107] Let ξ=R / V m , represents the estimated remaining flight time, e1=θ L -θ Ld , represents the line of sight height angle error, represents the line of sight azimuth error, where is the desired sight angle, φ=t d -t-ξ. It represents the expected attack time error. The following assumptions are made:
[0108] Assumption 1: When taking the derivative of e2, cosθ L This term varies little and is considered a constant.
[0109] Assumption 2: During the guidance process, the time error term φ ≥ 0 always holds true.
[0110] Taking the derivative of ξ, e1, e2, φ in the above formula and substituting equations (1)-(6) into them, we can obtain:
[0111]
[0112]
[0113]
[0114]
[0115] Design an auxiliary variable Ω, whose expression is:
[0116]
[0117] Taking the derivative of both ends of Ω and substituting equations (20)-(23) into them, we can get:
[0118]
[0119] when a my After the missile's sight elevation angle is controlled to reach the desired value, according to formula (5), the following conditions will be met:
[0120]
[0121] At this time, formula (25) can be rewritten as
[0122]
[0123] According to (27), the following sliding die surface is designed:
[0124]
[0125] Taking the derivative of both ends of the sliding surface s2 and substituting equation (3) into it, we can obtain:
[0126]
[0127] In order to weaken the chattering phenomenon of the sliding surface and ensure that the sliding surface can converge quickly, the present invention designs a reaching law based on the super-helical sliding mode control method. First, formula (29) is written as:
[0128]
[0129] in,
[0130]
[0131]
[0132] According to the superhelical sliding mode theory, the reaching law can be expressed as:
[0133]
[0134] Where l1 and l2 are both constants greater than 0. Substituting equation (33) into equation (30), we can get the control quantity a mz for:
[0135]
[0136] First, according to the superhelical sliding mode theory, the sliding mode surface can reach s2 = 0 in a finite time. After reaching s2 = 0, assuming that a my The missile is also controlled to reach the desired sight angle. According to equations (24) and (25), we have:
[0137]
[0138] Since cosθ m =1, according to the trigonometric formula, equation (20) and equation (23) can be expressed as:
[0139]
[0140]
[0141] First, design the following Lyapunov function:
[0142] V3=0.5φ 2 (38)
[0143] Taking the derivative of both ends, we have
[0144]
[0145] Since φ≥0, If and only if φ=0, Therefore, φ can converge to 0 asymptotically. According to Assumption 2, φ≥0 always holds true before the expected time is reached. Assuming φ=0, we can get:
[0146]
[0147] t+ξ=t d (41)
[0148] If the missile can hit the target, then when it hits the target, according to the definition, +ξ=R / V m = 0, according to formula (41), at this time, t=t d In summary, as long as the missile can hit the target, the missile hits the target at the expected time and can achieve the expected line of sight azimuth.
[0149] Combined with a my and a mz It can be seen that the missile can achieve the following guidance objectives:
[0150]
[0151] That is, the missile can hit the target at the expected time and achieve the expected line of sight inclination and line of sight deviation.
[0152] In order to demonstrate the feasibility and effectiveness of the design method of the three-dimensional sliding mode guidance law with time and angle constraints under the condition of uncontrollable speed, the present invention designs a simulation verification test. The initial conditions of the missiles are shown in Table 1. The elevation angle constraints of the four missiles are θ Ld =[-35° -10° -15° -20°], the sight angle constraint is Expected attack time of missile T d The simulation time is 60s, the simulation termination condition is set to r<0.5m, the maximum overload of the missile is 30g, and the simulation step is 0.001s. The simulation results are shown in Table 2 and Figure 2-Figure 9 Shown
[0153] Table 1 Initial conditions of missile
[0154]
[0155] Table 2 Simulation results
[0156]
[0157] The above description is only a specific implementation mode of the present invention, but the protection scope of the present invention is not limited thereto. Any technician familiar with the technical field can easily think of various equivalent modifications or substitutions within the technical scope disclosed in the present invention, and these modifications or substitutions should be included in the protection scope of the present invention.
Claims
1. A method for designing a three-dimensional sliding mode guidance law with time and angle constraints under uncontrollable speed conditions, characterized by: After analyzing the missile guidance conditions, based on the sliding mode control method, a my Used to control the missile to achieve the desired line of sight angle, a mz Used to control the missile to achieve the desired sight angle and desired attack time; The missile guidance model can be expressed as: Among them, R is the relative distance between the projectile and the target, θ is the trajectory inclination angle, is the ballistic deflection angle, θ L The height angle of sight. is the sight azimuth, σ m represents the lead angle, θ m and is m The decomposition of the pitch and yaw channels in the line of sight coordinate system represents the lead tilt angle and lead deflection angle, γ m Represents the front roll angle, V m Indicates missile speed; Further differentiation of the sight height angle and azimuth angle yields The guidance law design method is as follows: (1) Guidance law design for the elevation and low angles of sight First, to achieve the desired sight line height angle, a fast-converging non-singular sliding surface is designed: Where x1 = θ L -θ Ld , λ, β are both constants greater than 0, α∈[-1,1]; design an adaptive reaching law as the missile distance changes: Among them, k1 and k2 are constants greater than 0, and k1 and k2 satisfy: Finally, the line of sight elevation angle guidance law can be obtained as follows: (2) Guidance law design in the line of sight azimuth direction Let ξ=R / V m , e1=θ L -θ Ld , φ=t d -t-ξ, and make the following assumptions: Assumption 1: When taking the derivative of e2, cosθ L This term varies less, so it is considered a constant; Assumption 2: During the guidance process, the time error term φ ≥ 0 always holds true; Design the following sliding surface: Take the derivative of both ends of the sliding surface s2 and substitute the formula into the equation to get: Design of reaching law based on super helical sliding mode control method: Among them, l1 and l2 are constants greater than 0, w is an adaptive parameter of the super sliding mode to prevent the sliding surface from chattering; Substituting the above formula into the sliding surface s2, the control amount a can be obtained. mz for:
2. A computer system, characterized in that include: One or more processors, and a computer-readable storage medium for storing one or more programs, wherein when the one or more programs are executed by the one or more processors, the one or more processors are enabled to implement the method of claim 1.
3. A computer-readable storage medium, characterized in that Computer executable instructions are stored, and when the instructions are executed, they are used to implement the method of claim 1.
4. A computer program product, characterized in that The invention comprises computer executable instructions, which are used to implement the method of claim 1 when being executed.
