CN110345814B - 一种不依赖自身导引头测量信息的末制导算法 - Google Patents
一种不依赖自身导引头测量信息的末制导算法 Download PDFInfo
- Publication number
- CN110345814B CN110345814B CN201910514281.5A CN201910514281A CN110345814B CN 110345814 B CN110345814 B CN 110345814B CN 201910514281 A CN201910514281 A CN 201910514281A CN 110345814 B CN110345814 B CN 110345814B
- Authority
- CN
- China
- Prior art keywords
- coordinate system
- target
- missile
- line
- angular velocity
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000005259 measurement Methods 0.000 title claims abstract description 18
- 238000000034 method Methods 0.000 claims description 15
- 230000001133 acceleration Effects 0.000 claims description 3
- 238000012937 correction Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 238000001514 detection method Methods 0.000 description 3
- 230000000007 visual effect Effects 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F41—WEAPONS
- F41G—WEAPON SIGHTS; AIMING
- F41G3/00—Aiming or laying means
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
Abstract
本发明公开了一种不依赖自身导引头测量信息的末制导算法,包含以下步骤:利用友方导弹的测量信息确定目标在地面坐标系中的位置和速度;实时检测并修正目标运动状态数据中的野值;建立相对运动方程,计算地面坐标系中的视线角速度;利用导弹的当前运动状态,将地面坐标系中的视线角速度转化为弹道坐标系中;利用弹道坐标系中的视线角速度计算弹道坐标系中的比例导引律过载指令,完成制导算法的设计。本发明利用友方导弹的测量信息计算目标的运动状态信息,依据导弹和目标的相对运动关系计算视线角速度并计算制导指令,避免了由于自身导引头难以探测目标信息时,无法计算制导指令的问题。
Description
技术领域
本发明涉及战术武器制导算法技术领域,具体涉及一种不依赖自身导引头测量信息的末制导算法。
背景技术
随着现代战争中战场环境的复杂化,多元化,战术武器的导引头在工作过程中遭受的干扰也日益增多。战术武器在攻击目标的过程中,受攻击目标主动干扰或环境干扰等多种因素的影响,导引头极有可能丧失对目标进行跟踪探测的能力,无法实时向制导***输出视线角速度,导致制导***无法正常工作,并最终导致作战任务的失败。如何在自身导引头无法正常工作的条件下获取用于生成导弹制导指令的视线角速度,对提升导弹在复杂战场环境下的作战效能极为重要。
目前,主要采用诱饵弹识别算法、目标检测算法等方式提高导引头的抗干扰能力或通过地面雷达引导来应对强外界干扰对导引头探测能力的影响。提高抗干扰能力能在一定程度上应对目标对导弹的主动干扰,但上述方法都必须对干扰源和目标具备一定的先验信息,当面对未知干扰源,或目标信息与干扰源信息无明显不同时,抗干扰能力将明显下降甚至丧失抗干扰能力。而且,当存在探测角度不足、目标被遮挡等问题时,导引头同样无法向制导***输出目标的视线角速度信息。使用地面或载机雷达引导的方式对作战环境和态势有着极高的要求,在实际使用中会受到极大的限制。
发明内容
本发明的目的在于提供一种不依赖自身导引头测量信息的末制导算法,利用友方导弹的测量信息计算目标的运动状态信息,依据导弹和目标的相对运动关系计算视线角速度并计算制导指令,避免了由于自身导引头难以探测目标信息时,无法计算制导指令的问题。
为了达到上述目的,本发明通过以下技术方案实现:一种不依赖自身导引头测量信息的末制导算法,其特点是,包含以下步骤:
(1)确定导弹和目标在地面坐标系中的位置和速度;
(2)实时检测并修正目标运动状态数据中的野值;
(3)计算地面坐标系中的视线角速度;
(4)将地面坐标系中的视线角速度转化为弹道坐标系中;
(5)计算弹道坐标系中的比例导引律过载指令;
进一步地,所述步骤(1)中,利用友方导弹在地面坐标系下的位置信息和目标相对于友方导弹的视线信息计算目标在地面坐标系下位置和速度。
进一步地,所述步骤(2)中,采用一阶差分检测目标运动数据当前值是否为野值,采用线性拟合对野值进行修正。
进一步地,所述步骤(3)中,利用导弹和目标的相对位置和相对运动速度计算用于计算制导指令的地面坐标系中的视线角速度。
进一步地,所述步骤(4)中,利用导弹相对于地面坐标系的弹道倾角、弹道偏角信息,将地面坐标系中的视线角速度转化到弹体坐标系中。
进一步地,所述步骤(5)中,计算导弹和目标的相对接近速度,利用弹体坐标系中的视线角速度等信息计算弹体坐标系中的比例导引律过载指令。
本发明一种不依赖自身导引头测量信息的末制导算法与现有技术相比具有以下优点:本发明根据友方导弹的测量信息,确定了目标的运动状态,检测并修正了数据中的野值,将修正后的数据代入相对运动方程中,计算了用于生成制导指令的视线角速度,并生成了制导指令,避免了由于导弹自身导引头无法提供有效的目标视线角速度信息导致的制导指令无法计算的问题。
附图说明
图1为本发明一种不依赖自身导引头测量信息的末制导算法的流程图。
具体实施方式
以下结合附图,通过详细说明一个较佳的具体实施例,对本发明做进一步阐述。
如图1所示,一种不依赖自身导引头测量信息的末制导算法,包含以下步骤:
S1、确定导弹和目标在地面坐标系中的位置和速度
友方导弹利用其测量信息,确定目标地面坐标系下的位置和速度,具体方法为:
式中,Xt,Yt,Zt和为友方导弹计算得到的目标在地面坐标系下的位置分量、速度分量,Xf,Yf,Zf和为友方导弹在地面坐标系下的位置分量、速度分量,εft,βft分别为目标相对于友方导弹的惯性视线高低角和惯性视线方位角,分别为目标相对于友方导弹的惯性视线高低角速度和惯性视线方位角速度,rft,分别为友方导弹和目标的相对距离和相对接近速度。
S2、实时检测并修正目标运动状态数据中的野值
实时检测并修正友方导弹通过数据链提供的地面坐标系下目标运动状态数据中的野值,具体方法为:
S3、计算地面坐标系中的视线角速度
利用相对运动方程计算地面坐标系中的视线角速度,计算方法为:
S4、将地面坐标系中的视线角速度转化为弹道坐标系中
利用导弹的当前运动状态,将地面坐标系中的视线角速度转化为弹道坐标系中,计算方法为:
S5、计算弹道坐标系中的比例导引律过载指令
利用弹道坐标系中的视线角速度计算弹道坐标系中的比例导引律过载指令,计算方法为:
式中,nyc,nzc为弹体坐标系中的俯仰和偏航通道的比例导引律过载指令,K为比例导引律制导系数,g为重力加速度。
野值、时间序列、比例导引律、俯仰和偏航通道、弹道倾角、弹道偏角、坐标转换矩阵定义为本领域公知知识,在此不再详述。
坐标系定义:
1、地面坐标系Oxyz
坐标原点O位于导弹发射点,Ox轴在水平面内,指向北为正,Oy轴在包含Ox轴的铅垂面内且与Ox轴垂直,指向天为正,Oz轴与Ox轴和Oy轴组成右手坐标系。
2、弹道坐标系Ovxvyvzv
坐标原点Ov位于导弹质心,Ovxv轴沿速度方向,与速度方向相同时为正,Ovyv轴在包含Ovxv轴的铅垂面内且与Ovxv轴垂直,指向上方为正,Ovzv轴与Ovxv轴和Ovyv轴组成右手坐标系。
3、视线坐标系Osxsyszs
坐标原点Os位于导弹质心,Osxs轴沿导弹与目标的视线方向,由导弹指向目标为正,Osys轴在包含Osxs轴的铅垂面内且与Osxs轴垂直,指向上方为正,Oszs轴与Osxs轴和Osys轴组成右手坐标系。
角度和角速度定义:
1、惯性视线高低角εft:视线坐标系Osxs轴与水平面之间的夹角,由导弹指向目标的视线矢量向上时为正;
3、惯性视线方位角βft:视线坐标系Osxs轴在水平面内的投影与地面坐标系Ox轴的夹角,沿Oy轴反方向看,由导弹指向目标的视线矢量在Ox轴左侧为正;
5、弹道倾角θ:速度矢量与水平面的夹角,速度矢量向上时为正;
6、弹道偏角φV:速度矢量在水平面内的投影与地面坐标系Ox轴的夹角;
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (1)
1.一种不依赖自身导引头测量信息的末制导算法,其特征在于,包含以下步骤:
(1)确定导弹和目标在地面坐标系中的位置和速度;
(2)实时检测并修正目标运动状态数据中的野值;
(3)计算地面坐标系中的视线角速度;
(4)将地面坐标系中的视线角速度转化为弹道坐标系中的视线角速度;
(5)计算弹道坐标系中的过载指令;
所述步骤(1)中,友方导弹利用其测量信息,确定目标地面坐标系下的位置和速度,具体为:
式中,Xt,Yt,Zt和为友方导弹计算得到的目标在地面坐标系下的位置分量、速度分量,Xf,Yf,Zf和为友方导弹在地面坐标系下的位置分量、速度分量,εft,βft分别为目标相对于友方导弹的惯性视线高低角和惯性视线方位角,分别为目标相对于友方导弹的惯性视线高低角速度和惯性视线方位角速度,rft,分别为友方导弹和目标的相对距离和相对接近速度;
所述步骤(2)中,首先,对友方导弹通过数据链发送的包含野值的目标位置数据、目标速度数据进行一阶差分,具体为:
利用相对运动方程计算地面坐标系中的视线角速度,具体为:
所述步骤(3)中,利用导弹的当前运动状态,将地面坐标系中的视线角速度转化为弹道坐标系中,具体为:
所述步骤(4)中,利用弹道坐标系中的视线角速度计算弹道坐标系中的比例导引律过载指令,具体为:
其中,nyc,nzc为弹体坐标系中的俯仰和偏航通道的比例导引律过载指令,K为比例导引律制导系数,g为重力加速度;
所述步骤(5)中,
利用弹道坐标系中的视线角速度计算弹道坐标系中的比例导引律过载指令,具体为:
式中,nyc,nzc为弹体坐标系中的俯仰和偏航通道的比例导引律过载指令,K为比例导引律制导系数,g为重力加速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910514281.5A CN110345814B (zh) | 2019-06-14 | 2019-06-14 | 一种不依赖自身导引头测量信息的末制导算法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910514281.5A CN110345814B (zh) | 2019-06-14 | 2019-06-14 | 一种不依赖自身导引头测量信息的末制导算法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110345814A CN110345814A (zh) | 2019-10-18 |
CN110345814B true CN110345814B (zh) | 2021-10-15 |
Family
ID=68182115
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910514281.5A Active CN110345814B (zh) | 2019-06-14 | 2019-06-14 | 一种不依赖自身导引头测量信息的末制导算法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110345814B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111121539B (zh) * | 2019-12-20 | 2022-04-22 | 上海航天控制技术研究所 | 一种基于高速数据链的双目协同探测方法及装置 |
CN111397449B (zh) * | 2020-04-03 | 2021-07-20 | 中国北方工业有限公司 | 一种针对导引头失效模式下的数据链末制导方法 |
CN114061380B (zh) * | 2021-09-29 | 2023-11-03 | 湖北航天飞行器研究所 | 一种概略瞄准制导方法 |
CN114923365B (zh) * | 2022-06-07 | 2023-01-17 | 西北工业大学 | 一种类tvm制导方法及装置 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB1306674A (en) * | 1968-04-25 | 1973-02-14 | France Armed Forces | Method and device for correcting the aim of a weapon |
FR1605335A (en) * | 1955-01-18 | 1974-10-31 | Anti aircraft rocket control system - predicting gyrometer type device replaced by low inertia device | |
US3960453A (en) * | 1973-12-20 | 1976-06-01 | Forenade Fabriksverken | Electronic telescopic sight |
CN103245256A (zh) * | 2013-04-25 | 2013-08-14 | 北京理工大学 | 一种多导弹协同作战制导律设计方法 |
CN106681348A (zh) * | 2017-01-13 | 2017-05-17 | 西北工业大学 | 考虑全捷联导引头视场约束的制导控制一体化设计方法 |
CN107478111A (zh) * | 2017-08-02 | 2017-12-15 | 北京理工大学 | 导引头模型辨识***及应用其的制导控制仿真*** |
CN108759565A (zh) * | 2018-06-07 | 2018-11-06 | 哈尔滨工业大学 | 一种基于虚拟比例导引的运载火箭子级返回段精确制导方法 |
CN109581888A (zh) * | 2018-12-04 | 2019-04-05 | 上海航天控制技术研究所 | 伺服***静态标定及动态零位补偿的试验方法及*** |
-
2019
- 2019-06-14 CN CN201910514281.5A patent/CN110345814B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
FR1605335A (en) * | 1955-01-18 | 1974-10-31 | Anti aircraft rocket control system - predicting gyrometer type device replaced by low inertia device | |
GB1306674A (en) * | 1968-04-25 | 1973-02-14 | France Armed Forces | Method and device for correcting the aim of a weapon |
US3960453A (en) * | 1973-12-20 | 1976-06-01 | Forenade Fabriksverken | Electronic telescopic sight |
CN103245256A (zh) * | 2013-04-25 | 2013-08-14 | 北京理工大学 | 一种多导弹协同作战制导律设计方法 |
CN106681348A (zh) * | 2017-01-13 | 2017-05-17 | 西北工业大学 | 考虑全捷联导引头视场约束的制导控制一体化设计方法 |
CN107478111A (zh) * | 2017-08-02 | 2017-12-15 | 北京理工大学 | 导引头模型辨识***及应用其的制导控制仿真*** |
CN108759565A (zh) * | 2018-06-07 | 2018-11-06 | 哈尔滨工业大学 | 一种基于虚拟比例导引的运载火箭子级返回段精确制导方法 |
CN109581888A (zh) * | 2018-12-04 | 2019-04-05 | 上海航天控制技术研究所 | 伺服***静态标定及动态零位补偿的试验方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN110345814A (zh) | 2019-10-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110345814B (zh) | 一种不依赖自身导引头测量信息的末制导算法 | |
CN111580556B (zh) | 一种时空约束下多无人机协同路径规划与制导方法 | |
Kim et al. | Lyapunov-based impact time control guidance laws against stationary targets | |
CN107132765B (zh) | 一种基于轨迹规划的攻击角度与攻击时间控制方法 | |
CN108279005B (zh) | 一种导引头数据失效模式下的制导信息重构方法 | |
CN109669480B (zh) | 一种预测目标位置的导引头控制方法 | |
CN111351401B (zh) | 应用于捷联导引头制导飞行器的防侧偏制导方法 | |
CN105180728B (zh) | 基于前数据的旋转制导炮弹快速空中对准方法 | |
CN112033234B (zh) | 一种多导弹协同制导律设计方法 | |
CN110686564B (zh) | 一种红外半捷联导引头制导方法及*** | |
CN114035616B (zh) | 一种飞行器对移动目标打击控制方法及*** | |
CN111487997A (zh) | 一种攻击型无人机双机协同制导方法 | |
CN113587740B (zh) | 一种基于弹目视线角的被动反辐射导引方法及*** | |
CN111397449B (zh) | 一种针对导引头失效模式下的数据链末制导方法 | |
CN110972541B (zh) | 一种提高脱靶平面内弹目相对高度的导引方法 | |
RU2436032C1 (ru) | Способ наведения управляемой ракеты | |
Zuoe et al. | Study on vertical attack penetration probability of anti-ship missile | |
Li et al. | Anti-jamming Trajectory Planning of Infrared Imaging Air-to-air Missile | |
CN114608391B (zh) | 一种具有隐身效果的炮弹制导方法及*** | |
CN112379599A (zh) | 一种针对空中机动目标的三维协同中制导方法 | |
CN115755955B (zh) | 基于截获概率的空空导弹协同探测方法 | |
CN105987652A (zh) | 姿态角速率估算***及应用其的弹药 | |
CN113008080B (zh) | 一种基于刚性原理对近海目标进行火控解算方法 | |
Jisi et al. | Simulation for two-dimensional trajectory correction projectile with fixed-canard based on modified proportional navigation | |
RU2260162C1 (ru) | Способ наведения телеуправляемой ракеты и система наведения для его реализации |
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 |