CN115406312A - 考虑视场角和舵机延时约束的导弹制导控制一体化方法 - Google Patents

Abstract

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

Description

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

技术领域

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

背景技术

高超声速导弹对高速机动性目标实施精确拦截对制导控制系统的设计带来了严重挑战。尤其是在追击过程中，由于目标的机动极易产生较大视场角。由于捷联导引头结构简单，可靠性高，成本低，以及不受限制的跟踪角速率的优点，被广泛应用。此外，由于捷联导引头视场角范围更小，在追击机动目标的过程中，导弹为了产生较大过载需要不断的调整姿态以实现精确打击，寻的阶段极易出现过大的视场角从而丢失目标导致脱靶。因此，此类携带捷联导引头的导弹在进行制导控制系统设计时，须考虑视场角约束。

考虑视场角约束的制导控制系统设计的研究多数集中于制导律的设计。但是，这些制导律的设计的共同点都是基于攻角足够小假设，这时导弹前置角即弹-目连线与导弹速度的夹角可以等同于体视线角。然而，这相当于忽略了导弹的姿态动力学特性。当导弹在拦截过程中需要进行大攻角机动时，这些制导律实现FOV约束的假设便不在成立，拦截过程中可能违背FOV约束甚至脱靶。所以这样的假设太过于理想而无法在实际过程中实现。

制导控制一体化设计方法将制导环和控制环视为一个整体，根据弹体自身运动状态和弹目相对运动关系，直接解算控制指令。由于充分考虑制导系统和控制系统的耦合关系，制导控制一体化有助于提升整个系统的稳定性和精确打击能力。如果将视场角约束考虑在内，采用制导控制一体化设计方法，将大大提升高超声速导弹末制导阶段制导控制系统的拦截性能，减小脱靶量。

由于制导控制系统本身就是一个高阶非线性系统，同时还存在由目标机动、时变参数摄动以及外界干扰带来的非匹配不确定性扰动，如果再考虑视场角约束，对制导控制系统设计来说是个不小的挑战。此外，由于高超声速导弹末制导阶段快时变的特点，作为末制导阶段导弹唯一的执行机构，舵机的延时动态特性将严重影响弹体的响应速度，进而影响控制器的性能，不得不加以考虑。

综上所述，当前考虑视场角约束的制导律的设计或者制导控制一体化设计方法的研究对象都是携带捷联导引头的亚声速或者超声速导弹，对于高超声速导弹拦截高速机动目标的场景还未见公开文献。

发明内容

本发明针对携带捷联导引头的高超声速导弹拦截高速机动目标的场景，提供一种鲁棒性强的制导控制一体化设计方法，同时考虑了视场角约束和舵机的延时动态特性。

本发明提出的制导控制一体化设计方法基于反步法、障碍Lyapunov函数、滑模控制方法、动态面方法以及绛阶扩张状态观测器提出，主要用于携带捷联导引头的高超声速导弹末制导阶段拦截高速机动目标。首先，建立了纵向平面的严反馈形式的非线性制导控制一体化模型。随后，基于反步法、障碍Lyapunov函数、滑模控制方法设计了制导控制一体化控制器，其中模型中各个通道的复合干扰使用降阶扩张状态观测器进行估计和补偿。

步骤一、建立纵向通道的弹-目运动关系、几何关系方程、导弹的动力学方程、舵机的动力学方程。

(a)导弹纵向通道的弹-目相对运动关系方程如下：

其中R是弹-目相对距离，q_L是弹-目视线角，

和

分别是R和q_L的一阶导数，V_M和θ_M是导弹的速度矢量和速度倾角，V_T和θ_T是目标的速度矢量和速度倾角。

对上式求导可得

式中d_T＝a_Tcos(θ_T-q_L)是由目标加速度引起不确定性，

分别为垂直于导弹速度方向和沿着导弹速度方向的加速度。

分别为垂直于目标速度方向的加速度。

(b)导弹在纵向平面的几何关系和动力学方程如下：

式中α为攻角，

为俯仰角，T为导弹推力，Y为导弹升力，m为导弹质量，g为重力加速度，D为空气阻力，ω_z为俯仰角速率，J_z为z轴的转动惯量，δ_z为舵偏角，M₀为与攻角、俯仰角速率、舵偏角有关的俯仰力矩。

(c)导弹在纵向平面的升力和俯仰力矩模型为：

式中，

为动压，ρ为空气密度，S为特征面积，l为特征长度，

为升力系数对攻角、舵偏角的偏导数，c_x0为零升阻力系数，

为阻力系数对α²的偏导数。M_α代表与攻角有关的俯仰力矩分量，

代表与俯仰角速率有关的俯仰力矩分量，

代表与舵偏角有关的俯仰力矩分量。

分别为俯仰力矩系数对攻角、俯仰角速度、舵偏角的偏导数。

将式(4)带入式(3)，忽略小项和近似可得

式中

表示近似误差。

将式(6)带入到式(2)中有

式中

表示系统的复合干扰，包含了系统未建模误差，时变参数引起的摄动以及目标机动带来的干扰。

(d)导引头几何关系方程

式中q_B为体视线角。

令d₁＝-ω_z，对式(8)求导有

(e)舵机一阶动力学模型可以简化如下：

式中，τ_z为舵机的时间常数，δ_z为舵偏角，δ_zc控制器的输入指令。

步骤二、建立包含非匹配不确定的严反馈形式的非线性的导弹纵向通道的制导控制一体化模型。

为简化公式，令：

定义系统状态变量

所建立的制导控制一体化模型如下：

其中，u为控制器的输入设计；

式中

其中d₁、d₂、d₃、d₄为系统各个通道的复合干扰，包含了系统未建模的动态、外部干扰、气动参数变化引起的摄动以及目标机动。

步骤三、根据步骤二建立的制导控制一体化模型，本步骤使用反步法将模型分为导引头子系统、制导子系统、攻角子系统、姿态子系统和舵机子系统并进行逆向递推设计，使用障碍Lyapunov函数和滑模控制方法设计制导控制一体化控制器。

(a)针对导引头子系统，通过BLF函数，为保证BLOS不会超出最大视场角限制k_c1，即|x₁|＜k_c1。定义第一个滑模面

s₁＝x₁-x_1d (12)

式中，x_1d为系统状态x₁的期望值，为保证对目标的精准拦截，期望的视场角x_1d＝0。

由式(12)可知，|s₁|＜k_c1-0＝k_b1，k_b1为滑模面s₁的最大值。

定义障碍Lyapunov函数为

式中a₀＞0。

对式(13)求导，有

设计虚拟控制命令x_2c为：

式中需要设计的参数k₁＞0。

为了避免使用反演法引入的虚拟控制命令而带来的“微分爆炸”现象，引入动态面方法，使得x_2c通过一阶滤波器得到x_2d和

式中τ₂＞0为滤波器的时间常数。

(b)对于制导子系统，即式(11)的第二个方程，为保证虚拟控制命令x₂对虚拟指令x_2d的跟踪，定义第二个滑模面为

s₂＝x₂-x_2d (17)

对上式(17)求导并将式(11)的第二个方程带入得

将系统状态x₃视为虚拟控制输入，设计虚拟控制命令x_3c如下：

式中需要设计的参数k₂＞0。

同理，将x_3c通过一阶滤波器得到x_3d和

式中τ₃＞0为滤波器的时间常数。

(c)针对攻角子系统，为保证系统状态x₃对虚拟指令x_3d的跟踪，定义第三个滑模面为：

s₃＝x₃-x_3d (21)

对上式求导将式(11)的第三个方程带入有

将系统状态x₄作为虚拟控制输入，设计虚拟控制命令x_4c如下：

式中需要设计的参数k₃＞0。

将虚拟控制命令x_4c通过一阶滤波器得到x_4d和

式中τ₄＞0为滤波器的时间常数。

(d)针对姿态子系统，为保证系统状态x₄对虚拟指令x_4d的跟踪，定义第四个滑模面为

s₄＝x₄-x_4d (25)

对上式求导并将式(11)的第四个方程带入有

将系统状态x₅作为虚拟控制输入，设计虚拟控制命令x_5c如下：

式中需要设计的参数k₄＞0。

将虚拟控制命令x_5c通过一阶滤波器得到x_5d和

式中τ₅＞0为滤波器的时间常数。

(e)针对舵机子系统，为保证系统状态x₅对虚拟指令x_5d的跟踪，定义第五个滑模面为：

s₅＝x₅-x_5d (29)

对上式求导并将式(11)的第五个方程带入有

控制器的输入设计为

式中需要设计的参数k₅＞0。

步骤四、为了提升控制器的鲁棒性，针对上一步骤所设计的虚拟控制命令中的未知的复合干扰，采用降阶扩张状态观测器对其进行估计。

式中，p_i,i＝1,2,3,4是辅助变量，

是通道间复合干扰d_i,i＝1,2,3,4的估计值，β_i＞0,i＝1,2,3,4为观测器增益。

步骤五、综上所述，根据步骤三、四，所设计的考虑视场角约束的制导控制一体化控制器为

本发明的有益效果及优点如下：

1.本发明首先建立了纵向平面的考虑视场角和舵角的导弹制导控制系统的制导控制一体化模型，并考虑了阻力因素的影响。

2.本发明针对高超声速导弹拦截高速机动目标的场景，基于障碍Lyapunov函数和滑模控制算法提出了一种制导控制一体化控制器。使用绛阶扩张状态器对系统未知复合干扰的估计并在控制器中加以补偿，保证了控制器的鲁棒性。

3.障碍Lyapunov函数保证了视场角的有界性，实现了视场角约束，提升了末制导阶段拦截机动目标的可靠性。

附图说明

图1是本发明的导弹纵向平面的弹-目相对运动关系示意图。

图2是本发明的制导控制一体化设计方法的流程图。

图3是本发明基于实例下的导弹拦截机动目标的轨迹图。

图4是本发明基于实例下的导弹体视线角曲线。

图5是本发明基于实例下的导弹攻角曲线。

图6是本发明基于实例下的导弹速度曲线。

图7是本发明基于实例下的导弹俯仰角速度曲线。

图8是本发明基于实例下的导弹舵偏角曲线。

图9是本发明基于实例下的控制器命令输出曲线。

具体实施方式

参照图例就本发明的具体实施方式做进一步阐述。

如图1是本发明的导弹纵向平面的弹-目相对运动关系示意图，图2是本发明的制导控制一体化设计方法的流程图。给定的仿真初始条件为：导弹的初始坐标(0,0)，目标的初始位置

初始弹-目视线角q_L＝30°，导弹的初始速度V_M0＝2000m/s，目标的初始速度V_T0＝800m/s，导弹与目标初始速度倾角θ_M0＝35°，θ_T0＝0°，初始体视线角q_B0＝5°，最大视场角

初始俯仰角速度ω_z0＝0°/s，初始俯仰角

，初始舵偏角δ_z0＝0°，最大舵角

步骤一、首先建立纵向通道的弹-目运动关系、导弹的动力学方程、舵机的动力学方程。

(a)导弹纵向通道的弹-目相对运动关系方程如下：

其中R是弹-目相对距离，q_L是弹-目视线角，

和

分别是R和q_L的一阶导数，V_M和θ_M是导弹的速度矢量和速度倾角，V_T和θ_T是目标的速度矢量和速度倾角。

对上式求导可得

式中d_T＝a_Tcos(θ_T-q_L)是由目标加速度引起不确定性，

分别为垂直于导弹速度方向和沿着导弹速度方向的加速度。

分别为垂直于目标速度方向的加速度。

(b)导弹在纵向平面的几何关系和动力学方程如下：

式中α为攻角，

为俯仰角，T＝0为导弹推力，Y为导弹升力，m＝1200kg为导弹质量，g＝9.8m/s²为重力加速度，D为空气阻力，ω_z为俯仰角速率，J_z＝5600kgm²为z轴的转动惯量，δ_z为舵偏角，M₀为与攻角、俯仰角速率、舵偏角有关的俯仰力矩。

(c)导弹在纵向平面的升力和俯仰力矩模型为：

式中，

为动压，ρ＝1.2196kg/m³为空气密度，S＝0.42m²为特征面积，l＝0.68m为特征长度，

为升力系数对攻角、舵偏角的偏导数，c_x0＝0.10为零升阻力系数，

为阻力系数对α²的偏导数。M_α代表与攻角有关的俯仰力矩分量，

代表与俯仰角速率有关的俯仰力矩分量，

代表与舵偏角有关的俯仰力矩分量。

分别为俯仰力矩系数对攻角、俯仰角速度、舵偏角的偏导数。

将式(4)带入式(3)，忽略小项和近似可得

式中

表示近似误差。

将式(6)带入到式(2)中有

式中

表示系统的复合干扰，包含了系统未建模误差，时变参数引起的摄动以及目标机动带来的干扰。

(d)导引头几何关系方程

式中q_B为体视线角。

令d₁＝-ω_z，对式(8)求导有

(e)舵机一阶动力学模型可以简化如下：

式中，τ_z＝0.1为舵机的时间常数，δ_z为舵偏角，δ_zc控制器的输入指令。

步骤二、建立包含非匹配不确定的严反馈形式的非线性的导弹纵向通道的制导控制一体化模型。

为简化公式，令：

定义系统状态变量

所建立的制导控制一体化模型如下：

其中，u为控制器的输入设计；

式中

其中d₁、d₂、d₃、d₄为系统各个通道的复合干扰，包含了系统未建模的动态、外部干扰、气动参数变化引起的摄动以及目标机动。

步骤三、根据步骤二建立的制导控制一体化模型，本步骤使用反步法将模型分为导引头子系统、制导子系统、攻角子系统、姿态子系统和舵机子系统并进行逆向递推设计，使用障碍Lyapunov函数和滑模控制方法设计制导控制一体化控制器。

(a)针对导引头子系统，通过BLF函数，为保证BLOS不会超出最大视场角限制k_c1＝20°，即|x₁|＜k_c1。定义第一个滑模面

s₁＝x₁-x_1d (12)

式中，x_1d为系统状态x₁的期望值，为保证对目标的精准拦截，期望的视场角x_1d＝0。

由式(12)可知，|s₁|＜k_c1-0＝k_b1，k_b1为滑模面s₁的最大值。

定义障碍Lyapunov函数为

式中a₀＝1。

对式(13)求导，有

设计虚拟控制命令x_2c为：

式中需要设计的参数k₁＝14。

为了避免使用反演法引入的虚拟控制命令而带来的“微分爆炸”现象，引入动态面方法，使得x_2c通过一阶滤波器得到x_2d和

式中τ₂＝0.01为滤波器的时间常数。

(b)对于制导子系统，即式(11)的第二个方程，为保证虚拟控制命令x₂对虚拟指令x_2d的跟踪，定义第二个滑模面为

s₂＝x₂-x_2d (17)

对上式(17)求导并将式(11)的第二个方程带入得

将系统状态x₃视为虚拟控制输入，设计虚拟控制命令x_3c如下：

式中需要设计的参数k₂＝15。

同理，将x_3c通过一阶滤波器得到x_3d和

式中τ₃＝0.01为滤波器的时间常数。

(c)针对攻角子系统，为保证系统状态x₃对虚拟指令x_3d的跟踪，定义第三个滑模面为：

s₃＝x₃-x_3d (21)

对上式求导将式(11)的第三个方程带入有

将系统状态x₄作为虚拟控制输入，设计虚拟控制命令x_4c如下：

式中需要设计的参数k₃＝25。

将虚拟控制命令x_4c通过一阶滤波器得到x_4d和

式中τ₄＝0.01为滤波器的时间常数。

(d)针对姿态子系统，为保证系统状态x₄对虚拟指令x_4d的跟踪，定义第四个滑模面为

s₄＝x₄-x_4d (25)

对上式求导并将式(11)的第四个方程带入有

将系统状态x₅作为虚拟控制输入，设计虚拟控制命令x_5c如下：

式中需要设计的参数k₄＝25。

将虚拟控制命令x_5c通过一阶滤波器得到x_5d和

式中τ₅＝0.01为滤波器的时间常数。

(e)针对舵机子系统，为保证系统状态x₅对虚拟指令x_5d的跟踪，定义第五个滑模面为：

s₅＝x₅-x_5d (29)

对上式求导并将式(11)的第五个方程带入有

控制器的输入设计为

式中需要设计的参数k₅＝25。

步骤四、为了提升控制器的鲁棒性，针对上一步骤所设计的虚拟控制命令中的未知的复合干扰，采用降阶扩张状态观测器对其进行估计。

式中，p_i,i＝1,2,3,4是辅助变量，

是通道间复合干扰d_i,i＝1,2,3,4的估计值，β₁＝20,β₂＝30,β₃＝30,β₄＝1为观测器增益。

步骤五、综上所述，根据步骤三、四，所设计的考虑视场角约束的制导控制一体化控制器为

步骤六、仿真实例验证

图3给出了弹道拦截机动目标的轨迹曲线，脱靶量为0.88m。

图4给出了导弹的体视线角曲线，说明整个拦截过程中体视线角均在最大视场角范围内。

图5-图8给出了系统状态变化曲线，图9给出了控制器命令输出曲线。

Claims (6)

1.一种考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：

步骤一、建立纵向通道的弹-目运动关系、几何关系方程、导弹的动力学方程、舵机的动力学方程；

步骤二、建立包含非匹配不确定的严反馈形式的非线性的导弹纵向通道的制导控制一体化模型；

步骤三、根据步骤二建立的制导控制一体化模型，使用反步法将模型分为导引头子系统、制导子系统、攻角子系统、姿态子系统和舵机子系统并进行逆向递推设计，使用障碍Lyapunov函数和滑模控制方法设计制导控制一体化控制器；

步骤四、对虚拟控制命令中的未知的复合干扰，采用降阶扩张状态观测器对其进行估计；

步骤五、根据步骤一至步骤四，得出制导控制一体化控制器。

2.根据权利要求1所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤一中，具体包括如下步骤：

1.1导弹纵向通道的弹-目相对运动关系方程如下：

其中，R是弹-目相对距离，q_L是弹-目视线角，

和

分别是R和q_L的一阶导数，V_M和θ_M是导弹的速度矢量和速度倾角，V_T和θ_T是目标的速度矢量和速度倾角；

对上式求导得到

式中d_T＝a_Tcos(θ_T-q_L)是由目标加速度引起不确定性，

分别为垂直于导弹速度方向和沿着导弹速度方向的加速度；

分别为垂直于目标速度方向的加速度；

1.2导弹在纵向平面的几何关系和动力学方程如下：

式中α为攻角，θ为俯仰角，T为导弹推力，Y为导弹升力，m为导弹质量，g为重力加速度，D为空气阻力，ω_z为俯仰角速率，J_z为z轴的转动惯量，δ_z为舵偏角，M₀为与攻角、俯仰角速率、舵偏角有关的俯仰力矩；

1.3导弹在纵向平面的升力和俯仰力矩模型为：

式中，

为动压，ρ为空气密度，S为特征面积，l为特征长度，

为升力系数对攻角、舵偏角的偏导数，c_x0为零升阻力系数，

为阻力系数对α²的偏导数；M_α代表与攻角有关的俯仰力矩分量，

代表与俯仰角速率有关的俯仰力矩分量，

代表与舵偏角有关的俯仰力矩分量；

分别为俯仰力矩系数对攻角、俯仰角速度、舵偏角的偏导数；

将式(4)带入式(3)，忽略小项和近似得到

式中

表示近似误差；

将式(6)带入到式(2)中有

式中

表示系统的复合干扰，包含了系统未建模误差，时变参数引起的摄动以及目标机动带来的干扰；

1.4导引头几何关系方程

q_B＝q_L-θ (8)

式中q_B为体视线角；

令d₁＝-ω_z，对式(8)求导有

1.5舵机一阶动力学模型简化如下：

式中，τ_z为舵机的时间常数，δ_z为舵偏角，δ_zc控制器的输入指令。

3.根据权利要求2所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤二中，令：

定义系统状态变量

所建立的制导控制一体化模型如下：

其中，u为控制器的输入设计；

式中

其中d₁、d₂、d₃、d₄为系统各个通道的复合干扰，包含了系统未建模的动态、外部干扰、气动参数变化引起的摄动以及目标机动。

4.根据权利要求2或3所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤三中，具体包括如下步骤：

3.1针对导引头子系统，通过BLF函数，为保证BLOS不会超出最大视场角限制k_c1，即|x₁|＜k_c1；定义第一个滑模面

s₁＝x₁-x_1d (12)

式中，x_1d为系统状态x₁的期望值，为保证对目标的精准拦截，期望的视场角x_1d＝0；

由式(12)得到，|s₁|＜k_c1-0＝k_b1，k_b1为滑模面s₁的最大值；

定义障碍Lyapunov函数为

式中a₀＞0；

对式(13)求导，有

设计虚拟控制命令x_2c为：

式中需要设计的参数k₁＞0；

为了避免使用反演法引入的虚拟控制命令而带来的“微分爆炸”现象，引入动态面方法，使得x_2c通过一阶滤波器得到x_2d和

式中τ₂＞0为滤波器的时间常数；

3.2对于制导子系统，即式(11)的第二个方程，为保证虚拟控制命令x₂对虚拟指令x_2d的跟踪，定义第二个滑模面为

s₂＝x₂-x_2d (17)

对上式(17)求导并将式(11)的第二个方程带入得

将系统状态x₃视为虚拟控制输入，设计虚拟控制命令x_3c如下：

式中需要设计的参数k₂＞0；

同理，将x_3c通过一阶滤波器得到x_3d和

式中τ₃＞0为滤波器的时间常数；

3.3针对攻角子系统，为保证系统状态x₃对虚拟指令x_3d的跟踪，定义第三个滑模面为：

s₃＝x₃-x_3d (21)

对上式求导将式(11)的第三个方程带入有

将系统状态x₄作为虚拟控制输入，设计虚拟控制命令x_4c如下：

式中需要设计的参数k₃＞0；

将虚拟控制命令x_4c通过一阶滤波器得到x_4d和

式中τ₄＞0为滤波器的时间常数；

3.4针对姿态子系统，为保证系统状态x₄对虚拟指令x_4d的跟踪，定义第四个滑模面为

s₄＝x₄-x_4d (25)

对上式求导并将式(11)的第四个方程带入有

将系统状态x₅作为虚拟控制输入，设计虚拟控制命令x_5c如下：

式中需要设计的参数k₄＞0；

将虚拟控制命令x_5c通过一阶滤波器得到x_5d和

式中τ₅＞0为滤波器的时间常数；

3.5针对舵机子系统，为保证系统状态x₅对虚拟指令x_5d的跟踪，定义第五个滑模面为：

s₅＝x₅-x_5d (29)

对上式求导并将式(11)的第五个方程带入有

控制器的输入设计为

式中需要设计的参数k₅＞0。

5.根据权利要求4所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤四中，采用降阶扩张状态观测器对其进行估计，具体为：

式中，p_i,i＝1,2,3,4是辅助变量，

是通道间复合干扰d_i,i＝1,2,3,4的估计值，β_i＞0,i＝1,2,3,4为观测器增益。

6.根据权利要求5所述的考虑视场角和舵机延时约束的导弹制导控制一体化方法，其特征在于：在步骤五中，考虑视场角约束的制导控制一体化控制器为：

Images