CN113835439B - 一种针对初始航迹角自由的控制时间和角度的二维协同制导方法 - Google Patents
一种针对初始航迹角自由的控制时间和角度的二维协同制导方法 Download PDFInfo
- Publication number
- CN113835439B CN113835439B CN202111050450.8A CN202111050450A CN113835439B CN 113835439 B CN113835439 B CN 113835439B CN 202111050450 A CN202111050450 A CN 202111050450A CN 113835439 B CN113835439 B CN 113835439B
- Authority
- CN
- China
- Prior art keywords
- queue
- angle
- initial
- track
- search
- 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
- 238000000034 method Methods 0.000 title claims abstract description 27
- 230000001133 acceleration Effects 0.000 claims description 5
- 238000004364 calculation method Methods 0.000 abstract description 10
- 230000008859 change Effects 0.000 abstract description 2
- 230000008569 process Effects 0.000 description 5
- 230000007547 defect Effects 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 230000001351 cycling effect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000005457 optimization Methods 0.000 description 1
- 230000002265 prevention Effects 0.000 description 1
- 238000010845 search algorithm Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/107—Simultaneous control of position or course in three dimensions specially adapted for missiles
-
- 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)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提出了一种针对初始航迹角自由的控制时间和撞击角度的二维协同制导方法,其特征在于计算期望飞行距离、确定轨迹搜索初始值、计算初始航向角、计算贝塞尔曲线的控制点、计算贝塞尔轨迹长度、视贝塞尔轨迹长度调整初始航迹角大小、向搜索队列中加入初始搜索区间、从队列中取出头部搜索空间、向队列中加入需进一步搜索空间、判断队列是否为空、判断目标是否处于杀伤半径等步骤。本发明基于贝塞尔曲线长度单调性变化规律,设计了使用二分法确定初始航迹角和使用队列搜索轨迹跟踪点的方法,实现了飞行器变速度条件下的攻击时间和攻击角度的高精度控制。该算法的复杂度低,工程实现简单,具有收敛速度快、适于机载弹载计算机实时计算的优点。
Description
技术领域
本发明属于制导技术领域,特别涉及一种针对初始航迹角自由的控制时间和角度的二维协同制导方法。
背景技术
控制攻击时间和攻击角度的(ITACG)制导律目标是控制飞行器实现在特定时间、特定角度对目标进行打击,在军事上具有广泛的应用前景。尤其对于协同对海突击而言,ITACG制导律有希望降低对方防空系统的拦截效果,提高突防概率,且对于存在雷达盲区的舰船而言,具有特殊的打击效果。对于装备了垂直发射系统的舰艇而言,由于该系统发射的导弹具有全向攻击能力,相当于具有了一种选择合适的初始航迹角的机会。而当前ITACG制导律很少考虑初始航迹角的优化与选择问题,在导弹变速度的情况下,其制导律也存在计算复杂度高,不利于实时计算的缺点。同时对于轨迹跟踪问题而言,传统的轨迹离散化跟踪方法,具有跟踪精度低、时间误差大的缺点。
具体而言,ITACG制导律主要有变导引参数法、滑模控制法、飞行过程中集中决策法、飞行过程中分散决策法等。这些控制方法都极少考虑初始航迹角的优化问题,同时难以适应变速度的情况,且大多依赖于飞行过程中的通讯协调,一旦受到干扰很容易不能完成协同打击。最后,部分基于几何的制导律计算过程复杂,不利于机载计算机实时计算。
发明内容
为了解决现有技术中存在的问题,本发明提供了一种针对初始航迹角自由的控制时间和角度的二维协同制导方法,包括以下步骤:
S1:根据期望打击时间tD,根据飞行器速度剖面确定飞行器期望飞行距离LD。
S2:确定轨迹搜索初始值,具体包括:搜索角度下限θs,搜索角度上限θb,搜索精度ε,轨迹位置搜索宽度s,初始匹配τpre和搜索队列Q;
S3:计算初始航迹角
S4:根据初始航迹角和期望攻击角度确定贝塞尔曲线的控制点Pc(xc,yc),具体为:
记飞行器初始位置为E1(x1,y1),目标位置为E2(x2,y2),初始航迹角为θ0,期望攻击角度为θf,则控制点的位置可计算为:
yc=y1+tan(θf)(xc-x1)
S5:计算贝塞尔轨迹长度,记由E1、Pc、E2点组成的贝塞尔曲线为则其长度为/>
S6:视贝塞尔轨迹长度调整初始航迹角大小,具体为:
如果则θs=θ0,返回S3;
如果则θb=θ0,返回S3;
如果则进行S7;
S7:向搜索队列中加入初始搜索区间,具体为:
清空搜索队列Q,并将搜索空间加入队列Q中,记导弹当前的位置为P,设置τmin=τpre,/>
S8.从队列Q中弹出队首的搜索空间[τs,τb],则如果/>则τmin=τm,/>
S9:向队列中增加需要进一步搜索的空间:
如果τm-τs>ε且则向队列Q中加入[τs,τm];
如果τb-τm>ε且则向队列Q中加入[τm,τb];
否则如果τm-τs>ε则向队列加入[τs,τm]和[τm,τb];
S10:判断队列是否为空:
如果队列Q已空,则计算点的切线,记P点到切线的距离为d,切线方向为θd,则侧向加速度为/>τpre=τmin;
否则返回S8;
S11:判断目标是否处于杀伤半径内,如果是则退出,否则返回S7。
本发明提供的针对初始航迹角自由的控制时间的二维协同制导方法,制导律使用二分法确定初始航迹角,计算复杂度低,收敛速度快,计算量小,可以满足实时计算的要求。基于二分法设计了一种跟踪点选取搜索算法,对飞行器飞行过程中可能遇到的阻力具有很好的鲁棒性,可实现高精度打击时间控制。针对初始航计角可变的情况设计ITACG制导律,具有很强的实用性。
附图说明
图1本发明的制导律的计算流程图;
图2基于贝塞尔曲线的二段式制导轨迹;
图3无侧向机动的情况下速度剖面。
具体实施方式
为使本申请的目的、技术方案和优点更加清楚,下面将结合本申请具体实施例及相应的附图对本申请技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本申请一部分实施例,而不是全部的实施例。基于本申请中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本申请保护的范围。
本实施例具体步骤如图1所示,本发明首先针对期望攻击角计算初始航迹角,如图2所示。该轨迹对应的贝塞尔曲线可表示为该轨迹具有两个特点:
(1)对于90°>θ0>0°,90°>θf>0°,随θ0的变大而变大。
基于该单调性的特点,可使用二分法确定θ0使得等于期望长度。为了计算得到该轨迹,首先根据期望撞击时间tD和飞行器速度剖面确定期望飞行距离LD。其次先要设置初始参数,例如初始航迹角θ0=45°,角度搜索上限θs=0.1°,角度搜索下限θb=89.9°,搜索精度ε=0.01。然后根据初始航迹角θ0确定贝塞尔曲线的控制点Pc(xc,yc)。记E1为起点,E2称为终点,则初射直线和入射直线如式(1)所示。
两直线的焦点即为贝塞尔曲线的控制点Pc。贝塞尔曲线方程可表示如式(2)所示。
P(τ)=(1-τ)2E1+2(1-τ)τPc+τ2E2,τ∈[0,1] (2)
由于本发明采用二阶贝塞尔曲线,其曲线长度存在解析解,其计算方式为:
其中J=E1-2Pc+E3,K=Pc-E1,D=(J·K)/|J|2,E=|K|2/|J|2,U=E-D2,如果/>则说明初始航迹角和期望打击角已计算准确,其二阶贝塞尔曲线长度与期望长度相等。如果/>则θs=θ0,/>如果/>则θb=θ0,/>重复计算贝塞尔控制点和长度的公式即可对轨迹进行调整。
轨迹设计完毕后,需要初始化搜索队列,将搜索空间加入队列Q中。然后根据先进先出的原则,不停从队列首部弹出所需搜索的空间[τs,τb]。如果空间[τs,τb]中点对应的轨迹点与导弹更近,则更新贝塞尔曲线位置。且如果τm-τs>ε,则说明该区间还未到达搜索的精度,可能需要进一步在该区间进行搜索。在此情况下,如果则向队列中加入[τs,τm];如果/>则向队列中加入[τm,τb];否则将两个区间均加入搜索队列中。当搜索队列为空时,则说明已找到具体要跟踪的点了。此时再计算P点到切线的距离为d,切线方向为θd,则侧向加速度为循环往复便可跟踪该轨迹飞向目标。
本方法中,具体含有:一个飞行轨迹生成器和一个轨迹跟踪器。以导弹打击固定目标为例,发射点为E1=(0,0),打击目标位置为E2=(10000,0),期望打击时间tD=55s,期望打击角度为θf=-43°,初始发射角为θ0=49.04°。飞行轨迹生成器先根据飞行剖面计算期望飞行距离为11.5公里,控制点为Pc=(4474,5153)。假设导弹最大横侧向过载为200m/s2,典型飞行速度剖面如图3所示。
该制导律运行大致分为两个阶段。第一个阶段是飞行轨迹生成器运行,计算初始的θ0。在计算完毕后,实时搜索轨迹最近点并计算横侧向加速度。轨迹跟踪器在每个时间步的计算步骤如下:
(1)首先清空搜索队列Q,并将搜索空间加入队列Q中
(2)其次从队列Q中弹出队首的搜索空间[τs,τb],并更新最短点位置
(3)向队列中增加需要进一步搜索的空间。
(4)判断队列是否为空并计算跟踪所需的加速度。
上述虽然结合附图对本发明的具体实施方式进行了描述,但并非对发明保护范围的限制,所属领域技术人员应该明白,在本发明的技术方案的基础上,本领域技术人员不需要付出创造性劳动即可做出的各种修改或变形仍在本发明的保护范围内。
Claims (1)
1.一种针对初始航迹角自由的控制时间和角度的二维协同制导方法,其特征在于包括以下步骤:
S1:根据期望打击时间tD,根据飞行器速度剖面确定飞行器期望飞行距离LD;
S2:确定轨迹搜索初始值,具体包括:搜索角度下限θs,搜索角度上限θb,搜索精度ε,轨迹位置搜索宽度s,初始匹配τpre和搜索队列Q;
S3:计算初始航迹角
S4:根据初始航迹角和期望攻击角度确定贝塞尔曲线的控制点Pc(xc,yc),具体为:
记飞行器初始位置为E1(x1,y1),目标位置为E2(x2,y2),初始航迹角为θ0,期望攻击角度为θf,则控制点的位置可计算为:
yc=y1+tan(θf)(xc-x1)
S5:计算贝塞尔轨迹长度,记由E1、Pc、E2点组成的贝塞尔曲线为则其长度为
S6:视贝塞尔轨迹长度调整初始航迹角大小,具体为:
如果则θs=θ0,返回S3;
如果则θb=θ0,返回S3;
如果则进行S7;
S7:向搜索队列中加入初始搜索区间,具体为:
清空搜索队列Q,并将搜索空间加入队列Q中,记导弹当前的位置为P,设置τmin=τpre,/>
S8.从队列Q中弹出队首的搜索空间[τs,τb],则如果/>则τmin=τm,/>
S9:向队列中增加需要进一步搜索的空间:
如果τm-τs>ε且则向队列Q中加入[τs,τm];
如果τb-τm>ε且则向队列Q中加入[τm,τb];
否则如果τm-τs>ε则向队列加入[τs,τm]和[τm,τb];
S10:判断队列是否为空:
如果队列Q已空,则计算点的切线,记P点到切线的距离为d,切线方向为θd,则侧向加速度为/>τpre=τmin;
否则返回S8;
S11:判断目标是否处于杀伤半径内,如果是则退出,否则返回S7。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111050450.8A CN113835439B (zh) | 2021-09-08 | 2021-09-08 | 一种针对初始航迹角自由的控制时间和角度的二维协同制导方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111050450.8A CN113835439B (zh) | 2021-09-08 | 2021-09-08 | 一种针对初始航迹角自由的控制时间和角度的二维协同制导方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113835439A CN113835439A (zh) | 2021-12-24 |
CN113835439B true CN113835439B (zh) | 2024-03-26 |
Family
ID=78958719
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111050450.8A Active CN113835439B (zh) | 2021-09-08 | 2021-09-08 | 一种针对初始航迹角自由的控制时间和角度的二维协同制导方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113835439B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116909311B (zh) * | 2023-06-21 | 2024-06-14 | 四川大学 | 一种分布式弹群对海作战打击角决策方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2395409A2 (de) * | 2010-06-11 | 2011-12-14 | Diehl BGT Defence GmbH & Co.KG | Verfahren und Vorrichtung zum Steuern eines Lenkflugkörpers |
CN104965519A (zh) * | 2015-06-10 | 2015-10-07 | 北京理工大学 | 一种基于贝塞尔曲线的带落角约束的末制导方法 |
CN107132765A (zh) * | 2017-06-01 | 2017-09-05 | 烟台南山学院 | 一种基于轨迹规划的攻击角度与攻击时间控制方法 |
CN108153328A (zh) * | 2017-12-18 | 2018-06-12 | 北京理工大学 | 一种基于分段贝塞尔曲线的多导弹协同航迹规划方法 |
CN109471454A (zh) * | 2018-12-07 | 2019-03-15 | 湖北航天飞行器研究所 | 一种指定攻击倾角的微型作业飞行器的末端制导段进入方法 |
CN111351488A (zh) * | 2020-03-03 | 2020-06-30 | 南京航空航天大学 | 飞行器智能轨迹重构再入制导方法 |
-
2021
- 2021-09-08 CN CN202111050450.8A patent/CN113835439B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP2395409A2 (de) * | 2010-06-11 | 2011-12-14 | Diehl BGT Defence GmbH & Co.KG | Verfahren und Vorrichtung zum Steuern eines Lenkflugkörpers |
CN104965519A (zh) * | 2015-06-10 | 2015-10-07 | 北京理工大学 | 一种基于贝塞尔曲线的带落角约束的末制导方法 |
CN107132765A (zh) * | 2017-06-01 | 2017-09-05 | 烟台南山学院 | 一种基于轨迹规划的攻击角度与攻击时间控制方法 |
CN108153328A (zh) * | 2017-12-18 | 2018-06-12 | 北京理工大学 | 一种基于分段贝塞尔曲线的多导弹协同航迹规划方法 |
CN109471454A (zh) * | 2018-12-07 | 2019-03-15 | 湖北航天飞行器研究所 | 一种指定攻击倾角的微型作业飞行器的末端制导段进入方法 |
CN111351488A (zh) * | 2020-03-03 | 2020-06-30 | 南京航空航天大学 | 飞行器智能轨迹重构再入制导方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113835439A (zh) | 2021-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109947123B (zh) | 一种基于视线导引律的无人机路径跟踪与自主避障方法 | |
CN104778376B (zh) | 一种临近空间高超声速滑翔弹头跳跃弹道预测方法 | |
CN104793201B (zh) | 一种跟踪临近空间高超声速目标的修正变结构网格交互多模型滤波方法 | |
CN111591470B (zh) | 一种适应推力可调模式的飞行器精确软着陆闭环制导方法 | |
CN108534614B (zh) | 一种三维全向实时预测制导方法 | |
CN113835439B (zh) | 一种针对初始航迹角自由的控制时间和角度的二维协同制导方法 | |
CN110764523B (zh) | 基于抗饱和平滑变换的比例积分前置导引攻击目标的方法 | |
CN108614580A (zh) | 一种无人机目标跟踪中的分层避障控制方法 | |
CN114035616A (zh) | 一种飞行器对移动目标打击控制方法及系统 | |
CN115145295A (zh) | 一种动态环境下无人机在线自主航迹优化控制方法 | |
CN116679743A (zh) | 拦截机动目标的非线性最优飞行时间控制制导方法 | |
CN114153143A (zh) | 一种导弹非奇异固定时间滑模制导律的设计方法 | |
CN114489101B (zh) | 一种无人机的末端制导控制方法及系统 | |
CN109827478B (zh) | 一种带落角约束与过载约束的制导方法 | |
CN109543135B (zh) | 一种基于信息最大化的多auv协同同时导引方法 | |
CN114675673A (zh) | 一种空中动目标追踪方法及系统 | |
CN113834385B (zh) | 一种针对初始航迹角自由的控制时间的二维协同制导方法 | |
CN110728010A (zh) | 一种高炮火控系统射击诸元求取方法 | |
CN110471283B (zh) | 一种带碰撞角约束的三维鲁棒制导律构建方法 | |
CN115993772A (zh) | 一种基于贝塞尔曲线的四阶段二维制导方法 | |
CN117932894A (zh) | 一种多模导引头信息融合目标状态估计方法 | |
CN116227343A (zh) | 拦截机动目标满足视场角约束的末角攻击制导律设计方法 | |
CN112286059B (zh) | 一种具有攻击角和视场角约束的二阶前置角重塑制导方法 | |
CN115686059A (zh) | 一种基于伪谱法的高超声速飞行器禁飞区规避制导方法 | |
JP4407352B2 (ja) | 飛しょう体誘導システム |
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 |