考虑视场角和舵机延时约束的导弹制导控制一体化方法技术

本发明专利技术提出一种考虑视场角和舵机延时约束的导弹制导控制一体化方法，主要用于携带捷联导引头的高超声速导弹末制导阶段拦截高速机动目标。首先，建立了纵向平面的严反馈形式的非线性制导控制一体化模型。随后，基于反步法、障碍Lyapunov函数、滑模控制方法设计了制导控制一体化控制器，其中模型中各个通道的复合干扰使用降阶扩张状态观测器进行估计和补偿。本发明专利技术针对高超声速导弹拦截高速机动目标的场景，使用绛阶扩张状态器对系统未知复合干扰的估计并在控制器中加以补偿，保证了控制器的鲁棒性。障碍Lyapunov函数保证了视场角的有界性，实现了视场角约束，提升了末制导阶段拦截机动目标的可靠性。截机动目标的可靠性。截机动目标的可靠性。

【技术实现步骤摘要】
考虑视场角和舵机延时约束的导弹制导控制一体化方法


[0001]本专利技术涉及携带捷联导引头的高超声速导弹末制导阶段一种制导控制系统设计方法，具体涉及一种考虑视场角约束和舵机延时动态特性的制导控制一体化设计方法。

技术介绍

[0002]高超声速导弹对高速机动性目标实施精确拦截对制导控制系统的设计带来了严重挑战。尤其是在追击过程中，由于目标的机动极易产生较大视场角。由于捷联导引头结构简单，可靠性高，成本低，以及不受限制的跟踪角速率的优点，被广泛应用。此外，由于捷联导引头视场角范围更小，在追击机动目标的过程中，导弹为了产生较大过载需要不断的调整姿态以实现精确打击，寻的阶段极易出现过大的视场角从而丢失目标导致脱靶。因此，此类携带捷联导引头的导弹在进行制导控制系统设计时，须考虑视场角约束。
[0003]考虑视场角约束的制导控制系统设计的研究多数集中于制导律的设计。但是，这些制导律的设计的共同点都是基于攻角足够小假设，这时导弹前置角即弹
‑
目连线与导弹速度的夹角可以等同于体视线角。然而，这相当于忽略了导弹的姿态动力学特性。当导弹在拦截过程中需要进行大攻角机动时，这些制导律实现FOV约束的假设便不在成立，拦截过程中可能违背FOV约束甚至脱靶。所以这样的假设太过于理想而无法在实际过程中实现。
[0004]制导控制一体化设计方法将制导环和控制环视为一个整体，根据弹体自身运动状态和弹目相对运动关系，直接解算控制指令。由于充分考虑制导系统和控制系统的耦合关系，制导控制一体化有助于提升整个系统的稳定性和精确打击能力。如果将视场角约束考虑在内，采用制导控制一体化设计方法，将大大提升高超声速导弹末制导阶段制导控制系统的拦截性能，减小脱靶量。
[0005]由于制导控制系统本身就是一个高阶非线性系统，同时还存在由目标机动、时变参数摄动以及外界干扰带来的非匹配不确定性扰动，如果再考虑视场角约束，对制导控制系统设计来说是个不小的挑战。此外，由于高超声速导弹末制导阶段快时变的特点，作为末制导阶段导弹唯一的执行机构，舵机的延时动态特性将严重影响弹体的响应速度，进而影响控制器的性能，不得不加以考虑。
[0006]综上所述，当前考虑视场角约束的制导律的设计或者制导控制一体化设计方法的研究对象都是携带捷联导引头的亚声速或者超声速导弹，对于高超声速导弹拦截高速机动目标的场景还未见公开文献。

技术实现思路

[0007]本专利技术针对携带捷联导引头的高超声速导弹拦截高速机动目标的场景，提供一种鲁棒性强的制导控制一体化设计方法，同时考虑了视场角约束和舵机的延时动态特性。
[0008]本专利技术提出的制导控制一体化设计方法基于反步法、障碍Lyapunov函数、滑模控制方法、动态面方法以及绛阶扩张状态观测器提出，主要用于携带捷联导引头的高超声速导弹末制导阶段拦截高速机动目标。首先，建立了纵向平面的严反馈形式的非线性制导控
制一体化模型。随后，基于反步法、障碍Lyapunov函数、滑模控制方法设计了制导控制一体化控制器，其中模型中各个通道的复合干扰使用降阶扩张状态观测器进行估计和补偿。
[0009]步骤一、建立纵向通道的弹
‑
目运动关系、几何关系方程、导弹的动力学方程、舵机的动力学方程。
[0010](a)导弹纵向通道的弹
‑
目相对运动关系方程如下：
[0011][0012]其中R是弹
‑
目相对距离，q
L
是弹
‑
目视线角，和分别是R和q
L
的一阶导数，V
M
和θ
M
是导弹的速度矢量和速度倾角，V
T
和θ
T
是目标的速度矢量和速度倾角。
[0013]对上式求导可得
[0014][0015]式中d
T
＝a
T
cos(θ
T
‑
q
L
)是由目标加速度引起不确定性，分别为垂直于导弹速度方向和沿着导弹速度方向的加速度。分别为垂直于目标速度方向的加速度。
[0016](b)导弹在纵向平面的几何关系和动力学方程如下：
[0017][0018]式中α为攻角，为俯仰角，T为导弹推力，Y为导弹升力，m为导弹质量，g为重力加速度，D为空气阻力，ω
z
为俯仰角速率，J
z
为z轴的转动惯量，δ
z
为舵偏角，M0为与攻角、俯仰角速率、舵偏角有关的俯仰力矩。
[0019](c)导弹在纵向平面的升力和俯仰力矩模型为：
[0020][0021][0022]式中，为动压，ρ为空气密度，S为特征面积，l为特征长度，为升
力系数对攻角、舵偏角的偏导数，c
x0
为零升阻力系数，为阻力系数对α2的偏导数。M
α
代表与攻角有关的俯仰力矩分量，代表与俯仰角速率有关的俯仰力矩分量，代表与舵偏角有关的俯仰力矩分量。分别为俯仰力矩系数对攻角、俯仰角速度、舵偏角的偏导数。
[0023]将式(4)带入式(3)，忽略小项和近似可得
[0024][0025]式中表示近似误差。
[0026]将式(6)带入到式(2)中有
[0027][0028]式中表示系统的复合干扰，包含了系统未建模误差，时变参数引起的摄动以及目标机动带来的干扰。
[0029](d)导引头几何关系方程
[0030][0031]式中q
B
为体视线角。
[0032]令d1＝
‑
ω
z
，对式(8)求导有
[0033][0034](e)舵机一阶动力学模型可以简化如下：
[0035][0036]式中，τ
z
为舵机的时间常数，δ
z
为舵偏角，δ
zc
控制器的输入指令。
[0037]步骤二、建立包含非匹配不确定的严反馈形式的非线性的导弹纵向通道的制导控制一体化模型。
[0038]为简化公式，令：
[0039][0040][0041]定义系统状态变量所建立的制导控制一体化模型如下：
[0042][0043]其中，u为控制器的输入设计；
[0044]式中
[0045][0046]其中d1、d2、d3、d4为系统各个通道的复合干扰，包含了系统未建模的动态、外部干扰、气动参数变化引起的摄动以及目标机动。
[0047]步骤三、根据步骤二建立的制导控制一体化模型，本步骤使用反步法将模型分为导引头子系统、制导子系统、攻角子系统、姿态子系统和舵机子系统并进行逆向递推设计，使用障碍Lyapunov函数和滑模控制方法设计制导控制一体化控制器。
[0048](a)针对导引头子系统，通过BLF函数，为保证BLOS不会超出最大视场角限制k
c1
，即|x1|＜k
c1
。定义第一本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：步骤一、建立纵向通道的弹
‑
目运动关系、几何关系方程、导弹的动力学方程、舵机的动力学方程；步骤二、建立包含非匹配不确定的严反馈形式的非线性的导弹纵向通道的制导控制一体化模型；步骤三、根据步骤二建立的制导控制一体化模型，使用反步法将模型分为导引头子系统、制导子系统、攻角子系统、姿态子系统和舵机子系统并进行逆向递推设计，使用障碍Lyapunov函数和滑模控制方法设计制导控制一体化控制器；步骤四、对虚拟控制命令中的未知的复合干扰，采用降阶扩张状态观测器对其进行估计；步骤五、根据步骤一至步骤四，得出制导控制一体化控制器。2.根据权利要求1所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤一中，具体包括如下步骤：1.1导弹纵向通道的弹
‑
目相对运动关系方程如下：其中，R是弹
‑
目相对距离，q
L
是弹
‑
目视线角，和分别是R和q
L
的一阶导数，V
M
和θ
M
是导弹的速度矢量和速度倾角，V
T
和θ
T
是目标的速度矢量和速度倾角；对上式求导得到式中d
T
＝a
T
cos(θ
T
‑
q
L
)是由目标加速度引起不确定性，分别为垂直于导弹速度方向和沿着导弹速度方向的加速度；分别为垂直于目标速度方向的加速度；1.2导弹在纵向平面的几何关系和动力学方程如下：式中α为攻角，θ为俯仰角，T为导弹推力，Y为导弹升力，m为导弹质量，g为重力加速度，D为空气阻力，ω
z
为俯仰角速率，J
z
为z轴的转动惯量，δ
z
为舵偏角，M0为与攻角、俯仰角速率、舵偏角有关的俯仰力矩；1.3导弹在纵向平面的升力和俯仰力矩模型为：
式中，为动压，ρ为空气密度，S为特征面积，l为特征长度，为升力系数对攻角、舵偏角的偏导数，c
x0
为零升阻力系数，为阻力系数对α2的偏导数；M
α
代表与攻角有关的俯仰力矩分量，代表与俯仰角速率有关的俯仰力矩分量，代表与舵偏角有关的俯仰力矩分量；分别为俯仰力矩系数对攻角、俯仰角速度、舵偏角的偏导数；将式(4)带入式(3)，忽略小项和近似得到式中表示近似误差；将式(6)带入到式(2)中有式中表示系统的复合干扰，包含了系统未建模误差，时变参数引起的摄动以及目标机动带来的干扰；1.4导引头几何关系方程q
B
＝q
L
‑
θ
ꢀꢀ
(8)式中q
B
为体视线角；令d1＝
‑
ω
z
，对式(8)求导有
1.5舵机一阶动力学模型简化如下：式中，τ
z
为舵机的时间常数，δ
z
为舵偏角，δ
zc
控制器的输入指令。3.根据权利要求2所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤二中，令：特征在于：在步骤二中，令：定义系统状态变量所建立的制导控制一体化模型如下：其中，u为控制器的输入设计；式中其中d1、d2、d3、d4为系统各个通道的复合干扰，包含了系统未建模的动态、外部干扰、气动参数变化引起的摄动以及目标机动。4.根据权利要求2或3所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤...

【专利技术属性】
技术研发人员：张小跃，李志兵，吴扬波，白光远，崔越，
申请(专利权)人：北京航空航天大学，
类型：发明
国别省市：