CN112050693A - 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 - Google Patents
考虑攻击角和视场约束的半捷联制导控制一体化设计方法 Download PDFInfo
- Publication number
- CN112050693A CN112050693A CN202010923942.2A CN202010923942A CN112050693A CN 112050693 A CN112050693 A CN 112050693A CN 202010923942 A CN202010923942 A CN 202010923942A CN 112050693 A CN112050693 A CN 112050693A
- Authority
- CN
- China
- Prior art keywords
- missile
- angle
- semi
- representing
- guidance control
- 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
Images
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
Landscapes
- Engineering & Computer Science (AREA)
- General Engineering & Computer Science (AREA)
- Chemical & Material Sciences (AREA)
- Aviation & Aerospace Engineering (AREA)
- Combustion & Propulsion (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种考虑攻击角和视场约束的半捷联制导控制一体化设计方法,所述方法包括如下步骤:步骤一、建立半捷联制导控制一体化设计模型;步骤二、根据半捷联制导控制一体化设计模型,设计考虑攻击角和视场约束的半捷联制导控制一体化算法,使视线角速度视线角ε与期望的末端视线角εd之差ε‑εd以及导引头失调角η尽快收敛到零附近,同时满足导引头视场约束:其中表示η的最大允许值;步骤三、仿真检验考虑攻击角和视场约束的半捷联制导控制一体化算法的性能。本发明的方法在设计中显示地考虑了导引头视场约束,因而能够从理论上保证导引头失调角始终保持在允许范围内,克服了现有半捷联制导控制一体化设计方法没有考虑导引头视场约束的不足。
Description
技术领域
本发明属于航空航天技术领域,涉及一种制导控制一体化设计方法,具体涉及一种考虑末端攻击角和导引头视场约束的半捷联制导控制一体化设计方法。
背景技术
相比于传统的制导与控制独立设计方法,制导控制一体化设计方法能够主动利用制导回路与控制回路之间的耦合关系来提升整体系统性能,因而在减小导弹需用过载、降低脱靶量、提高稳定性和可靠性等方面更具优势。但是,现有绝大多数制导控制一体化设计成果并没有考虑导引头本身的物理特性。随着制导武器的小型化和低成本化,将探测器与弹体全/半固联安装的全/半捷联制导已逐步成为一个发展趋势。因此,研究全/半捷联制导控制一体化设计方法具有重要的实际应用价值。目前,全捷联制导控制一体化设计已经有了较多的研究成果,而对于半捷联制导控制一体化设计的报道,仅见于文献1“Integratedguidance and control for semi-strapdown missiles,Proceedings of the 37thChinese Control Conference,2017,9826-9830”。但该文献没有考虑导引头视场受约束这一重要问题。由于导弹弹体和半捷联导引头之间存在强烈的动力学耦合,因此,弹体姿态的调整很容易导致导引头失调角超出允许范围,从而导致目标脱离导引头视场。同时,该文献也没有考虑导弹末端攻击角受约束的问题。实际上,使导弹以期望的末端攻击角命中目标对于提升弹头的攻击效能也是十分重要的。
发明内容
为了克服现有半捷联制导控制一体化设计方法的不足,本发明提供了一种考虑攻击角和视场约束的半捷联制导控制一体化设计方法,使导弹以期望的末端攻击角精确命中目标,同时使导引头失调角尽快收敛到零并且不超过允许的范围,从而确保导引头视场约束得以满足。
本发明的目的是通过以下技术方案实现的:
一种考虑攻击角和视场约束的半捷联制导控制一体化设计方法,包括如下步骤:
步骤一、建立半捷联制导控制一体化设计模型:
式中, ε表示视线倾角,表示视线角速率,r表示弹-目相对距离,g表示重力加速度,P表示导弹发动机推力,q表示动压头,S表示导弹特征面积,表示导弹攻角,θ表示导弹弹道倾角,表示导弹俯仰角,m表示导弹质量,表示导弹升力系数cy对α的偏导数,y表示由目标法向加速度引起的不确定性项,VT表示目标速度,θT表示目标弹道倾角,V表示导弹速度,表示导引头失调角,λ表示导引头框架角,ωλ表示导引头框架角速率,ωz表示导弹俯仰角速率,L表示导弹特征长度,Jz表示导弹绕弹体z轴转动惯量,δz表示导弹俯仰舵偏角,分别表示导弹俯仰力矩系数mz相对于α,δz的偏导数,dα和表示不确定性项,不确定性项dt,dα,满足:其由di>0,i=1,2,3为已知常数;
步骤二、根据半捷联制导控制一体化设计模型,设计考虑攻击角和视场约束的半捷联制导控制一体化算法,使视线角速度视线角ε与期望的末端视线角εd之差ε-εd以及导引头失调角η尽快收敛到零附近,同时满足导引头视场约束:其中表示η的最大允许值,具体步骤如下:
(1)借鉴滑模控制理论,设计第一层虚拟控制量αd;
(2)利用非线性映射将导引头失调角η受约束的控制问题转化为不受约束的控制问题,设计第二层虚拟控制量ωzd和导引头框架角速度指令ωλ;
(3)设计导弹俯仰舵偏角指令δz;
(4)综合(1)至(3),得到如下考虑攻击角和视场约束的半捷联制导控制一体化算法:
其中,设计参数满足:c>0,k1>0,ε1>0,γ1>d1,K2=diag(k21,k22),k21>0,k22>0,ε2>0,γ2>d2,k3>0,ε3>0,γ3>d3;
步骤三、仿真检验考虑攻击角和视场约束的半捷联制导控制一体化算法的性能,如果性能满足要求,则设计结束;否则,调整设计参数,重新进行仿真计算并进行性能检验。
相比于现有技术,本发明具有如下优点:
1、本发明的方法在设计中显示地考虑了导引头视场约束,因而能够从理论上保证导引头失调角始终保持在允许的范围内,克服了现有半捷联制导控制一体化设计方法没有考虑导引头视场约束的不足。
2、本发明的方法可以保证导弹以期望的末端攻击角命中目标,从而提高弹头的攻击效能,这也是现有半捷联制导控制一体化设计方法所不能保证的。
附图说明
图1为本发明考虑攻击角和视场约束的半捷联制导控制一体化设计流程图;
图2为纵向平面拦截几何关系和重要角度;
图3为弹-目相对距离变化曲线;
图4为视线角速率变化曲线;
图5为视线角变化曲线;
图6为导引头失调角变化曲线;
图7为导弹俯仰舵偏角指令曲线;
图8为导引头框架角速率指令曲线。
具体实施方式
下面结合附图对本发明的技术方案作进一步的说明,但并不局限于此,凡是对本发明技术方案进行修改或者等同替换,而不脱离本发明技术方案的精神和范围,均应涵盖在本发明的保护范围中。
本发明提供了一种考虑攻击角和视场约束的半捷联制导控制一体化设计方法,如图1所示,具体设计步骤如下:
第一步:建立半捷联制导控制一体化设计模型。
纵向平面内的拦截几何关系和重要角度如图2所示,其中,M表示导弹,T表示目标,LOS表示视线,ε表示视线倾角,r表示弹-目相对距离,V表示导弹速度,xb表示导弹弹体纵轴,xd表示导引头光轴,表示导弹俯仰角,θ表示导弹弹道倾角,表示导弹攻角,λ表示导引头框架角,表示导引头失调角,VT表示目标速度,θT表示目标弹道倾角。忽略导弹和目标速度大小的变化,则视线角满足如下动态方程:
其中,表示由目标法向加速度引起的不确定性项(当弹-目相对距离小于某阈值时,导引头进入盲区,导弹不再更新制导控制指令。因此,在导弹的受控飞行阶段,弹-目相对距离始终大于该阈值,因而(1)式不会出现奇异问题且目标法向加速度引起的不确定性是有界的)。导弹弹道倾角满足如下动态方程:
式中,m为导弹质量,P为导弹发动机推力,g为重力加速度,Y为导弹所受升力,其中,q为动压头(q=0.5ρV2,ρ为导弹所处高度的空气密度),S为导弹特征面积,δz为导弹俯仰舵偏角,分别为升力系数cy对α,δz的偏导数。由于导弹所受升力主要由弹体本身产生,即同时,当攻角不大时,有sinα≈α,故可认为:
另外,在末制导过程中视线方向与速度方向一般偏离不大,故cos(ε-θ)≈1。于是,可得:
取攻角α与俯仰角速率ωz作为状态变量,可建立导弹控制系统模型如下:
导弹导引头失调角满足如下动态方程:
考虑攻击角和视场约束的半捷联制导控制一体化算法的设计任务可以描述为:根据半捷联制导控制一体化设计模型(8),设计导弹俯仰舵偏角指令和导引头框架角速度指令,使视线角速度视线角ε与期望的末端视线角εd之差ε-εd以及导引头失调角η尽快收敛到零附近,同时满足导引头视场约束:其中表示η的最大允许值。
第二步:借鉴滑模控制理论,设计第一层虚拟控制量αd。
定义
构造第一层虚拟控制量αd为:
其中,k1>0,ε1>0,γ1>d1为设计参数,并定义z2=α-αd,则有:
第三步:利用非线性映射将导引头失调角η受约束的控制问题转化为不受约束的控制问题,设计第二层虚拟控制量ωzd和导引头框架角速度指令ωλ。
定义非线性映射
其中,
其中,
构造第二层虚拟控制量ωzd和导引头框架角速度指令ωλ为:
其中,K2=diag(k21,k22),k21>0,k22>0,ε2>0,γ2>d2为设计参数,并定义z3=ωz-ωzd,则有:
第四步:设计导弹俯仰舵偏角指令δz。
考虑
构造舵偏角指令为:
其中,k3>0,ε3>0,γ3>d3为设计参数,则有:
由上式可知,只要设计参数k1,k21,k22,k3选取得足够大,则z1,z3有界,且随着参数k1,k21,k22,k3的增加,z1,z3可以收敛到任意接近于零,因而可以实现考虑攻击角和视场约束的半捷联制导控制一体化算法的设计任务。
第五步:综合前述第二至第四步,便得到考虑攻击角和视场约束的半捷联制导控制一体化算法。最终的制导控制一体化算法如下所示:
其中,设计参数满足:c>0,k1>0,ε1>0,γ1>d1,K2=diag(k21,k22),k21>0,k22>0,ε2>0,γ2>d2,k3>0,ε3>0,γ3>d3。设计参数的具体取值需要结合应用场景开展非线性数值仿真进行。
第六步:仿真检验制导控制一体化算法的性能。
为了检验所设计的考虑攻击角和视场约束的半捷联制导控制一体化算法的性能,可将其应用于导弹在纵向平面内的非线性制导与控制系统,借助常用的计算机数值计算和仿真软件来进行。在允许的范围内选择好设计参数后,进行仿真计算并进行性能检验。如果制导控制一体化算法的性能满足要求,则设计结束;否则,需要调整设计参数,重新进行仿真计算并进行性能检验。
实施例:
将本发明设计的考虑末端攻击角和导引头视场约束的制导控制一体化算法应用于如下所示的导弹在纵向平面内的半捷联制导与控制系统:
在仿真中,设导弹的结构和气动参数分别为:S=0.42m2,L=0.68m,m=1200Kg,Jz=5600Kg·m2,P=5000N, 设目标为地面运动目标,速度大小为Vt=20m/s,目标弹道倾角为θt=0°;设导弹的速度初始值为V=250m/s,俯仰角初始值为俯仰角速度初始值为ωz=-3°/s,弹道倾角初始值为θ0=-36°,弹-目相对距离初始值为R0=5000m,视线倾角初始值为ε0=-45°,导引头失调角初始值为η0=15°,视场约束设为期望的末端视线角为εd=-60°。设计参数选取如下:c=0.4,k1=1,k21=2,k22=5,k3=3,εi=0.05,γi=0.3,i=1,2,3。设弹-目相对距离小于50m时,导弹导引头进入盲区,此后导弹舵偏角保持不变,进入无控飞行状态,直至仿真结束。弹-目相对距离小于1m时,停止仿真。
弹-目相对距离变化曲线如图3所示,脱靶量小于1m,导弹能够精确命中目标。视线角速率变化曲线如图4所示,视线角速率收敛并保持在零附近。视线角变化曲线如图5所示,末端视线角为-60°,表明导弹能以期望的末端攻击角命中目标。导引头失调角曲线如图6所示,失调角快速收敛并保持在零附近,并且满足|η|≤20°的导引头视场约束。导弹俯仰舵偏角指令曲线如图7所示。导引头框架角速率指令曲线如图8所示。仿真结果表明了设计的正确性和有效性。
Claims (2)
1.一种考虑攻击角和视场约束的半捷联制导控制一体化设计方法,其特征在于所述方法包括如下步骤:
步骤一、建立半捷联制导控制一体化设计模型:
式中, ε表示视线倾角,表示视线角速率,r表示弹-目相对距离,g表示重力加速度,P表示导弹发动机推力,q表示动压头,S表示导弹特征面积,表示导弹攻角,θ表示导弹弹道倾角,表示导弹俯仰角,m表示导弹质量,表示导弹升力系数cy对α的偏导数,表示由目标法向加速度引起的不确定性项,VT表示目标速度,θT表示目标弹道倾角,V表示导弹速度,表示导引头失调角,λ表示导引头框架角,ωλ表示导引头框架角速率,L表示导弹特征长度,Jz表示导弹绕弹体z轴转动惯量,δz表示导弹俯仰角速率,分别表示导弹俯仰力矩系数mz相对于α,δz的偏导数,dα和表示不确定性项,不确定性项dt,dα,满足:其中di>0,i=1,2,3为已知常数;
步骤二、根据半捷联制导控制一体化设计模型,设计考虑攻击角和视场约束的半捷联制导控制一体化算法,使视线角速度视线角ε与期望的末端视线角εd之差ε-εd以及导引头失调角η尽快收敛到零附近,同时满足导引头视场约束:其中表示η的最大允许值;
步骤三、仿真检验考虑攻击角和视场约束的半捷联制导控制一体化算法的性能,如果性能满足要求,则设计结束;否则,调整设计参数,重新进行仿真计算并进行性能检验。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010923942.2A CN112050693B (zh) | 2020-09-04 | 2020-09-04 | 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010923942.2A CN112050693B (zh) | 2020-09-04 | 2020-09-04 | 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112050693A true CN112050693A (zh) | 2020-12-08 |
CN112050693B CN112050693B (zh) | 2021-04-23 |
Family
ID=73607401
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010923942.2A Active CN112050693B (zh) | 2020-09-04 | 2020-09-04 | 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112050693B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113758380A (zh) * | 2021-08-03 | 2021-12-07 | 北京航空航天大学 | 考虑舵机动态性能和攻击角约束的制导控制一体化方法 |
CN114138000A (zh) * | 2021-08-16 | 2022-03-04 | 西北工业大学 | 考虑全捷联导引头视场约束的弹群协同制导控制一体化设计方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106681348A (zh) * | 2017-01-13 | 2017-05-17 | 西北工业大学 | 考虑全捷联导引头视场约束的制导控制一体化设计方法 |
EP3407023A1 (en) * | 2017-05-23 | 2018-11-28 | Atlantic Inertial Systems Limited | Inertial navigation system |
US10323907B1 (en) * | 2016-08-26 | 2019-06-18 | Cummings Aerospace, Inc. | Proportional velocity-deficit guidance for ballistic targeting accuracy |
CN110008502A (zh) * | 2019-01-29 | 2019-07-12 | 西北工业大学 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
-
2020
- 2020-09-04 CN CN202010923942.2A patent/CN112050693B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US10323907B1 (en) * | 2016-08-26 | 2019-06-18 | Cummings Aerospace, Inc. | Proportional velocity-deficit guidance for ballistic targeting accuracy |
CN106681348A (zh) * | 2017-01-13 | 2017-05-17 | 西北工业大学 | 考虑全捷联导引头视场约束的制导控制一体化设计方法 |
EP3407023A1 (en) * | 2017-05-23 | 2018-11-28 | Atlantic Inertial Systems Limited | Inertial navigation system |
CN110008502A (zh) * | 2019-01-29 | 2019-07-12 | 西北工业大学 | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113758380A (zh) * | 2021-08-03 | 2021-12-07 | 北京航空航天大学 | 考虑舵机动态性能和攻击角约束的制导控制一体化方法 |
CN113758380B (zh) * | 2021-08-03 | 2022-06-03 | 北京航空航天大学 | 考虑舵机动态性能和攻击角约束的制导控制一体化方法 |
CN114138000A (zh) * | 2021-08-16 | 2022-03-04 | 西北工业大学 | 考虑全捷联导引头视场约束的弹群协同制导控制一体化设计方法 |
Also Published As
Publication number | Publication date |
---|---|
CN112050693B (zh) | 2021-04-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110008502B (zh) | 考虑全捷联导引头视场约束的三维制导控制一体化设计方法 | |
CN112558631B (zh) | 基于测量信息的带大落角约束变参数制导方法 | |
CN112013726B (zh) | 一种基于三阶模型的全捷联制导控制一体化设计方法 | |
CN112762776B (zh) | 一种火箭弹末端速度估计方法 | |
CN111336871B (zh) | 一种基于迂回式飞行的垂直攻击制导方法 | |
CN114020019B (zh) | 飞行器的制导方法与装置 | |
CN110032206B (zh) | 远程制导飞行器大落角攻顶控制方法及控制系统 | |
CN112526872B (zh) | 带大落角约束中制导和末制导交接与制导信息的处理方法 | |
CN114509946B (zh) | 一种基于预设时间滑模的飞行器制导控制一体化设计方法 | |
CN115406312B (zh) | 考虑视场角和舵机延时约束的导弹制导控制一体化方法 | |
CN112050693B (zh) | 考虑攻击角和视场约束的半捷联制导控制一体化设计方法 | |
CN111176315B (zh) | 一种基于l1自适应控制的变体巡飞弹控制方法 | |
CN114153143B (zh) | 一种导弹非奇异固定时间滑模制导律的设计方法 | |
CN114637304A (zh) | 一种察打武器系统及随动跟踪控制方法 | |
Özkan et al. | Performance comparison of the notable acceleration-and angle-based guidance laws for a short-range air-to-surface missile | |
CN116301028B (zh) | 基于吸气式高超声速平台的多约束在线飞行轨迹规划中段导引方法 | |
Kim et al. | Guidance and control system design for impact angle control of guided bombs | |
CN105987652A (zh) | 姿态角速率估算系统及应用其的弹药 | |
Milinovic et al. | Experimental and simulation testing of flight spin stability for small caliber cannon projectile | |
Elsaadany et al. | Accurate trajectory prediction for typical artillery projectile | |
Özkan et al. | Comparison of the notable acceleration-and angle-based guidance laws for a short-range air-to-surface missile | |
Özkan et al. | Implementation of linear homing guidance law on a two-part homing missile | |
CN116753788B (zh) | 一种基于线性自抗扰的敏捷转弯复合控制方法 | |
Li et al. | Control System Design for Guided Rocket Base on Adaptive Sliding Mode Control | |
CN113064443B (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 |