CN118009819B - 一种弱资源情况下的转弯控制策略设计方法 - Google Patents
一种弱资源情况下的转弯控制策略设计方法 Download PDFInfo
- Publication number
- CN118009819B CN118009819B CN202410428317.9A CN202410428317A CN118009819B CN 118009819 B CN118009819 B CN 118009819B CN 202410428317 A CN202410428317 A CN 202410428317A CN 118009819 B CN118009819 B CN 118009819B
- Authority
- CN
- China
- Prior art keywords
- deflection angle
- quasi
- rudder
- channel
- angle
- 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 10
- 238000011217 control strategy Methods 0.000 title claims abstract description 7
- 238000013016 damping Methods 0.000 claims description 14
- 238000005096 rolling process Methods 0.000 claims description 2
- 229920001971 elastomer Polymers 0.000 claims 6
- 239000000806 elastomer Substances 0.000 claims 6
- 241000380131 Ammophila arenaria Species 0.000 claims 3
- 230000005540 biological transmission Effects 0.000 claims 3
- 238000010304 firing Methods 0.000 claims 2
- 238000005259 measurement Methods 0.000 claims 1
- 230000006641 stabilisation Effects 0.000 description 4
- 238000011105 stabilization Methods 0.000 description 4
- 230000007774 longterm Effects 0.000 description 3
- 238000009434 installation Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000087 stabilizing effect Effects 0.000 description 1
Classifications
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B15/00—Self-propelled projectiles or missiles, e.g. rockets; Guided missiles
- F42B15/01—Arrangements thereon for guidance or control
-
- F—MECHANICAL ENGINEERING; LIGHTING; HEATING; WEAPONS; BLASTING
- F42—AMMUNITION; BLASTING
- F42B—EXPLOSIVE CHARGES, e.g. FOR BLASTING, FIREWORKS, AMMUNITION
- F42B15/00—Self-propelled projectiles or missiles, e.g. rockets; Guided 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)
- General Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Combustion & Propulsion (AREA)
- Aiming, Guidance, Guns With A Light Source, Armor, Camouflage, And Targets (AREA)
Abstract
本发明公开了一种弱资源情况下的转弯控制策略设计方法,依次计算滚转通道舵偏角指令、弹体实时弹道倾角和弹道偏角、发射系速度方向单位向量及速度方向指令单位向量、准弹体系速度方向单位向量及速度方向指令单位向量、准弹体系俯仰和偏航通道舵偏角指令、弹体系俯仰和偏航通道舵偏角指令,最终将弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令。本发明有效降低了发射初始段由于舵效低而长时间满舵所导致的程序角跟踪误差较大甚至弹体发散的风险。
Description
技术领域
本发明属于制导技术领域,具体涉及一种弱资源情况下的转弯控制策略设计方法。
背景技术
垂直发射导弹在发射初始段速度较慢、动压较小、舵效较低,难以同时满足抗扰、滚转角控制和弹道转弯的控制需求。为了降低发射初始段由于舵资源紧俏等弱资源情况所导致的程序角跟踪误差较大甚至弹体发散的风险,需要在抗扰动、滚转角控制、弹道转弯三者之间做出适当取舍,更合理地利用舵资源,以保证导弹在发射初始段的飞行质量。
发明内容
为了克服现有技术的不足,本发明提供了一种弱资源情况下的转弯控制策略设计方法,依次计算滚转通道舵偏角指令、弹体实时弹道倾角和弹道偏角、发射系速度方向单位向量及速度方向指令单位向量、准弹体系速度方向单位向量及速度方向指令单位向量、准弹体系俯仰和偏航通道舵偏角指令、弹体系俯仰和偏航通道舵偏角指令,最终将弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令。本发明有效降低了发射初始段由于舵效低而长时间满舵所导致的程序角跟踪误差较大甚至弹体发散的风险。
本发明解决其技术问题所采用的技术方案如下:
步骤1:计算滚转通道舵偏角指令:
;
如果飞行时间小于等于N:
;
如果飞行时间大于N:
;
其中,、、均为滚转通道控制增益,为惯导测量的弹体滚转角速度,为滚转角指令,为惯导测量的弹体滚转角,为滚转通道阻尼舵偏角指令,为滚转通道阻尼+PI控制舵偏角指令,为滚转通道舵偏角指令;
步骤2:计算弹体实时弹道倾角和弹道偏角;
弹道倾角:
;
弹道偏角:
;
其中,分别为惯导测量的导弹发射系速度在X、Y、Z轴的分量,为弹道倾角,为弹道偏角;
步骤3:计算发射系速度方向单位向量及速度方向指令单位向量;
发射系速度方向单位向量:
;
发射系速度方向指令单位向量:
;
其中,为装定的弹道倾角指令,为装定的弹道偏角指令,分别为速度方向单位向量在发射系X、Y、Z轴的分量,分别为速度方向指令单位向量在发射系X、Y、Z轴的分量;
步骤4:计算准弹体系速度方向单位向量及速度方向指令单位向量;
准弹体系速度方向单位向量:
;
准弹体系速度方向指令单位向量:
;
其中,为惯导测量的弹体发射系俯仰角,为惯导测量的发射系偏航角,分别为速度方向单位向量在准弹体系X、Y、Z轴的分量,分别为速度方向指令单位向量在准弹体系X、Y、Z轴的分量;
步骤5:计算准弹体系俯仰和偏航通道舵偏角指令;
将俯仰和偏航角速度转为准弹体系角速度:
;
其中,分别为惯导测量的弹体偏航和俯仰角速度,为惯导测量的弹体滚转角,为准弹体偏航角速度,为准弹体俯仰角速度;
准弹体系俯仰和偏航通道阻尼舵偏角指令分别为:
;
其中,为俯仰偏航通道阻尼控制增益,为准弹体系俯仰通道阻尼舵偏角指令,为准弹体系偏航通道阻尼舵偏角指令;
准弹体系俯仰和偏航通道增稳舵偏角指令分别为:
;
其中,为俯仰偏航通道增稳控制增益,为准弹体系俯仰通道增稳舵偏角指令,为准弹体系偏航通道增稳舵偏角指令;
准弹体系俯仰通道弹道倾角控制舵偏角指令和偏航通道弹道偏角舵偏角指令分别为:
;
其中,分别为弹道倾角和弹道偏角指令对应空间指向与准弹体系的夹角,分别为弹道倾角和弹道偏角对应空间指向与准弹体系的夹角,为准弹体系俯仰通道弹道倾角控制舵偏角指令,为准弹体系偏航通道弹道偏角控制舵偏角指令;
准弹体系俯仰和偏航通道舵偏角指令分别为:
;
其中,为准弹体系俯仰通道舵偏角指令,为准弹体系偏航通道舵偏角指令;
步骤6:弹体系俯仰和偏航通道舵偏角指令;
将准弹体系俯仰和偏航通道舵偏角指令转为弹体系舵偏角指令:
;
其中,为弹体系俯仰通道舵偏角指令,为弹体系偏航通道舵偏角指令;
步骤7:弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令;
将三个通道舵偏角指令转为4片舵的舵偏角指令:
;
其中,分别为4片舵的第1、2、3、4号舵翼对应舵偏角指令。
优选地,所述N=12秒。
本发明的有益效果如下:
本发明有效降低了发射初始段由于舵效低而长时间满舵所导致的程序角跟踪误差较大甚至弹体发散的风险。
附图说明
图1是本发明方法流程图。
图2是舵翼安装位置及偏转极性定义示意图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
垂直发射导弹在初始段一般要同时面临抗扰、滚转角控制和弹道转弯等问题,转弯段由于动压较小造成控制效率低,在舵资源紧俏而较长时间满舵时,易导致程序角跟踪误差较大甚至面临弹体发散的风险。
本发明提出一种弱资源情况下的转弯控制策略设计方法,在垂直发射导弹初始滚转角为任意值的情况下,为了更有效地利用紧俏的舵资源,前12s滚转通道仅进行阻尼控制,节省舵资源用于抗初始扰动和控制导弹速度转向目标,有效降低了由于初始段舵效低而长时间满舵所导致的程序角跟踪误差较大甚至弹体发散的风险。
本发明流程图如图1所示,具体步骤如下:
步骤1:计算滚转通道舵偏角指令:
如果飞行时间小于等于12s:
如果飞行时间大于12s:
步骤2:计算弹体实时弹道倾角和弹道偏角;
弹道倾角:
弹道偏角:
步骤3:计算发射系速度方向单位向量及速度方向指令单位向量;
发射系速度方向单位向量:
发射系速度方向指令单位向量:
步骤4:计算准弹体系速度方向单位向量及速度方向指令单位向量;
准弹体系速度方向单位向量:
准弹体系速度方向指令单位向量:
步骤5:计算准弹体系俯仰和偏航通道舵偏角指令;
将俯仰和偏航角速度转为准弹体系角速度:
准弹体系俯仰和偏航通道阻尼舵偏角指令分别为:
准弹体系俯仰和偏航通道增稳舵偏角指令分别为:
准弹体系俯仰通道弹道倾角控制舵偏角指令和偏航通道弹道偏角舵偏角指令分别为:
准弹体系俯仰和偏航通道舵偏角指令分别为:
步骤6:弹体系俯仰和偏航通道舵偏角指令;
将准弹体系俯仰和偏航通道舵偏角指令转为弹体系舵偏角指令:
步骤7:弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令;
将三个通道舵偏角指令转为4片舵的舵偏角指令:
其中,分别为4片舵的第1、2、3、4号舵翼所对应的舵偏角指令。由弹尾向弹头方向看,舵翼安装位置及偏转极性定义见图2,舵翼的后沿偏转为正舵偏角。
Claims (2)
1.一种弱资源情况下的转弯控制策略设计方法,其特征在于,包括如下步骤:
步骤1:计算滚转通道舵偏角指令:
;
如果飞行时间小于等于N:
;
如果飞行时间大于N:
;
其中,、、均为滚转通道控制增益,为惯导测量的弹体滚转角速度,为滚转角指令,为惯导测量的弹体滚转角,为滚转通道阻尼舵偏角指令,为滚转通道阻尼+PI控制舵偏角指令,为滚转通道舵偏角指令;
步骤2:计算弹体实时弹道倾角和弹道偏角;
弹道倾角:
;
弹道偏角:
;
其中,分别为惯导测量的导弹发射系速度在X、Y、Z轴的分量,为弹道倾角,为弹道偏角;
步骤3:计算发射系速度方向单位向量及速度方向指令单位向量;
发射系速度方向单位向量:
;
发射系速度方向指令单位向量:
;
其中,为装定的弹道倾角指令,为装定的弹道偏角指令,分别为速度方向单位向量在发射系X、Y、Z轴的分量,分别为速度方向指令单位向量在发射系X、Y、Z轴的分量;
步骤4:计算准弹体系速度方向单位向量及速度方向指令单位向量;
准弹体系速度方向单位向量:
;
准弹体系速度方向指令单位向量:
;
其中,为惯导测量的弹体发射系俯仰角,为惯导测量的发射系偏航角,分别为速度方向单位向量在准弹体系X、Y、Z轴的分量,分别为速度方向指令单位向量在准弹体系X、Y、Z轴的分量;
步骤5:计算准弹体系俯仰和偏航通道舵偏角指令;
将俯仰和偏航角速度转为准弹体系角速度:
;
其中,分别为惯导测量的弹体偏航和俯仰角速度,为惯导测量的弹体滚转角,为准弹体偏航角速度,为准弹体俯仰角速度;
准弹体系俯仰和偏航通道阻尼舵偏角指令分别为:
;
其中,为俯仰偏航通道阻尼控制增益,为准弹体系俯仰通道阻尼舵偏角指令,为准弹体系偏航通道阻尼舵偏角指令;
准弹体系俯仰和偏航通道增稳舵偏角指令分别为:
;
其中,为俯仰偏航通道增稳控制增益,为准弹体系俯仰通道增稳舵偏角指令,为准弹体系偏航通道增稳舵偏角指令;
准弹体系俯仰通道弹道倾角控制舵偏角指令和偏航通道弹道偏角舵偏角指令分别为:
;
其中,分别为弹道倾角和弹道偏角指令对应空间指向与准弹体系的夹角,分别为弹道倾角和弹道偏角对应空间指向与准弹体系的夹角,为准弹体系俯仰通道弹道倾角控制舵偏角指令,为准弹体系偏航通道弹道偏角控制舵偏角指令;
准弹体系俯仰和偏航通道舵偏角指令分别为:
;
其中,为准弹体系俯仰通道舵偏角指令,为准弹体系偏航通道舵偏角指令;
步骤6:弹体系俯仰和偏航通道舵偏角指令;
将准弹体系俯仰和偏航通道舵偏角指令转为弹体系舵偏角指令:
;
其中,为弹体系俯仰通道舵偏角指令,为弹体系偏航通道舵偏角指令;
步骤7:弹体系俯仰和偏航通道舵偏角指令分配为单片舵偏角指令;
将三个通道舵偏角指令转为4片舵的舵偏角指令:
;
其中,分别为4片舵的第1、2、3、4号舵翼对应舵偏角指令。
2.根据权利要求1所述的一种弱资源情况下的转弯控制策略设计方法,其特征在于,所述N=12秒。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202410428317.9A CN118009819B (zh) | 2024-04-10 | 2024-04-10 | 一种弱资源情况下的转弯控制策略设计方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202410428317.9A CN118009819B (zh) | 2024-04-10 | 2024-04-10 | 一种弱资源情况下的转弯控制策略设计方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN118009819A CN118009819A (zh) | 2024-05-10 |
| CN118009819B true CN118009819B (zh) | 2024-07-12 |
Family
ID=90951059
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202410428317.9A Active CN118009819B (zh) | 2024-04-10 | 2024-04-10 | 一种弱资源情况下的转弯控制策略设计方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN118009819B (zh) |
Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110764528A (zh) * | 2019-10-18 | 2020-02-07 | 北京航天长征飞行器研究所 | 一种舰载火箭弹垂直转弯控制方法 |
| CN114485265A (zh) * | 2021-12-08 | 2022-05-13 | 航天科工火箭技术有限公司 | 一种电磁发射火箭转弯段弹道设计方法 |
Family Cites Families (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JP2001174283A (ja) * | 1999-12-15 | 2001-06-29 | Daikin Ind Ltd | 回転飛翔体の姿勢測定装置 |
| FR2855258B1 (fr) * | 2003-05-19 | 2006-06-30 | Giat Ind Sa | Procede de controle de la trajectoire d'un projectile girant |
| GB2565264B (en) * | 2017-05-23 | 2022-03-09 | Atlantic Inertial Systems Ltd | Inertial navigation system |
| CN110008502B (zh) * | 2019-01-29 | 2022-07-15 | 西北工业大学 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
| CN115930698B (zh) * | 2023-01-10 | 2024-08-27 | 中国人民解放军国防科技大学 | 一种非零滚转角条件下控制通道舵偏角转化为x形舵偏角的方法 |
| CN116719333B (zh) * | 2023-05-25 | 2024-08-16 | 西安现代控制技术研究所 | 一种垂直发射导弹速度矢量控制转弯指令设计方法 |
-
2024
- 2024-04-10 CN CN202410428317.9A patent/CN118009819B/zh active Active
Patent Citations (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN110764528A (zh) * | 2019-10-18 | 2020-02-07 | 北京航天长征飞行器研究所 | 一种舰载火箭弹垂直转弯控制方法 |
| CN114485265A (zh) * | 2021-12-08 | 2022-05-13 | 航天科工火箭技术有限公司 | 一种电磁发射火箭转弯段弹道设计方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN118009819A (zh) | 2024-05-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111306998B (zh) | 一种参数摄动自适应的制导火箭弹垂直攻击制导方法 | |
| CN112416012B (zh) | 一种火箭动力面对称运载器主动段制导控制方法 | |
| CN111123967B (zh) | 一种基于自适应动态逆的固定翼无人机着舰控制方法 | |
| CN111473696B (zh) | 一种基于落点估计的制导火箭垂直攻击制导方法 | |
| CN105334735A (zh) | 一种基于角速率的飞翼布局无人机控制律 | |
| CN111336871B (zh) | 一种基于迂回式飞行的垂直攻击制导方法 | |
| CN110411289B (zh) | 一种抑制强机弹干扰的分离稳定控制方法 | |
| CN116107345B (zh) | 一种多飞行器的协同制导方法 | |
| CN109703769B (zh) | 一种基于预瞄策略的空中加油对接控制方法 | |
| CN112486023B (zh) | 一种巡飞弹航迹飞行控制系统仿真设计方法及该控制系统 | |
| CN114995495B (zh) | 速度不可控条件下时间和角度约束三维滑模制导律设计方法 | |
| CN117348402B (zh) | 一种基于干扰利用技术的高超声速飞行器三维制导方法 | |
| CN118009819B (zh) | 一种弱资源情况下的转弯控制策略设计方法 | |
| CN116225048B (zh) | 基于落角和时间约束的巡飞弹末端协同打击方法 | |
| CN109460055A (zh) | 一种飞行器控制能力确定方法、装置及电子设备 | |
| CN116719333B (zh) | 一种垂直发射导弹速度矢量控制转弯指令设计方法 | |
| CN113739635B (zh) | 一种实现导弹大扇面角发射的制导方法 | |
| CN111486755B (zh) | 一种可变气动外形制导装备的落速控制方法 | |
| CN116859914A (zh) | 一种基于角度约束的水下三维协同制导方法 | |
| CN116576736B (zh) | 一种飞行器速度限制条件下时间和角度约束三维制导方法 | |
| CN117891271A (zh) | 考虑时间和角度约束的高速飞行器三维协同制导方法 | |
| CN117170409A (zh) | 一种基于直接力控制的固定翼无人机空中回收精确对接控制方法 | |
| CN116774714A (zh) | 一种基于事件触发机制的多约束协同制导方法 | |
| CN119644850B (zh) | 一种控制输入受限的巡飞弹集群分布式时间协同制导方法 | |
| CN117234070B (zh) | 一种基于角度控制指令的btt分配方法 |
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 |