CN112099348A - Collision angle control guidance method based on observer and global sliding mode - Google Patents
Collision angle control guidance method based on observer and global sliding mode Download PDFInfo
- Publication number
- CN112099348A CN112099348A CN202010837398.XA CN202010837398A CN112099348A CN 112099348 A CN112099348 A CN 112099348A CN 202010837398 A CN202010837398 A CN 202010837398A CN 112099348 A CN112099348 A CN 112099348A
- Authority
- CN
- China
- Prior art keywords
- target
- missile
- observer
- sliding mode
- guidance
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Granted
Links
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
Abstract
The invention discloses an impact angle control guidance method based on an observer and a global sliding mode. The method comprises the following steps: firstly, establishing a bullet relative kinematics model; then acquiring the motion parameters of the projectile body and the target through a projectile-borne sensor; estimating target acceleration information; then designing a guidance law; finally, inputting a guidance instruction into an actuator to control the missile to fly; and repeating the step motion parameter measurement and the guidance control until the guidance is finished. The invention has the characteristic of limited time convergence and is suitable for static targets and maneuvering targets.
Description
Technical Field
The invention relates to the technical field of missile guidance, in particular to a collision angle control guidance method based on an observer and a global sliding mode.
Background
In order to achieve accurate strike, a designed guidance law is required to ensure a small miss distance. However, in some special application scenarios, such as anti-tank missiles and anti-ship missiles, a designed guidance law can be required to control the collision angle so as to enhance the damage effect. Scholars at home and abroad propose solutions to the multi-constraint guidance law problem. For example, Dou L. (Dou, L., Dou, J.: The design of optimal guidance law with multi-constraints using block pulse functions. Aerospace Science and Technology 23(1), 201-. Lee C.H. et al (Lee, C.H., Shin, H.S., Tsourdos, A.: A New Command Shaping navigation Law using Lagrange Multiplier. IFAC paperOnLine 50(1), 15185-. Liu D.W. et al (Liu, D.W., Xia, Q., Du, Y.: Miss Distance and Impact Angle Error of trajectory Shaping guide Law Based on Statistical linear linearity addition method 11 (13)), 6370-6377(2011)) propose an Impact Angle control Guidance Law Based on a linear quadratic optimization control theory, and adopt a Statistical linearity adaptation Guidance Law to study the characteristics of the proposed Guidance Law. Erer K.S. et al (er K.S.: index Impact-Angle-Control acquisition Targets Using binary Pure presentation navigation. journal of Guidance controls and Dynamics,35 (2)), 700-. However, the above methods all need to acquire the remaining flight time of the missile, and the remaining flight time of the missile is usually acquired by an estimation method, so that estimation errors are inevitably introduced, and the missile cannot complete a precise hitting task; on the other hand, none of the above methods can guarantee the finite time convergence characteristic.
Disclosure of Invention
The invention aims to provide a collision angle control guidance method based on an observer and a global sliding mode and having a finite time convergence characteristic, so that a missile can complete a task of accurately striking.
The technical solution for realizing the purpose of the invention is as follows: an impact angle control guidance method based on an observer and a global sliding mode comprises the following steps:
and 6, repeating the steps 2 to 5 until the guidance is finished.
Further, the establishment of the bullet relative kinematics model in the step 1 specifically includes the following steps:
the relative kinematics model of the missile-target in the two-dimensional plane is established as follows:
wherein, the lower corner marks T and M represent the target and the missile; a represents acceleration, V represents velocity, θ represents line of sight angle, λ and the direction of flight angles of the missile and target, respectively, relative to the line of sight LOS; γ represents a flight path angle;
andrespectively representing the acceleration components of the missile and the target perpendicular to the LOS; vθAnd VRRepresenting relative velocity perpendicular to and along the LOS, respectively; the calculation is made according to the following formula:
Vθ=VMsin-VTsinλ,VR=VMcos-VTcosλ (3)。
further, the step 2 of obtaining the motion parameters of the projectile body and the target through the projectile-loaded sensor specifically includes:
the projectile motion parameters obtained by the projectile loading sensor are as follows: vMλ; the target motion parameters obtained by the missile-borne sensor are as follows: vT,。
Further, the estimating of the target acceleration information in step 3 specifically includes:
observer dynamics are represented by:
wherein h is0、h1、h2、z0、z1、z2Intermediate variables, with no specific meaning; sgn () is a sign function; k>0 is a design constant;
the dynamic state of the observer is solved in real time to obtain the estimation of the target accelerationComprises the following steps:
further, designing a guidance law in the step 4 specifically includes:
Design the sliding mode variable s as
Wherein, mu1>0 and mu2>0 is a constant, t represents time;
acceleration of missile of
Wherein g >0 is a constant;
A is an intermediate variable, with no specific meaning, calculated according to the following formula:
compared with the prior art, the invention has the following remarkable advantages: (1) the guidance method is based on a global sliding mode control method and a fast observer, and has the characteristic of finite time convergence; (2) by adopting a sliding mode control technology, the control of a large-range impact angle can be realized; (3) the method is suitable for static targets and maneuvering targets and has a wide application range.
Drawings
FIG. 1 is a schematic flow chart diagram of an impact angle control guidance method based on a global sliding mode.
FIG. 2 is a diagram of the missile flight trajectory during the simulation.
FIG. 3 is a global sliding mode variable trajectory diagram in the simulation process.
FIG. 4 is a view angle trace diagram during simulation.
FIG. 5 is a diagram of acceleration trajectory during simulation.
Detailed Description
The invention discloses an impact angle control guidance method based on an observer and a global sliding mode, which comprises the following steps of:
and 6, repeating the steps 2 to 5 until the guidance is finished.
Further, the establishment of the bullet relative kinematics model in the step 1 specifically includes the following steps:
the relative kinematics model of the missile-target in the two-dimensional plane is established as follows:
wherein, the lower corner marks T and M represent the target and the missile; a represents acceleration, V represents velocity, θ represents line of sight angle, λ and the direction of flight angles of the missile and target, respectively, relative to the line of sight LOS; γ represents a flight path angle;
andrespectively representing the acceleration components of the missile and the target perpendicular to the LOS; vθAnd VRRepresenting relative velocity perpendicular to and along the LOS, respectively; the calculation is made according to the following formula:
Vθ=VMsin-VTsinλ,VR=VMcos-VTcosλ (3)。
further, the step 2 of obtaining the motion parameters of the projectile body and the target through the projectile-loaded sensor specifically includes:
the projectile motion parameters obtained by the projectile loading sensor are as follows: vMλ; the target motion parameters obtained by the missile-borne sensor are as follows: vT,。
Further, the estimating of the target acceleration information in step 3 specifically includes:
observer dynamics are represented by:
wherein h is0、h1、h2、z0、z1、z2Intermediate variables, with no specific meaning; sgn () is a sign function; k>0 is a design constant;
the dynamic state of the observer is solved in real time to obtain the estimation of the target accelerationComprises the following steps:
further, designing a guidance law in the step 4 specifically includes:
Design the sliding mode variable s as
Wherein, mu1>0 and mu2>0 is a constant, t represents time;
acceleration of missile of
Wherein g >0 is a constant;
A is an intermediate variable, with no specific meaning, calculated according to the following formula:
the invention is described in further detail below with reference to the figures and the embodiments.
Example 1
With reference to fig. 1, the invention provides an impact angle control guidance method based on an observer and a global sliding mode, which comprises the following steps:
the relative kinematics model of the missile-target in the two-dimensional plane can be established as follows:
wherein, the lower corner marks T and M represent the target and the missile; a represents acceleration, V represents velocity, θ represents line of sight angle, λ and the direction of flight angles of the missile and target, respectively, relative to the line of sight (LOS); γ represents the flight path angle.Andrespectively representing the acceleration components of the missile and the target perpendicular to the LOS; vθAnd VRIndicating the relative velocity perpendicular to and along the LOS, respectively. They can be calculated according to the following formula:
Vθ=VMsin-VTsinλ,VR=VMcos-VTcosλ (3)
the projectile motion parameters obtained by the projectile loading sensor are as follows: vMλ; the target motion parameters obtained by the missile-borne sensor are as follows: vT,。
observer dynamics can be represented by:
wherein h is0、h1、h2、z0、z1、z2Intermediate variables, with no specific meaning; sgn () is a sign function; k>0 is a design constant.
The observer dynamics is solved in real time, and the estimation of the target acceleration can be obtainedComprises the following steps:
Design the sliding mode variable s as
Wherein, mu1>0 and mu2>0 is a design constant; t represents time.
The missile acceleration can be designed as
Wherein g is a design parameter. It is known thatRequire thatA is an intermediate variable, with no specific meaning, and can be calculated according to the following formula:
and 6, repeating the steps 2 to 6 until the guidance is finished.
By means of a handleA collision angle control guidance method based on an observer and a global sliding mode is provided, and a guidance simulation experiment is designed. The simulation parameters are designed as follows: vM=900,VT=1000,0=180°,λ0=180°,μ1=0.6;μ2=0.8,τT=0.1s,θ0=0°,R0In the simulation, assume the target is at aTManeuver was performed at 50sin (0.7t + π). The initial conditions were set as: target coordinates: (0,0) m; missile coordinates are as follows: (15000,0) m.
Fig. 2 is a diagram of the flight trajectory of a missile during simulation, and it can be seen from fig. 2 that the proposed method results in three significantly different flight trajectories in order to obtain a desired terminal angle.
Fig. 3 is a trace diagram of a global sliding mode variable in a simulation process, and it can be seen from fig. 3 that an initial value of the sliding mode variable is always 0 and is kept near a value of 0 in the simulation process.
Fig. 4 is a view of the trajectory of the viewing angle in the simulation process, and it can be seen from fig. 4 that the missile can finally obtain the desired viewing angle.
Fig. 5 is a diagram of acceleration traces in the simulation process, and it can be seen from fig. 5 that the acceleration traces are smoother.
In conclusion, the guidance method is based on a global sliding mode control method and a fast observer, and has the characteristic of finite time convergence; by adopting a sliding mode control technology, the control of a large-range impact angle can be realized; the method is suitable for static targets and maneuvering targets and has a wide application range.
Claims (5)
1. An impact angle control guidance method based on an observer and a global sliding mode is characterized by comprising the following steps:
step 1, establishing a bullet relative kinematics model;
step 2, acquiring the motion parameters of a projectile body and a target through a projectile-borne sensor;
step 3, estimating target acceleration information;
step 4, designing a guidance law;
step 5, inputting instructions to an actuator to control the missile to fly;
and 6, repeating the steps 2 to 5 until the guidance is finished.
2. The method for controlling and guiding the collision angle based on the observer and the global sliding mode according to claim 1, wherein the establishment of the missile-target relative kinematics model in the step 1 specifically comprises the following steps:
the relative kinematics model of the missile-target in the two-dimensional plane is established as follows:
wherein, the lower corner marks T and M represent the target and the missile; a represents acceleration, V represents velocity, θ represents line of sight angle, λ and the direction of flight angles of the missile and target, respectively, relative to the line of sight LOS; γ represents a flight path angle;
andrespectively representing the acceleration components of the missile and the target perpendicular to the LOS; vθAnd VRRepresenting relative velocity perpendicular to and along the LOS, respectively; the calculation is made according to the following formula:
Vθ=VMsin-VTsinλ,VR=VMcos-VTcosλ (3)。
3. the collision angle control guidance method based on the observer and the global sliding mode according to claim 1, wherein the step 2 of obtaining the motion parameters of the projectile body and the target through the missile-borne sensor specifically comprises the following steps:
the projectile motion parameters obtained by the projectile loading sensor are as follows: vMλ; the target motion parameters obtained by the missile-borne sensor are as follows: vT,。
4. The method for controlling and guiding an impact angle based on an observer and a global sliding mode according to claim 1, wherein the estimating of the target acceleration information in step 3 is specifically:
observer dynamics are represented by:
wherein h is0、h1、h2、z0、z1、z2Intermediate variables, with no specific meaning; sgn () is a sign function; k>0 is a design constant;
the dynamic state of the observer is solved in real time to obtain the estimation of the target accelerationComprises the following steps:
5. the method for controlling and guiding an impact angle based on an observer and a global sliding mode according to claim 1, wherein the designing of the guidance law in the step 4 specifically comprises:
Design the sliding mode variable s as
Wherein, mu1>0 and mu2>0 is a constant, t represents time;
acceleration of missile of
Wherein g >0 is a constant;
A is an intermediate variable, with no specific meaning, calculated according to the following formula:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010837398.XA CN112099348B (en) | 2020-08-19 | 2020-08-19 | Collision angle control guidance method based on observer and global sliding mode |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010837398.XA CN112099348B (en) | 2020-08-19 | 2020-08-19 | Collision angle control guidance method based on observer and global sliding mode |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112099348A true CN112099348A (en) | 2020-12-18 |
CN112099348B CN112099348B (en) | 2022-05-20 |
Family
ID=73753148
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010837398.XA Active CN112099348B (en) | 2020-08-19 | 2020-08-19 | Collision angle control guidance method based on observer and global sliding mode |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112099348B (en) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113359819A (en) * | 2021-05-27 | 2021-09-07 | 北京航空航天大学 | Optimal guidance law with collision angle constraint and acceleration limitation |
CN113589839A (en) * | 2021-07-09 | 2021-11-02 | 山东思达特测控设备有限公司 | Unmanned aerial vehicle automatic collision avoidance method based on rapid finite time convergence sliding mode guidance |
CN113589840A (en) * | 2021-07-09 | 2021-11-02 | 山东思达特测控设备有限公司 | Unmanned aerial vehicle automatic collision avoidance method based on finite time convergence sliding mode guidance |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130092785A1 (en) * | 2008-07-11 | 2013-04-18 | Davidson Technologies, Inc. | System and method for guiding and controlling a missile using high order sliding mode control |
CN106934120A (en) * | 2017-02-23 | 2017-07-07 | 哈尔滨工业大学 | Three-dimensional guidance based on preceding from the interception hypersonic aircraft to guidance restrains method for designing |
CN110017729A (en) * | 2019-04-18 | 2019-07-16 | 西安交通大学 | A kind of more guided missile time coordination method of guidance with impingement angle constraint |
CN110220416A (en) * | 2019-05-15 | 2019-09-10 | 南京理工大学 | A kind of adaptive quickly path tracking method of guidance |
-
2020
- 2020-08-19 CN CN202010837398.XA patent/CN112099348B/en active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130092785A1 (en) * | 2008-07-11 | 2013-04-18 | Davidson Technologies, Inc. | System and method for guiding and controlling a missile using high order sliding mode control |
CN106934120A (en) * | 2017-02-23 | 2017-07-07 | 哈尔滨工业大学 | Three-dimensional guidance based on preceding from the interception hypersonic aircraft to guidance restrains method for designing |
CN110017729A (en) * | 2019-04-18 | 2019-07-16 | 西安交通大学 | A kind of more guided missile time coordination method of guidance with impingement angle constraint |
CN110220416A (en) * | 2019-05-15 | 2019-09-10 | 南京理工大学 | A kind of adaptive quickly path tracking method of guidance |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113359819A (en) * | 2021-05-27 | 2021-09-07 | 北京航空航天大学 | Optimal guidance law with collision angle constraint and acceleration limitation |
CN113359819B (en) * | 2021-05-27 | 2024-04-16 | 北京航空航天大学 | Optimal guidance law with collision angle constraint and acceleration limitation |
CN113589839A (en) * | 2021-07-09 | 2021-11-02 | 山东思达特测控设备有限公司 | Unmanned aerial vehicle automatic collision avoidance method based on rapid finite time convergence sliding mode guidance |
CN113589840A (en) * | 2021-07-09 | 2021-11-02 | 山东思达特测控设备有限公司 | Unmanned aerial vehicle automatic collision avoidance method based on finite time convergence sliding mode guidance |
Also Published As
Publication number | Publication date |
---|---|
CN112099348B (en) | 2022-05-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN112099348B (en) | Collision angle control guidance method based on observer and global sliding mode | |
CN108168381B (en) | A kind of control method of more pieces of guided missile cooperations | |
CN110220416B (en) | Self-adaptive rapid trajectory tracking guidance method | |
CN111551080B (en) | Guidance method for attack time control | |
CN111591470B (en) | Aircraft precise soft landing closed-loop guidance method adapting to thrust adjustable mode | |
CN105486308B (en) | Estimation plays the design method of the rapid convergence Kalman filter of line of sight angular speed | |
CN111324149A (en) | Composite guidance method based on line-of-sight angle information and preposed guidance information | |
CN115406312B (en) | Missile guidance control integrated method considering view angle and steering engine delay constraint | |
CN106091816B (en) | A kind of half strapdown air-to-air missile method of guidance based on sliding mode variable structure theory | |
Wang et al. | Three-dimensional impact angle and time control guidance law based on two-stage strategy | |
CN113758380B (en) | Guidance control integration method considering steering engine dynamic performance and attack angle constraint | |
CN114489101B (en) | Terminal guidance control method and system for unmanned aerial vehicle | |
CN110471283B (en) | Three-dimensional robust guidance law construction method with collision angle constraint | |
CN109780933B (en) | Dynamic target prediction guidance method for individual-soldier guided rocket | |
CN116663263A (en) | Aircraft tail end falling speed and falling angle constraint guidance method and system based on sliding die surface | |
CN114153143B (en) | Design method of non-singular fixed time sliding mode guidance law of missile | |
Xiaojian et al. | Impact angle control over composite guidance law based on feedback linearization and finite time control | |
CN113110428A (en) | Carrier-based aircraft landing fixed time trajectory tracking method based on limited backstepping control | |
CN117073473B (en) | Missile view angle planning guidance method and system based on time constraint | |
CN115289908B (en) | Remote control instruction air-defense missile introduction section guiding method and device | |
CN112097765B (en) | Aircraft preposed guidance method combining steady state with time-varying preposed angle | |
Awad et al. | Evaluation and enhancing missile performance via real time flight simulation model | |
CN112306073B (en) | Multi-lead-angle guiding method based on fuzzy confidence superposition | |
CN116974208B (en) | Rotor unmanned aerial vehicle target hitting control method and system based on strapdown seeker | |
CN116126033B (en) | Image composite aircraft guidance control method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |