[发明专利]一种角速度控制段兼顾角偏差控制的方法

说明书

本发明公开了一种角速度控制段兼顾角偏差控制的方法根据角速度控制段第一个周期的角偏差计算角速度，取反限幅后，作为角速度控制的目标程序角速度。这样能够使姿态角向减小角偏差的方向运动，达到了在角速度控制时兼顾角偏差发散的作用，避免了角偏差持续增大，简单有效。本发明提供的一种角速度控制段兼顾角偏差控制的方法实现抛整流罩前后角速度控制精度的要求，并避免姿态角长时间无控导致角偏差持续增大的负面作用，为运载火箭抛整流罩前后的飞行安全起到了至关重要的作用。本发明降低了姿态控制网络设计的复杂度，简单可靠，易于工程实现，适于广泛推广。

技术领域

本发明涉及导航、制导与控制技术领域，特别涉及，一种角速度控制段兼顾角偏差控制的方法。

背景技术

当运载火箭在大气层飞行时，整流罩用于保护有效载荷不受气动加热、气动力、振动等的影响。而当火箭进入真空中后，外界干扰因素消失，需要进行整流罩分离。为确保整流罩抛罩过程安全，避免碰撞风险，在抛罩前后一段时间须严格将箭体姿态角速度控制在较低水平。

因此，要求起控后先采用角速度控制，后进行姿态控制，这样导致姿态角长时间处于失控状态，角偏差持续增大，造成实际发动机推力线方向长期偏移，箭体速度、位置偏离既定弹道，对迭代制导精度产生不利影响。若采用角偏差和角速度控制，容易导致在指定时间内无法达到角速度控制要求值，同时增加控制网络设计的复杂性。

针对此问题，提出了一种解决现有技术所存的为确保整流罩分离安全，运载火箭在抛整流罩前后需要在较长时间段内进行角速度控制，这样导致姿态角处于失控状态，角偏差持续增大，影响迭代制导精度的问题的方法，从而更妥善有效的解决角速度控制需求和姿态角控制精度的矛盾。

发明内容

针对上述缺陷，本发明解决的技术问题在于，提供一种角速度控制段兼顾角偏差控制的方法，以解决现在技术所存在的为确保整流罩分离安全，运载火箭在抛整流罩前后需要在较长时间段内进行角速度控制，这样导致姿态角处于失控状态，角偏差持续增大，影响迭代制导精度的问题。

本发明提供了一种角速度控制段兼顾角偏差控制的方法，具体步骤包括：

步骤1、在角速度控制段第一周期，根据当前时刻俯仰、偏航、滚动角偏差以及角速度控制要求时长，得到角速度控制段的平均需求角速度；

步骤2、将平均需求角速度取反，并对取反后的平均角速度进行限幅；

步骤3、将取反限幅后的平均角速度作为角速度控制段的目标程序角速度输入控制方程构建的模型进行角速度偏差控制，其中所述控制方程基于角速度通道增益、校正网络和控制指令输出建立。

优选地，所述步骤1中角速度控制段的平均需求角速度为：

其中为当前时刻俯仰角偏差，Δψ₁为当前时刻偏航角偏差，Δγ₁为当前时刻滚动角偏差，Δt_jsdctrl为角速度控制要求时长。

优选地，所述步骤2中平均角速度限幅值的绝对值ω_{ψ_max}、ω_{γ_max}均满足指标要求。

优选地，所述步骤2中得到的取反限幅后的平均角速度为：

其中ω_{ψ_max}、ω_{γ_max}为平均角速度限幅值的绝对值。

优选地，所述步骤3中nT时刻角速度控制通道输入为：

其中为控制方程的俯仰角速度的输入量，为控制方程的偏航角速度的输入量，为控制方程的滚动角速度的输入量，ω_x1、ω_y1、ω_z1分别为当前时刻俯仰、偏航和滚动通道的箭体系角速度。

优选地，所述步骤3中控制方程为：