CN110345814A - 一种不依赖自身导引头测量信息的末制导算法 - Google Patents
一种不依赖自身导引头测量信息的末制导算法 Download PDFInfo
- Publication number
- CN110345814A CN110345814A CN201910514281.5A CN201910514281A CN110345814A CN 110345814 A CN110345814 A CN 110345814A CN 201910514281 A CN201910514281 A CN 201910514281A CN 110345814 A CN110345814 A CN 110345814A
- Authority
- CN
- China
- Prior art keywords
- target
- guided missile
- coordinate system
- line
- sight
- 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
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、实时检测并修正目标运动状态数据中的野值
实时检测并修正友方导弹通过数据链提供的地面坐标系下目标运动状态数据中的野值,具体方法为:
首先,对友方导弹通过数据链发送的目标位置数据目标速度数据进行一阶差分,具体为:
其中,yk代表t(k)时刻的所构成的向量,且k≥4,t为时间序列,代表yk第i各元素的值,且i≤6。
根据友方导弹导引头的测量精度和目标机动加速度的经验取值设置门限值为Mi,若则认为yk为合理点;若则认为yk为野值,采用线性拟合的方式对该值进行修正,具体为:
其中,ai,bi线性拟合的中间变量,为经过线性拟合的修正值。
S3、计算地面坐标系中的视线角速度
利用相对运动方程计算地面坐标系中的视线角速度,计算方法为:
其中,和为修正野值后地面坐标系下的目标位置数据、目标速度数据,Xm,Ym,Zm和为导弹在地面坐标系下的位置分量、速度分量,rmt为导弹和目标的相对距离,为地面坐标系中的视线角速度分量。
S4、将地面坐标系中的视线角速度转化为弹道坐标系中
利用导弹的当前运动状态,将地面坐标系中的视线角速度转化为弹道坐标系中,计算方法为:
式中,为弹体坐标系中的视线角速度分量,θ,φV为导弹的弹道倾角、弹道偏角。
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轴与水平面之间的夹角,由导弹指向目标的视线矢量向上时为正;
2、惯性视线高低角速度惯性视线高低角εft的变化速度,沿Osys轴反方向看,逆时针转动为正;
3、惯性视线方位角βft:视线坐标系Osxs轴在水平面内的投影与地面坐标系Ox轴的夹角,沿Oy轴反方向看,由导弹指向目标的视线矢量在Ox轴左侧为正;
4、惯性视线方位角速度惯性视线方位角βft的变化速度,沿Oy轴反方向看,逆时针转动为正;
5、弹道倾角θ:速度矢量与水平面的夹角,速度矢量向上时为正;
6、弹道偏角φV:速度矢量在水平面内的投影与地面坐标系Ox轴的夹角;
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (6)
1.一种不依赖自身导引头测量信息的末制导算法,其特征在于,包含以下步骤:
(1)确定导弹和目标在地面坐标系中的位置和速度;
(2)实时检测并修正目标运动状态数据中的野值;
(3)计算地面坐标系中的视线角速度;
(4)将地面坐标系中的视线角速度转化为弹道坐标系中的视线角速度;
(5)计算弹道坐标系中的过载指令。
2.如权利要求1所述的一种不依赖自身导引头测量信息的末制导算法,其特征在于,所述步骤(1)中,友方导弹利用其测量信息,确定目标地面坐标系下的位置和速度,具体为:
式中,Xt,Yt,Zt和为友方导弹计算得到的目标在地面坐标系下的位置分量、速度分量,Xf,Yf,Zf和为友方导弹在地面坐标系下的位置分量、速度分量,εft,βft分别为目标相对于友方导弹的惯性视线高低角和惯性视线方位角,分别为目标相对于友方导弹的惯性视线高低角速度和惯性视线方位角速度,rft,分别为友方导弹和目标的相对距离和相对接近速度。
3.如权利要求2所述的一种不依赖自身导引头测量信息的末制导算法,其特征在于,所述步骤(2)中,首先,对友方导弹通过数据链发送的包含野值的目标位置数据、目标速度数据进行一阶差分,具体为:
式中,和为包含野值的目标位置数据、目标速度数据;yk为t(k)时刻的目标位置数据、目标速度数据所构成的向量,且k≥4,t为时间序列,为yk第i个元素的值,且i≤6;
根据友方导弹导引头的测量精度和目标机动加速度取值范围设置门限值为Mi;若则认为yk为合理点;若则认为yk为野值,采用线性拟合的方式对该值进行修正,具体为:
其中,ai,bi线性拟合的中间变量,为经过线性拟合的修正值。
4.如权利要求3所述的一种不依赖自身导引头测量信息的末制导算法,其特征在于,利用相对运动方程计算地面坐标系中的视线角速度,具体为:
其中,和为修正野值后地面坐标系下的目标位置数据、目标速度数据,Xm,Ym,Zm和为导弹在地面坐标系下的位置分量、速度分量,rmt为导弹和目标的相对距离,为地面坐标系中的视线角速度分量。
5.如权利要求4所述的一种不依赖自身导引头测量信息的末制导算法,其特征在于,所述步骤(3)中,利用导弹的当前运动状态,将地面坐标系中的视线角速度转化为弹道坐标系中,具体为:
其中,为弹体坐标系中的视线角速度分量,θ,φV为导弹的弹道倾角、弹道偏角。
6.如权利要求5所述的一种不依赖自身导引头测量信息的末制导算法,其特征在于,所述步骤(4)中,利用弹道坐标系中的视线角速度计算弹道坐标系中的比例导引律过载指令,具体为:
其中,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 true CN110345814A (zh) | 2019-10-18 |
CN110345814B 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) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111121539A (zh) * | 2019-12-20 | 2020-05-08 | 上海航天控制技术研究所 | 一种基于高速数据链的双目协同探测方法及装置 |
CN111397449A (zh) * | 2020-04-03 | 2020-07-10 | 中国北方工业有限公司 | 一种针对导引头失效模式下的数据链末制导方法 |
CN114061380A (zh) * | 2021-09-29 | 2022-02-18 | 湖北航天飞行器研究所 | 一种概略瞄准制导方法 |
CN114923365A (zh) * | 2022-06-07 | 2022-08-19 | 西北工业大学 | 一种类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 | 上海航天控制技术研究所 | 伺服系统静态标定及动态零位补偿的试验方法及系统 |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111121539A (zh) * | 2019-12-20 | 2020-05-08 | 上海航天控制技术研究所 | 一种基于高速数据链的双目协同探测方法及装置 |
CN111121539B (zh) * | 2019-12-20 | 2022-04-22 | 上海航天控制技术研究所 | 一种基于高速数据链的双目协同探测方法及装置 |
CN111397449A (zh) * | 2020-04-03 | 2020-07-10 | 中国北方工业有限公司 | 一种针对导引头失效模式下的数据链末制导方法 |
CN114061380A (zh) * | 2021-09-29 | 2022-02-18 | 湖北航天飞行器研究所 | 一种概略瞄准制导方法 |
CN114061380B (zh) * | 2021-09-29 | 2023-11-03 | 湖北航天飞行器研究所 | 一种概略瞄准制导方法 |
CN114923365A (zh) * | 2022-06-07 | 2022-08-19 | 西北工业大学 | 一种类tvm制导方法及装置 |
CN114923365B (zh) * | 2022-06-07 | 2023-01-17 | 西北工业大学 | 一种类tvm制导方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
CN110345814B (zh) | 2021-10-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110345814A (zh) | 一种不依赖自身导引头测量信息的末制导算法 | |
CN108416098B (zh) | 一种拦截机动目标的攻击时间约束制导律设计方法 | |
CN112558631B (zh) | 基于测量信息的带大落角约束变参数制导方法 | |
CN108279005B (zh) | 一种导引头数据失效模式下的制导信息重构方法 | |
CN109634293B (zh) | 一种固定翼无人机翻滚机动控制方法 | |
CN107132765B (zh) | 一种基于轨迹规划的攻击角度与攻击时间控制方法 | |
Yamasaki et al. | Triangle intercept guidance for aerial defense | |
CN108073742B (zh) | 基于改进粒子滤波算法的拦截导弹末段飞行状态估计方法 | |
CN115857538A (zh) | 三维空间下满足落角约束的多飞行器协同制导方法 | |
CN110160519A (zh) | 用于脉冲修正火箭弹的弹体姿态计算方法 | |
CN114489101A (zh) | 一种无人机的末端制导控制方法及系统 | |
CN113587740A (zh) | 一种基于弹目视线角的被动反辐射导引方法及系统 | |
CN109780933B (zh) | 一种单兵制导火箭动态目标预测导引方法 | |
RU2436032C1 (ru) | Способ наведения управляемой ракеты | |
CN110972541B (zh) | 一种提高脱靶平面内弹目相对高度的导引方法 | |
RU2498342C1 (ru) | Способ перехвата воздушных целей летательными аппаратами | |
RU2504725C2 (ru) | Способ пуска ракет для подвижных пусковых установок | |
CN115328206A (zh) | 一种适用于多无人机协同打击的分段制导方法 | |
Zuoe et al. | Study on vertical attack penetration probability of anti-ship missile | |
RU2439462C1 (ru) | Способ управления высокоточным оружием | |
CN114153143A (zh) | 一种导弹非奇异固定时间滑模制导律的设计方法 | |
Wang et al. | A hardware-in-the-loop simulation for LOS rate estimation of strapdown seeker based on EKF | |
Tang et al. | Research on Target State Estimation and Terminal Guidance Algorithm in the Process of Multi-UAV Cooperative Attack | |
RU2558407C2 (ru) | Способ определения наклонной дальности воздушной цели по ее установленной скорости | |
US20140042265A1 (en) | Method for automatically managing a homing device mounted on a projectile, in particular on a missile |
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 |