CN114754628B - 基于落点预测和虚拟跟踪的飞行体弹道控制方法 - Google Patents
基于落点预测和虚拟跟踪的飞行体弹道控制方法 Download PDFInfo
- Publication number
- CN114754628B CN114754628B CN202210355098.7A CN202210355098A CN114754628B CN 114754628 B CN114754628 B CN 114754628B CN 202210355098 A CN202210355098 A CN 202210355098A CN 114754628 B CN114754628 B CN 114754628B
- Authority
- CN
- China
- Prior art keywords
- deviation
- control
- flying body
- trajectory
- flight
- 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
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F41—WEAPONS
- F41G—WEAPON SIGHTS; AIMING
- F41G3/00—Aiming or laying means
-
- 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)
- General Engineering & Computer Science (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
Abstract
本发明提出了一种基于落点预测和虚拟跟踪的飞行体弹道控制方法,以实现控制能力较弱的飞行体,在较大弹道偏差下的精确控制。该方法通过根据实际飞行中的弹道参数,预测出飞行体理论落点Xt、Zt和剩余飞行时间Tt,并计算出理论落点和目标点的位置偏差△X,△Z。根据预估的落点偏差和飞行时间,计算出每秒需要消除的纵向△X/Tt和侧向偏差△Z/Tt,飞行中根据飞行体的实时位置(Xf、Zf)、方案弹道位置(Xp、Zp)、对应时刻需要消除的纵向△XTi/Tt和侧向偏差△ZTi/Tt形成反馈控制,控制飞行体逐步消除弹道偏差,以预测落点和目标点的偏差为最终控制指标,逼近目标点,实现对目标的精确打击。
Description
技术领域
本发明属于飞行控制技术领域,特别是一种针对控制能力弱的身管发射的制导炮弹、制导火箭的高精度弹道控制方法。
背景技术
制导炮弹、制导火箭是现代兵器领域的重要发展方向,由于其射速快、机动灵活、携弹量大、可全天候作战,现代战争中仍极为重要,特别在现代军事斗争中,在策略上有其独特作用,但新形势、新环境下,对火炮、火箭的作战性能也提出了更高的要求,需要其在射程、精度和威力上进一步向前发展。
提高射击精度是制导炮弹和制导火箭发展的关注重点,其飞行控制系统是实现高精度打击的关键,飞行控制算法是飞行控制系统的核心。现在常用于制导炮弹、制导火箭的飞行控制算法为经典的PID控制和滑模控制、鲁棒控制、智能控制等控制理论与方法,这些通用的控制算法常与方案弹道跟踪、比例制导等方法结合来实现对目标的精确打击,通过计算飞行体与方案弹道对应的实时位置偏差进行弹道跟踪,需要飞行体提供较大的控制能力才能实现高精度方案弹道跟踪,这与管射的制导炮弹、制导火箭的飞行控制能力弱相矛盾,且随着其射程的不断提高,启控时刻的弹道偏差也逐步增大,如果飞行控制系统不能协调好较大弹道偏差和较小控制能力之间的问题,则将极大影响此类飞行体的制导控制精度。
在国内外文献中,目前还比较缺乏对于此类飞行体控制能力弱和较大控制偏差下如何实现精确控制的针对性研究,尤其是随着制导炮弹和制导火箭向超远射程发展,飞行过程中扰动带来的弹道偏差越来越大,但对飞行稳定性和控制精度的要求更高,这一研究将变得更为迫切。
发明内容
本发明的目的在于提供一种基于落点预测和虚拟弹道跟踪的精确弹道控制方法,以实现控制能力较弱的飞行体,在较大弹道偏差下的精确控制。
实现本发明目的的技术解决方案为:
一种基于落点预测和虚拟跟踪的飞行体弹道控制方法,根据实际飞行中的弹道参数,预测出飞行体落点Xt、Zt和剩余飞行时间Tt,并计算出理论落点和目标点的位置偏差△X,△Z;
根据预估的落点偏差和飞行时间,计算出每秒需要消除的纵向位置偏差△X/Tt和侧向位置偏差△Z/Tt,输出控制指令驱动舵机运动以消除误差;
飞行中根据飞行体的实时位置(Xf、Zf)、方案弹道位置(Xp、Zp)、对应时刻需要消除的纵向位置偏差和侧向位置偏差形成反馈控制,控制飞行体逐步消除弹道偏差,以消除预测落点和目标点的偏差为最终控制指标,生成最终的指令舵偏角,操纵飞行体姿态,使得飞行体按照指令要求的轨迹飞行。
本发明与现有技术相比,其显著优点是:
(1)通过对落点的预测,获得落点偏差,并基于落点偏差进行全程修正,确保了在较大偏差情况下,能够实现稳定逐步消除落点偏差。避免传统方案弹道跟踪方法需要实时对当前飞行器位置和方案弹道位置的对应偏差进行修正控制,引起控制能力不足导致弹道控制精度差的问题。
(2)基于空中实时飞行弹道数据,进行落点预测,确保了偏差修正的实时性和有效性,补充了可用控制参量,提高了控制性能。
(3)直接修正相对于目标落点的纵向偏差△X和横向偏差△Z,避免了现有传统方法对Y向弹道参数的跟踪和修正,减小了对飞行体控制能力的要求。
(4)飞行控制过程中,以平均的落点偏差量作为主要的控制参量,能够实现稳步消除偏差,确保弹体飞行稳定,减小飞行攻角,减少了飞行中的气动阻力,提高了落点速度,从而增强打击效果。
(5)控制过程中对落点偏差的逐步消除,确保了弹体稳定性,为末端中末制导交接创造了更加稳定的弹道环境,保证了不同导引律交接的弹体稳定性,为顺利转入末制导提供了良好的弹体稳定性。
附图说明
图1为制导回路系统原理框图。
具体实施方式
下面结合附图及具体实施例对本发明做进一步的介绍。
根据图1所示的控制流程,飞行体发射后,基于弹道上升段某时刻的弹道参数,根据弹道方程组,推算落点,计算出目标点和落点的弹道偏差及平均弹道偏差(落点偏差除以控制飞行时间)。控制器依据平均偏差、弹体运动参数及部分方案弹道参数,计算出控制指令,驱动舵机运动,舵面偏转,控制飞行体姿态,进而改变飞行轨迹,实现控制指标。
本发明通过根据实际飞行中的弹道参数,预测出飞行体落点Xt、Zt和剩余飞行时间Tt,并计算出理论落点和目标点的位置偏差△X,△Z。根据预估的落点偏差和飞行时间,计算出每秒需要消除的纵向△X/Tt和侧向偏差△Z/Tt,飞行中根据飞行体的实时位置(Xf、Zf)、方案弹道位置(Xp、Zp)、对应时刻需要消除的纵向△XTi/Tt和侧向偏差△ZTi/Tt形成反馈控制,控制飞行体逐步消除弹道偏差,以预测落点和目标点的偏差为最终控制指标,逼近目标点,在末端转入比例制导,实现对目标的精确打击。整个控制飞行过程,并不实时跟踪方案弹道,而是以逐步消除落点偏差为控制指标,实现以消除偏差为目的虚拟弹道的跟踪,兼顾飞行稳定和精确打击的双重目标,实现控制能力较弱的飞行体在较大偏差时候的精确弹道控制。具体包括以下步骤:
步骤1:采用雷达、卫星或者惯导等测量方式,测量并获得飞行体的弹道参数,这些弹道参数主要包含:飞行速度V、弹道倾角θ、弹道偏角将测得的弹道参数作为初始值,输入弹载计算机内的三自由度弹道方程,解算出预测飞行弹道,获得需要的弹道参数并保存在弹载存储器,用于控制的弹道参数包括:飞行体落点(Xt、Zt)和控制飞行时间Tt、启控点至落点的间隔△T的弹道参数。
步骤2:计算出预测落点和目标点的纵向位置偏差△X,侧向位置偏差△Z。根据预估的落点偏差和飞行时间,计算出每秒需要消除的纵向偏差△X/Tt和侧向偏差△Z/Tt,飞行中根据飞行体的实时位置(Xf、Zf)、方案弹道位置(Xp、Zp)、对应时刻需要消除的纵向位置偏差△XTi/Tt和侧向位置偏差△ZTi/Tt。其中△XTi=|Xf-Xp|,△ZTi=|Zf-Zp|。
设目标点和预测落点得出需要控制的偏差ycDX=△X、ycDZ=△Z;
启控后每秒需要消除的纵向和侧向偏差ycDDX=△X/Tt、ycDDZ=△Z/Tt;
实际飞行的射程、侧偏和Z向速度为FACTX,FACTZ,FACTVZ。
步骤3:根据实时测量的弹道参数、落点偏差和方案弹道,基于反馈控制原理,采用经典控制方法,可得飞行体纵向和横向的控制器表达式为:
DeltY=ycKX*ycDDX+kx1*(ycDDX*ConT-(FACTX-ycPROX))+kx2*DET0;
DeltZ=ycKZ*ycDDZ+kz1*(ycDDZ*ConT-(FACTZ-ycPROZ))+kdz*(-FACTVZ);
式中DeltY,DeltZ分别为纵向和横向需求舵偏角;
ycDDX,ycDDZ分别为单位时间需要消除的纵向和侧向偏差;
FACTX,FACTZ,FACTVZ分别为实际飞行的射程、侧偏和Z向速度;
ycPROX、ycPROZ分别为方案弹道对应的射程X和侧偏参数;
ConT为当前飞行控制时间;
ycKX,kx1,kx2为纵向控制系数;
ycKZ,kz1,kdz为横向控制系数;
DET0为重力补偿角度。
控制器的组成中ycKX*ycDDX、ycKZ*ycDDZ为根据单位时间需要控制消除的偏差乘以控制参数作为主控制变量,通过调整控制参数的大小,使得飞行体快速稳定消除偏差,向目标落点逼近。
控制器中的kx1*(ycDDX*ConT-(FACTX-ycPROX))、kz1*(ycDDZ*ConT-(FACTZ-ycPROZ))是根据当前时刻总共需要消除的位置偏差与当前时刻的实际位置偏差的差构成的控制变量,其主要用于补偿前期出现的跟踪误差,提高控制精度,通过调整控制参数来实现补偿量的大小。
控制器中的kx2*DET0由生成方案弹道的方案舵偏角DET0和控制参数组成,根据纵向和侧向的偏差量值来微调控制参数值,此项主要是随着侧向偏差的大小,调整补偿角度,使得在侧向较大偏差时,不要影响纵向的控制效果。
kdz*(-FACTVZ)为根据侧向的速度大小来适当调整侧向的舵偏角,此项主要是增加侧向的阻尼,减少摆动,提高稳定性和跟踪精度。
步骤4:根据步骤3计算得到的横向和纵向舵偏角,根据舵机和控制或要求进行舵偏角限幅,并根据合力方向值和限幅后的舵偏角重新进行纵向和横向的舵偏角分配,生成最终的指令舵偏角,驱动舵机,控制舵翼偏转,操纵飞行体姿态,使得飞行体按照指令要求的轨迹飞行,实现稳定的高精度弹道控制。
本发明作为一种基于落点预测和虚拟弹道跟踪的精确弹道控制方法,以实现控制能力较弱的飞行体,在较大弹道偏差下的精确控制。通过对落点的预测,获得落点偏差,并通过控制过程中对落点偏差的逐步消除,确保了弹体稳定性,避免传统方案弹道跟踪方法需要实时对当前飞行器位置和方案弹道位置的对应偏差进行修正控制,引起控制能力不足导致弹道控制精度差的问题,提高了远程制导炮弹、制导火箭等控制能力较弱的飞行体的飞行稳定性和弹道控制精度。
Claims (2)
1.一种基于落点预测和虚拟跟踪的飞行体弹道控制方法,其特征在于,根据实际飞行中的弹道参数,预测出飞行体落点Xt、Zt和剩余飞行时间Tt,并计算出理论落点和目标点的位置偏差△X,△Z;
根据预估的落点偏差和剩余飞行时间,计算出每秒需要消除的纵向位置偏差△X/Tt和侧向位置偏差△Z/Tt,输出控制指令驱动舵机运动以消除误差;
飞行中根据飞行体的实时位置(Xf、Zf)、方案弹道位置(Xp、Zp)、对应时刻需要消除的纵向位置偏差和侧向位置偏差形成反馈控制,控制飞行体逐步消除弹道偏差,以消除预测落点和目标点的偏差为最终控制指标,生成最终的指令舵偏角,操纵飞行体姿态,使得飞行体按照指令要求的轨迹飞行;
飞行体纵向和横向的控制器表达式为:
DeltY=ycKX*ycDDX+kx1*(ycDDX*ConT-(FACTX-ycPROX))+kx2*DET0;
DeltZ=ycKZ*ycDDZ+kz1*(ycDDZ*ConT-(FACTZ-ycPROZ))+kdz*(-FACTVZ);
式中DeltY,DeltZ分别为纵向和横向需求舵偏角;
ycDDX,ycDDZ分别为单位时间需要消除的纵向和侧向偏差;
ycPROX、ycPROZ分别为方案弹道对应的射程X和侧偏参数;
FACTX,FACTZ,FACTVZ分别为实际飞行的射程、侧偏和Z向速度;
ConT为当前飞行控制时间;
ycKX,kx1,kx2为纵向控制系数;
ycKZ,kz1,kdz为横向控制系数;
DET0为重力补偿角度。
2.根据权利要求1所述的基于落点预测和虚拟跟踪的飞行体弹道控制方法,其特征在于,弹道参数采用雷达、卫星或者惯导等测量方式测量。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210355098.7A CN114754628B (zh) | 2022-03-31 | 2022-03-31 | 基于落点预测和虚拟跟踪的飞行体弹道控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210355098.7A CN114754628B (zh) | 2022-03-31 | 2022-03-31 | 基于落点预测和虚拟跟踪的飞行体弹道控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114754628A CN114754628A (zh) | 2022-07-15 |
CN114754628B true CN114754628B (zh) | 2023-08-04 |
Family
ID=82330019
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210355098.7A Active CN114754628B (zh) | 2022-03-31 | 2022-03-31 | 基于落点预测和虚拟跟踪的飞行体弹道控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114754628B (zh) |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4008869A (en) * | 1976-01-07 | 1977-02-22 | Litton Systems, Inc. | Predicted - corrected projectile control system |
JPH1183398A (ja) * | 1997-09-02 | 1999-03-26 | Mitsubishi Electric Corp | 誘導飛しょう体 |
KR20160070573A (ko) * | 2014-12-10 | 2016-06-20 | 국방과학연구소 | 유도탄의 요격지점 실시간 예측 방법 |
CN107168374A (zh) * | 2017-07-06 | 2017-09-15 | 中国人民解放军军械工程学院 | 横向平面的自适应比例微分导引方法 |
CN107796401A (zh) * | 2017-10-11 | 2018-03-13 | 北京航空航天大学 | 跳跃式再入飞行器线性伪谱参数修正横向制导方法 |
CN111336871A (zh) * | 2020-03-24 | 2020-06-26 | 北京理工大学 | 一种基于迂回式飞行的垂直攻击制导方法 |
CN111473696A (zh) * | 2020-03-24 | 2020-07-31 | 北京理工大学 | 一种基于落点估计的制导火箭垂直攻击制导方法 |
CN113011011A (zh) * | 2021-03-02 | 2021-06-22 | 南京理工大学 | 炮弹轨迹修正方法及装置、存储介质及电子装置 |
CN113176787A (zh) * | 2021-04-25 | 2021-07-27 | 上海航天控制技术研究所 | 一种基于落点预测的动力下降轨迹规划在线触发方法 |
-
2022
- 2022-03-31 CN CN202210355098.7A patent/CN114754628B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US4008869A (en) * | 1976-01-07 | 1977-02-22 | Litton Systems, Inc. | Predicted - corrected projectile control system |
JPH1183398A (ja) * | 1997-09-02 | 1999-03-26 | Mitsubishi Electric Corp | 誘導飛しょう体 |
KR20160070573A (ko) * | 2014-12-10 | 2016-06-20 | 국방과학연구소 | 유도탄의 요격지점 실시간 예측 방법 |
CN107168374A (zh) * | 2017-07-06 | 2017-09-15 | 中国人民解放军军械工程学院 | 横向平面的自适应比例微分导引方法 |
CN107796401A (zh) * | 2017-10-11 | 2018-03-13 | 北京航空航天大学 | 跳跃式再入飞行器线性伪谱参数修正横向制导方法 |
CN111336871A (zh) * | 2020-03-24 | 2020-06-26 | 北京理工大学 | 一种基于迂回式飞行的垂直攻击制导方法 |
CN111473696A (zh) * | 2020-03-24 | 2020-07-31 | 北京理工大学 | 一种基于落点估计的制导火箭垂直攻击制导方法 |
CN113011011A (zh) * | 2021-03-02 | 2021-06-22 | 南京理工大学 | 炮弹轨迹修正方法及装置、存储介质及电子装置 |
CN113176787A (zh) * | 2021-04-25 | 2021-07-27 | 上海航天控制技术研究所 | 一种基于落点预测的动力下降轨迹规划在线触发方法 |
Non-Patent Citations (1)
Title |
---|
基于弹道预测与倾角校正的末制导炮弹导引方法;张华;常思江;牛春峰;;四川兵工学报(第11期) * |
Also Published As
Publication number | Publication date |
---|---|
CN114754628A (zh) | 2022-07-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110220416B (zh) | 一种自适应快速弹道跟踪制导方法 | |
CN111473696B (zh) | 一种基于落点估计的制导火箭垂直攻击制导方法 | |
CN111306998A (zh) | 一种参数摄动自适应的制导火箭弹垂直攻击制导方法 | |
CN111591470B (zh) | 一种适应推力可调模式的飞行器精确软着陆闭环制导方法 | |
CN111336871B (zh) | 一种基于迂回式飞行的垂直攻击制导方法 | |
CN111399531A (zh) | 一种高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
CN115406312B (zh) | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 | |
CN112182772A (zh) | 火箭推进控制方法、设备及存储介质 | |
CN111580547A (zh) | 一种高超声速飞行器编队控制方法 | |
Solis | An analysis of the vertical launch phase of a missile concept | |
JPH0933197A (ja) | 混合ミサイル自動操縦器 | |
CN114754628B (zh) | 基于落点预测和虚拟跟踪的飞行体弹道控制方法 | |
CN114637304A (zh) | 一种察打武器系统及随动跟踪控制方法 | |
CN114153143A (zh) | 一种导弹非奇异固定时间滑模制导律的设计方法 | |
CN116301028B (zh) | 基于吸气式高超声速平台的多约束在线飞行轨迹规划中段导引方法 | |
CN115993769A (zh) | 一种用于高动态飞行器的一体化制导控制方法 | |
CN113739635B (zh) | 一种实现导弹大扇面角发射的制导方法 | |
CN114995517A (zh) | 一种基于弹道偏角纠偏的亚音速飞行器轨迹规划方法 | |
CN114153226A (zh) | 动态视线信息辅助的无人飞行器视场保持导引方法及系统 | |
CN114646238B (zh) | 飞行体状态感知自适应方案弹道跟踪方法 | |
Menon et al. | Integrated Guidance-Control Systems for Fixed-Aim Warhead Missiles | |
CN113064443B (zh) | 增益在线调整方法及使用其的阻尼回路控制方法 | |
CN210180291U (zh) | 一种制导系统 | |
Duhri et al. | Guidance and control of 2nd stage RKX-200EB missile using proportional navigation approach | |
CN114740874B (zh) | 无人机火箭助推发射滚转姿态控制方法 |
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 |