Three-dimensional vector collaborative guidance law design method with flight time and terminal angle constraints

By designing the three-dimensional vector collaborative guidance law of effective pure proportion guidance and time constraint terms based on the optimal error dynamics theory in three-dimensional flight scenarios, the problem that time and angle constraints are difficult to satisfy simultaneously in three-dimensional flight scenarios in the prior art is solved. Achieve high-precision aircraft collaborative flight.

CN118938668APending Publication Date: 2024-11-12NORTHWESTERN POLYTECHNICAL UNIV
View PDF 0 Cites 2 Cited by

Patent Information

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

AI Technical Summary

Technical Problem

When the prior art designs the guidance law of time and angle constraints in three-dimensional flight scenarios, it is difficult to meet the flight time and terminal angle constraints at the same time, and the solution is complex, especially in the unpowered stage of the aircraft, and the application is limited.

Method used

Based on the optimal error dynamics theory, the two-dimensional terminal angle control guidance law is designed under effective pure proportion guidance, and it is expanded to three-dimensional, and time constraint terms are introduced to form a three-dimensional vector collaborative guidance law with flight time and terminal angle. , realizes coordinated flight of aircraft without plane decoupling.

Benefits of technology

It realizes high-precision control of the aircraft in the unpowered stage, has a wide range of application, high control accuracy, strong real-time performance, and is not affected by communication interference. It is suitable for the coordinated flight of multiple aircraft to large targets.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN118938668A_ABST
    Figure CN118938668A_ABST
Patent Text Reader

Abstract

The invention relates to the technical field of three-dimensional cooperative guidance laws, in particular to a three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints. The method comprises the steps of establishing kinematics and dynamics equations of an aircraft in a three-dimensional scene to obtain a guidance model, designing a two-dimensional angle control guidance law under effective pure proportion guidance, expanding the two-dimensional angle control guidance law into a three-dimensional angle control guidance law, introducing a time constraint term into the three-dimensional angle control guidance law, and obtaining a guidance model. Obtaining a three-dimensional vector collaborative guidance law with flight time and a terminal angle; according to the method, the problem that most three-dimensional time angle control guidance law designs need plane decoupling, inter-missile communication, acceleration along the tangential direction of the speed or application limitation caused by numerical calculation is solved, the aircraft can meet flight time constraint and two-terminal angle constraint at the same time under the condition that plane decoupling is not needed, and the design efficiency is improved. The method has high control precision and can be applied to cooperative flight of multiple aircrafts for large targets.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to the technical field of three-dimensional cooperative guidance law, and in particular to a design method of a three-dimensional vector cooperative guidance law with flight time and terminal angle constraints. Background Art

[0002] The collaborative guidance method can be divided into two categories: dynamic collaboration and static collaboration, depending on whether communication between aircraft is required. Dynamic collaboration relies on communication interaction between aircraft, and adjusts their respective flight times according to a certain strategy to ultimately reach a consistent flight time. Static collaboration is essentially an open-loop collaboration, where there is no information transmission between aircraft, and each aircraft independently completes the flight mission according to its own preset expected flight time, achieving the effect of reaching the target point at the same time as a whole. Static collaboration does not rely on online data links, has higher reliability, a wider range of applications, and can preset flight times.

[0003] A large number of studies on static cooperative guidance have been carried out under the framework of proportional guidance. At present, the flight time control guidance law based on proportional guidance is mostly implemented by three methods: sliding mode control, time-varying proportional coefficient or bias proportional guidance. The sliding mode control method divides the guidance instruction into two parts: equivalent control and switching control. The resulting guidance law is essentially a time-varying proportional guidance or bias proportional guidance. The premise of the time-varying proportional coefficient method is to obtain the estimated expression of the remaining flight time of the aircraft under proportional guidance, and then, based on the relationship between the flight time and the proportional coefficient, the proportional coefficient is inversely solved according to the real-time expected flight time. The main design idea of ​​the bias proportional guidance method is to divide the guidance instruction into two parts: proportional guidance term and time bias term. On the basis of estimating the remaining flight time, the time error is eliminated through theories such as error dynamics, and the time bias term is derived.

[0004] For the time control guidance law that further considers the angle constraint, most of the existing technologies use the "two-step method" and "integrated method" for design. The "two-step method" is to first design a guidance law with a flight angle constraint, then derive and estimate its remaining time flight time, and then design a compensation term to compensate for the flight time error. The "integrated method" is to summarize the flight time control guidance problem with flight angle constraints into a two-point boundary value problem, and obtain the required guidance law by solving the two-point boundary value problem. However, the two-point boundary value problem is usually not easy to solve. For three-dimensional flight scenarios, the guidance model is more complicated, and plane coupling needs to be considered. Especially in the unpowered stage of the aircraft, the problem is difficult to solve. Most three-dimensional time angle control guidance law designs require plane decoupling, inter-missile communication, acceleration or numerical calculation along the velocity tangent, which to a certain extent limits its application. Summary of the invention

[0005] In order to overcome the shortcomings of the above-mentioned prior art, the purpose of the present invention is to propose a three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints. Based on the optimal error dynamics theory, a two-dimensional terminal angle control guidance law under effective pure proportional guidance is designed, and then based on the vector guidance method, the two-dimensional terminal angle control guidance law is extended to three dimensions, and a time constraint bias term is introduced. Finally, based on the fixed time convergence theory, a three-dimensional vector guidance law with flight time and terminal angle constraints is designed. The present invention can enable the aircraft to simultaneously meet the flight time constraint and the two terminal angle constraints without the need for planar decoupling, and has high control accuracy, and can be applied to the cooperative flight of multiple aircraft over large targets.

[0006] To achieve the above purpose, the technical solution adopted by the present invention is as follows:

[0007] A three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints, comprising:

[0008] Establish the kinematic and dynamic equations of the aircraft in a three-dimensional scene and obtain the guidance model;

[0009] Based on the guidance model, design a two-dimensional angle control guidance law under effective pure proportional guidance;

[0010] Expand the two-dimensional angle control guidance law under effective pure proportional guidance into a three-dimensional angle control guidance law;

[0011] By introducing the time constraint term into the three-dimensional angle control guidance law, a three-dimensional vector cooperative guidance law with flight time and terminal angle is obtained.

[0012] The guidance model is expressed as:

[0013]

[0014] Where M is the center of mass of the aircraft, v M is the aircraft speed, θ M is the velocity inclination angle, is the velocity deflection angle, a y and a z is the normal acceleration component of the aircraft;

[0015] The aircraft velocity vector is expressed as:

[0016]

[0017] The unit vector representation of the aircraft velocity vector is:

[0018]

[0019] The relative position vector between the aircraft and the target is expressed as:

[0020]

[0021] Among them, q ε is the sight height angle, q β is the sight azimuth, r is the relative distance;

[0022] The unit vector representation of the relative position vector is:

[0023]

[0024] The expected attack unit vector is expressed as:

[0025]

[0026] Among them, q εd is the desired sight line height angle, q βd is the expected sight line azimuth.

[0027] The two-dimensional angle control guidance law under the effective pure proportional guidance is expressed as:

[0028]

[0029] Among them, a M is the normal acceleration, is the line of sight angular rate, η is the lead angle, N is the proportional coefficient, K is the control gain, and K>0, t go is the remaining flight time, q f is the terminal sight angle of the aircraft, ε qf is the angle error;

[0030] The remaining flight time is expressed as:

[0031]

[0032] The terminal sight angle of the aircraft is expressed as:

[0033]

[0034] Among them, q is the current sight angle;

[0035] The angular error is expressed as:

[0036] ε qf =q d -q f ,

[0037] Among them, q d is the expected terminal sight angle.

[0038] The three-dimensional angle control guidance law is expressed as:

[0039]

[0040] Among them, a M is the normal acceleration, ω r is the angular velocity of line of sight, u b Determines the direction of the angle offset term,

[0041]

[0042] δ qf =arccos(u d ·u r ),

[0043] Among them, δ qf is the three-dimensional angle error, that is, vector u d and u r The angle between.

[0044] The three-dimensional vector cooperative guidance law with flight time and terminal angle is expressed as:

[0045]

[0046] ξ=tan 2 η(Ncosη-1)-K(Ncosη-1)tanηcosεδ qf ,

[0047] Among them, a t is the time constraint term, δ t is the time error, δ t =t d -tt go , t d is the expected attack time, t is the current time, ε is the vector u ω and u b The angle between them, ε = arccos(u ω ·u b ),u ω =ω r / ω r ,u ω ω r The unit vector, ω r ω r The Euclidean norm of 2 η, function sag p (x)=|x p sat(x), Ψ(x) and sat(x) are auxiliary functions, defined as follows:

[0048]

[0049] σ>0, μ>0 are constants, l1, l2, κ1, κ2 are adjustable parameters, satisfying:

[0050]

[0051] l1>0,l2>0,m1>1,0 <m2<1。

[0052] A computer system 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 method.

[0053] A computer-readable storage medium stores computer-executable instructions, which are used to implement the above method when executed.

[0054] A computer program includes computer executable instructions, which are used to implement the above method when executed.

[0055] Compared with the prior art, the beneficial effects of the present invention are:

[0056] 1. The acceleration direction required by the guidance law of the present invention is along the velocity normal direction, which is applicable to the unpowered flight stage of the aircraft. Compared with the prior art, the present invention has the advantages of wide application range and high control accuracy.

[0057] 2. The guidance law of the present invention has an analytical expression. Compared with the prior art, it does not require numerical algorithms or switching logic, has strong real-time performance and smooth instructions.

[0058] 3. The guidance law of the present invention is a static cooperative guidance law, which is not affected by communication interference. When applied to fixed or slow large targets, its advantages are more obvious.

[0059] 4. The guidance law of the present invention is applicable to three-dimensional scenes, and the derivation of the guidance law does not require plane decoupling, which is closer to the real scene.

[0060] In summary, the present invention designs a three-dimensional vector cooperative guidance law with flight time and terminal angle constraints without the need for planar decoupling, which can enable the aircraft to reach the target point with the expected flight time and terminal angle, and has a very high guidance accuracy and cooperative accuracy. BRIEF DESCRIPTION OF THE DRAWINGS

[0061] Figure 1 The figure is a flow chart of the method of the present invention.

[0062] Figure 2 It is a three-dimensional guidance model.

[0063] Figure 3 It is the three-dimensional motion trajectory of flying to a stationary target.

[0064] Figure 4 It is the motion trajectory of flying to the stationary target in the XZ plane.

[0065] Figure 5 It is the motion trajectory of flying to the stationary target in the XY plane.

[0066] Figure 6 This is the acceleration curve when flying to a stationary target.

[0067] Figure 7 This is the line of sight angle change curve when flying to a stationary target.

[0068] Figure 8 It is the three-dimensional motion trajectory of flying to the slow target.

[0069] Fig. 9 It is the motion trajectory of flying to the slow target in the XZ plane.

[0070] Fig.10 It is the motion trajectory of flying to the slow target in the XY plane.

[0071] Fig.11 This is the acceleration curve when flying to a slow target.

[0072] Fig.12 This is the line of sight angle change curve when flying to a slow target. DETAILED DESCRIPTION

[0073] The technical solution of the present invention is described in detail below with reference to the accompanying drawings and embodiments.

[0074] A three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints, such as Figure 1 As shown, including:

[0075] S1, establish the kinematic and dynamic equations of the aircraft in a three-dimensional scene and obtain the guidance model.

[0076] The three-dimensional guidance model of the aircraft is as follows Figure 2 As shown in the figure, O-XYZ is the inertial system, M is the center of mass of the aircraft, T is the center of mass of the target point, r is the relative position vector (missile-target line of sight vector), from the aircraft to the target, v M represents the aircraft velocity vector, q ε ,q β are the sight altitude angle and sight azimuth angle, θ M , are velocity inclination and velocity deviation, respectively. The direction shown in the figure is positive. M is the normal acceleration of the aircraft, a y 、a z is the acceleration component, a yIn the longitudinal plane with v M vertical, a z In the lateral plane with v M vertical.

[0077] The guidance model is expressed as:

[0078]

[0079] Where M is the center of mass of the aircraft, v M is the aircraft speed, θ M is the velocity inclination angle, is the velocity deflection angle, a y and a z is the normal acceleration component of the aircraft, and the above formula is the kinematic and dynamic equation of the aircraft;

[0080] All variables in the formula are scalars, and the leading azimuth angle η is defined as β =ψ m -q β , front elevation angle η ε =θ m -q ε , the total lead angle η satisfies cosη=cosη β cosη ε ;

[0081] In the inertial coordinate system O-XYZ, the vehicle velocity vector v M It is expressed as:

[0082]

[0083] Aircraft velocity vector v M The unit vector u v It is expressed as:

[0084]

[0085] The relative position vector r between the aircraft and the target is expressed as:

[0086]

[0087] Among them, q ε is the sight height angle, q β is the sight azimuth, r is the relative distance;

[0088] Unit vector u relative to position vector r r It is expressed as:

[0089]

[0090] Expected attack unit vector u d It is expressed as:

[0091]

[0092] Among them, q εd is the desired sight line height angle, q βd is the expected sight line azimuth.

[0093] S2, based on the guidance model, designs a two-dimensional angle control guidance law under effective pure proportional guidance.

[0094] Combining pure proportional guidance and true proportional guidance, the effective pure proportional guidance law when the target is stationary is obtained:

[0095]

[0096] In the formula, is the line of sight angular velocity, η is the lead angle, and N is the proportional coefficient, which is generally a constant of 3 to 5. In order to reduce the lead angle, Ncosη0>1 must be satisfied. EPPN It is the normal acceleration command under the effective pure proportional guidance law, and its direction is perpendicular to the vehicle velocity vector.

[0097] From the lead angle η = θ M -q, q is the sight angle, we can know:

[0098]

[0099] By shifting the terms in the above equation and combining the aircraft dynamics equation with the effective pure proportional guidance, we can obtain:

[0100]

[0101] Integrate the above formula from the initial time to the terminal time:

[0102]

[0103] The subscript "0" indicates the initial value, and the subscript "f" indicates the terminal value. The solution is:

[0104]

[0105] Without loss of generality, replacing the initial value with the value at any time during the flight, the expression of the terminal sight angle of the aircraft under the effective pure proportional guidance law can be obtained:

[0106]

[0107] In order to realize the terminal angle constraint of the missile, a bias term that can make the terminal angle error converge to 0 is added on the basis of the effective pure proportional guidance law, that is:

[0108] a M=a EPPN +a IA ,

[0109] Among them, a M is the normal acceleration of the aircraft, a EPPN is the effective pure proportional guidance term, a IA is the bias term to eliminate the angle error.

[0110] To derive a IA The specific form of , defines the angle error:

[0111] ε qf =q d -q f ,

[0112] In the formula, q d is the expected terminal sight angle.

[0113] By taking the derivative of the angle error and combining it with the aircraft dynamics equation and using the small angle assumption, we can get:

[0114]

[0115] According to the optimal error dynamics theory, the error dynamics equation is selected:

[0116]

[0117] The bias term is obtained as:

[0118]

[0119] Among them, K is the control gain, which must satisfy K>0. At this time, the performance index J reaches the optimal value.

[0120]

[0121] Therefore, the two-dimensional angle control guidance law under the effective pure proportional guidance is expressed as:

[0122]

[0123] Among them, t go The remaining flight time can be estimated using the following formula:

[0124]

[0125] S3, expands the two-dimensional angle control guidance law under effective pure proportional guidance into a three-dimensional angle control guidance law.

[0126] u v 、u r and u d are all unit vectors. When the relative position unit vector ur and the expected attack vector u d When parallel, the aircraft's sight angle meets the constraint. Therefore, the three-dimensional angle control guidance law is designed as follows:

[0127] a M =a PNG u ω ×u v +a IACG u b ×u v ,

[0128] In the formula, a M is the normal acceleration vector. The first item on the right is the proportional guidance item, which controls the aircraft's lead angle to converge to 0 to ensure that the aircraft reaches the target. The second item is the angle offset item, which controls the aircraft's line of sight u r Rotate to u d Parallel, realize three-dimensional terminal angle constraint.

[0129] The angular velocity of line of sight rotation is:

[0130]

[0131] Then its unit vector is:

[0132]

[0133] Vector b The calculation method is as follows:

[0134]

[0135] Here, ||g|| represents the Euclidean norm of the vector.

[0136] Define the 3D angular error:

[0137] δ qf =arccos(u d ·u r ),

[0138] The three-dimensional angle control guidance law is expressed as:

[0139]

[0140] when||u d ×u||=0, a strange phenomenon will occur. This is because when u r with u d When parallel, the direction of the bias term cannot be determined. In this case, u b Just set it to 0.

[0141] S4, a time constraint term is introduced into the three-dimensional angle control guidance law to obtain a three-dimensional vector cooperative guidance law with flight time and terminal angle.

[0142] The three-dimensional angle control guidance law shown in S3 consists of a proportional guidance term for controlling the missile's miss distance and an angle offset term for controlling the terminal angle. To meet the time constraint, a time constraint term a is introduced into the proportional guidance term. t ,Right now

[0143]

[0144] In a three-dimensional scene, the total lead angle η is defined as:

[0145] η=arccos(u v ·u r ),

[0146] Taking the derivative of the above formula, we can get:

[0147]

[0148] Where ε = arccos(u ω ·u b ).

[0149] The remaining flight time is estimated using the expression:

[0150]

[0151] Then we have:

[0152]

[0153] in, therefore:

[0154]

[0155] Define the time error:

[0156] δ t =t d -tt go ,

[0157] Among them, t d is the expected attack time, and t is the current time.

[0158] Derivative of the above formula:

[0159]

[0160] Where ξ=tan 2 η(Ncosη-1)-K(Ncosη-1)tanηcosεδ qf .

[0161] According to the fixed time convergence theory, select:

[0162]

[0163] Among them, l1, l2, κ1, κ2 are adjustable parameters, satisfying:

[0164]

[0165] l1>0,l2>0,m1>1,0 <m2<1,

[0166] The time error dynamics equation will converge within a fixed time, and the error convergence time satisfies:

[0167]

[0168] When η→0, a singular phenomenon will occur, causing the acceleration command to vibrate at the maximum amplitude. The auxiliary function Ψ(x) can be introduced to avoid this problem:

[0169]

[0170] Among them, σ>0 is a constant.

[0171] In addition, sig p (x)=|x p sgn(x), which contains the sign function sgn(·), may cause chattering and can be replaced by the saturation function sat(x):

[0172]

[0173] Where μ>0.

[0174] Therefore, the three-dimensional vector cooperative guidance law with flight time and terminal angle is expressed as:

[0175]

[0176]

[0177] ξ=tan 2 η(Ncosη-1)-K(Ncosη-1)tanηcosεδ qf ,

[0178] Where f = tan 2 η, function sag p (x)=|x| p sat(x).

[0179] The above three-dimensional vector cooperative guidance law with flight time and terminal angle has many parameters. For the convenience of application, the reference range of parameter selection is summarized as follows:

[0180] 1) The proportional coefficient N is usually 3 to 6 and satisfies N>1 / |cosη0|, where η0 is the initial lead angle.

[0181] 2) In the angle offset term, the control gain K must satisfy K>0 and is usually 1 to 5.

[0182] 3) In the time constraint term, the parameters l1, l2, m1 and m2 affect the convergence time. Usually, 1 <m1<1.5,0.5<m2<1;l1> 0,l2>0.

[0183] 4) If the parameter σ in the auxiliary function Ψ(x) and the parameter μ in the saturation function sat(x) are too large, the convergence speed will be reduced; if they are too small, the guidance command may be too large. According to simulation experience, σ and μ are usually taken as 10 -3 ~10 -1 .

[0184] 5) The parameter n in the auxiliary function Ψ(x) is used to ensure the high-order infinitesimal characteristics of Ψ(x), so it should satisfy n≥1 and is usually an integer from 1 to 3.

[0185] When implementing the above algorithm, the vector acceleration instruction a M Decompose in the coordinate system, and then use the guidance model established in S1 to update the state. The normal acceleration component a of the aircraft y 、a z with a M The conversion relationship is:

[0186]

[0187] Among them, a1, a2, and a3 are respectively M The three components in the inertial coordinate system, M GtB is the transformation matrix, expressed as:

[0188]

[0189] When flying to a uniform linear motion target, the target position can be replaced by the predicted target point PIP position, and the remaining flight time t can be calculated using the relative information between the aircraft and PIP. go and guidance instructions. The PIP calculation method is as follows:

[0190]

[0191] Where x, y, and z represent the coordinates in the inertial coordinate system, the subscript "PIP" represents the predicted intercept point, and "T" represents the target. Tx 、v Ty 、v Tz are the components of the target velocity in the three axes of the inertial coordinate system.

[0192] Assume that four aircraft take off from different initial positions at the same time and fly to the same target point. The speed and terminal angle constraints of the four aircraft are different. The above guidance law is used for guidance in order to achieve simultaneous arrival at the fixed target point. The four aircraft are respectively recorded as aircraft 1, 2, 3, and 4. The initial state and terminal conditions of the aircraft are shown in Tables 1 and 2, and the parameter selection is shown in Table 3.

[0193] Table 1 Initial conditions

[0194]

[0195] Table 2 Terminal conditions

[0196]

[0197] Table 3 Guidance law simulation parameters

[0198]

[0199] When the target point is fixed, that is, the target point speed is 0, the simulation results are shown in Table 4. The four aircraft can reach the target point at the same time, and the time error is on the order of 10 -3 The terminal sight angle control accuracy is also 10 -3° Above, the guidance accuracy and coordination accuracy are both high. Figure 3-Figure 5 The motion trajectories of the aircraft and the target. The four aircraft reach the target point at different expected angles.

[0200] Figure 6 It is the acceleration command curve. Due to the large initial time error and angle error, there is command saturation in the early stage of guidance. The command is smooth in the middle stage of guidance without jitter. Figure 7 is the change curve of the aircraft's line of sight angle. Both the line of sight altitude angle and the line of sight azimuth angle converge to the expected value at the terminal moment.

[0201] The simulation results show that the algorithm can enable multiple aircraft to reach a fixed target point at the same time at different desired angles with high accuracy, and can be used for coordinated flight to a fixed target point.

[0202] Table 4 Simulation results of flying to a stationary target

[0203]

[0204] When the target point moves along the negative direction of the OZ axis at a speed of 10 m / s, the simulation results are shown in Table 5. Obviously, the three-dimensional vector cooperative guidance law with flight time and terminal angle constraints can enable the four aircraft to reach the uniform straight line target point at different desired angles at the same time, and the time error and angle error are both within 10 -3 As shown above, the control accuracy is not reduced compared with flying to a stationary target point.

[0205] Figure 8-Figure 12 The simulation result diagram of reaching a uniform linear motion target. All four aircraft can accurately reach the moving target point, and the terminal sight angle can converge to the expected value. Therefore, the present invention can be applied to the multi-directional cooperative flight of multiple aircraft to a slow-moving target.

[0206] Table 5 Simulation results of flying to the moving target point

[0207]

[0208] In summary, the present invention designs a three-dimensional vector cooperative guidance law with flight time and terminal angle constraints without the need for plane decoupling, which enables the aircraft to reach the target point with the expected flight time and terminal angle, and has a fairly high guidance accuracy and cooperative accuracy. The acceleration direction required by the guidance law is along the velocity normal, which is suitable for the aircraft's unpowered flight stage; it has an analytical expression, does not require numerical algorithms or switching logic, has strong real-time performance, and smooth instructions; it belongs to a static cooperative guidance law, is not affected by communication interference, and has more obvious advantages when applied to fixed or slow large targets.

[0209] Those skilled in the art will appreciate that the above embodiments are specific embodiments for implementing the present application, and in actual applications, various changes may be made thereto in form and detail without departing from the spirit and scope of the present application.

Claims

1. A three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints, characterized in that: include: Establish the kinematic and dynamic equations of the aircraft in a three-dimensional scene and obtain the guidance model; Based on the guidance model, design a two-dimensional angle control guidance law under effective pure proportional guidance; Expand the two-dimensional angle control guidance law under effective pure proportional guidance into a three-dimensional angle control guidance law; By introducing the time constraint term into the three-dimensional angle control guidance law, a three-dimensional vector cooperative guidance law with flight time and terminal angle is obtained.

2. The three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints according to claim 1 is characterized in that: The guidance model is expressed as: Where M is the center of mass of the aircraft, v M is the aircraft speed, θ M is the velocity inclination angle, is the velocity deflection angle, a y and a z is the normal acceleration component of the aircraft; The aircraft velocity vector is expressed as: The unit vector representation of the aircraft velocity vector is: The relative position vector between the aircraft and the target is expressed as: Among them, q ε is the sight height angle, q β is the sight azimuth, r is the relative distance; The unit vector representation of the relative position vector is: The expected attack unit vector is expressed as: Among them, q εd is the desired sight line height angle, q βd is the expected sight line azimuth.

3. The three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints according to claim 2 is characterized in that: The two-dimensional angle control guidance law under the effective pure proportional guidance is expressed as: Among them, a M is the normal acceleration, is the line of sight angular rate, η is the lead angle, N is the proportional coefficient, K is the control gain, and K>0, t go is the remaining flight time, q f is the terminal sight angle of the aircraft, ε qf is the angle error; The remaining flight time is expressed as: The terminal sight angle of the aircraft is expressed as: Among them, q is the current sight angle; The angular error is expressed as: ε qf =q d -q f , Among them, q d is the expected terminal sight angle.

4. The three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints according to claim 3 is characterized in that: The three-dimensional angle control guidance law is expressed as: Among them, a M is the normal acceleration, ω r is the angular velocity of line of sight, u b Determines the direction of the angle offset term, δ qf =arccos(u d ·in r ), Among them, δ qf is the three-dimensional angle error, that is, vector u d and u r The angle between.

5. The three-dimensional vector cooperative guidance law design method with flight time and terminal angle constraints according to claim 4 is characterized in that: The three-dimensional vector cooperative guidance law with flight time and terminal angle is expressed as: ξ=tan 2 η(Ncosη-1)-K(Ncosη-1)tanηcosεδ qf , Among them, a t is the time constraint term, δ t is the time error, δ t =t d -tt go , t d is the expected attack time, t is the current time, ε is the vector u ω and u b The angle between them, ε = arccos(u ω ·u b ),u ω =ω r / ω r ,u ω ω r The unit vector, ω r ω r The Euclidean norm of 2 η, function sag p (x)=|x| p sat(x), Ψ(x) and sat(x) are auxiliary functions, defined as follows: σ>0, μ>0 are constants, l1, l2, κ1, κ2 are adjustable parameters, satisfying: l1>0,l2>0,m1>1,0 <m2<1。 6. 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 implement the method of claims 1-5.

7. 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 claims 1-5.

8. A computer program, characterized in that The invention comprises computer executable instructions, which are used to implement the method of claims 1-5 when being executed.

Citation Information

Cited By

  • Tail end angle constraint guidance method adopting three-dimensional vector rotation

    CN120779984A

  • Multi-angle entering three-dimensional vector guidance method meeting position constraint

    CN121143446A