CN115390447B - 一种适应姿态大幅机动的飞行器预设性能控制方法 - Google Patents

Abstract

一种适应姿态大幅机动的飞行器预设性能控制方法，属于飞行器控制技术领域。方法如下：形成姿态控制误差模型；对于三个通道分别设计预设性能边界函数，以对姿态角控制误差响应进行约束；分别定义三个通道的无约束控制误差，求导得到对应的等价无约束控制模型；对等价无约束控制模型设计终端滑模控制律，并引入边界层函数降低滑模控制律的抖振现象。本发明优化了控制律的动态特性；在飞行器需进行大幅机动，姿态指令快速变化时适当放宽约束边界，从而避免了控制输入的长期饱和；此外，设计了终端滑模控制提高姿态角控制误差收敛速度，并引入边界层函数避免了控制量的抖振现象，便于工程应用。

Description

一种适应姿态大幅机动的飞行器预设性能控制方法

技术领域

本发明涉及一种适应姿态大幅机动的飞行器预设性能控制方法，属于飞行器控制技术领域。

背景技术

传统飞行器的控制系统设计往往仅考虑稳定性，而忽略了对控制动态性能的约束；同时飞行器执行任务过程中常需要大幅机动，在机动过程中控制输入易饱和，对动态性能的实现与满足带来一定影响。因此需要开发一种既能够约束控制动态性能，又能避免控制输入长期饱和的控制方法。

发明内容

为解决背景技术中存在的问题，本发明提供一种适应姿态大幅机动的飞行器预设性能控制方法。

实现上述目的，本发明采取下述技术方案：一种适应姿态大幅机动的飞行器预设性能控制方法，方法包括如下步骤：

S1：构建飞行器姿态动力学与运动学模型，并将姿态动力学与运动学模型和姿态指令作差，形成姿态控制误差模型；

S2：对于飞行器俯仰通道、偏航通道和滚转通道三个通道，分别设计引入抗饱和自适应项的预设性能边界函数，以对姿态角控制误差响应进行约束，并避免控制量长期饱和；

S3：分别定义飞行器俯仰通道、偏航通道和滚转通道三个通道的无约束控制误差，对其求导得到对应的等价无约束控制模型；

S4：对等价无约束控制模型设计终端滑模控制律，并引入边界层函数降低滑模控制律的抖振现象。

与现有技术相比，本发明的有益效果是：

本发明采用预设性能边界函数对姿态角控制误差收敛动态过程进行约束，优化了控制律的动态特性；同时在预设性能边界函数中引入与姿态指令变化速率相关的抗饱和自适应项，在飞行器需进行大幅机动，姿态指令快速变化时适当放宽约束边界，从而避免了控制输入的长期饱和；此外，设计了终端滑模控制提高姿态角控制误差收敛速度，并引入边界层函数避免了控制量的抖振现象，便于工程应用。

具体实施方式

下面对本发明中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅是发明的一部分实施例，而不是全部的实施例，基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。

一种适应姿态大幅机动的飞行器预设性能控制方法，所述方法包括如下步骤：

S1：构建飞行器姿态动力学与运动学模型，并将姿态动力学与运动学模型和姿态指令作差，形成姿态控制误差模型；

S101：基于绕质心转动动力学和姿态运动学，构建飞行器姿态动力学与运动学模型如下：

式(1)中：

为Ω关于时间的一阶导数；

为飞行器的姿态角矢量；

为俯仰角；

ψ为偏航角；

γ为滚转角；

T代表向量的转置；

R为姿态转换矩阵，

ω＝[ω_x,ω_y,ω_z]^T为飞行器的姿态角速度矢量；

ω_x为滚转角速度；

ω_y为偏航角速度；

ω_z为俯仰角速度；

为ω关于时间的一阶导数；

J为飞行器的转动惯量矩阵，且

J_xx为飞行器绕x轴的转动惯量；

J_yy为飞行器绕y轴的转动惯量；

J_zz为飞行器绕z轴的转动惯量；

J_xy，J_xz，J_yz为惯性积；

ω^×表示叉乘矩阵；

B₁为控制力矩系数矩阵；

U＝[δ_x,δ_y,δ_z]^T表示控制输入量；

δ_x为副翼的偏转角；

δ_y为方向舵的偏转角；

δ_z为升降舵的偏转角；

D₁＝[d_x,d_y,d_z]^T为气动力矩与干扰力矩项；

d_x为作用在滚转通道的气动力矩与干扰力矩项；

d_y为作用在偏航通道的气动力矩与干扰力矩项；

d_z为作用在俯仰通道的气动力矩与干扰力矩项；

S102：将姿态动力学与运动学模型和姿态指令作差，形成姿态控制误差模型：

设定飞行器姿态角变化指令Ω_c为：

Ω_c＝[Ω_cz,Ω_cy,Ω_cx] (2)

式(2)中：

Ω_cz为俯仰通道指令；

Ω_cy为偏航通道指令；

Ω_cx为滚转通道指令；

定义姿态角跟踪误差e₁及姿态角跟踪误差对时间的一阶导数e₂为：

式(3)中：

为Ω_c关于时间的一阶导数；

e_1z为俯仰通道误差；

e_1y为偏航通道误差；

e_1x为滚转通道误差；

e_2z为俯仰通道误差的导数；

e_2y为偏航通道误差的导数；

e_2x为滚转通道误差的导数；

将式(1)转化为姿态控制误差模型

式(4)中：

B＝RJ^-1B₁为控制矩阵；

为总干扰；

为Ω_c关于时间的二阶导数。

S2：对于飞行器俯仰通道、偏航通道和滚转通道三个通道，分别设计引入抗饱和自适应项的预设性能边界函数，以对姿态角控制误差响应进行约束，并避免控制量长期饱和；

S201：偏航通道的基函数χ_y(t)、滚转通道的基函数χ_x(t)以及俯仰通道的基函数χ_z(t)形式相同；以俯仰通道为例，设计俯仰通道的基函数χ_z(t)为

χ_z(t)＝(χ_0z-χ_fz)exp(-c_zt)+χ_fz (5)

式(5)中：

χ_0z为χ_z(t)的初始值；

χ_fz为χ_z(t)的终值；

exp表示指数函数；

c_z＞0为控制基函数衰减速率的系数；

t为时间；

S202：对于俯仰通道，在俯仰通道的基函数χ_z(t)中引入俯仰通道抗饱和自适应项设计俯仰通道预设性能边界函数ρ_z＝χ_z(t)+λ_z；式中tanh表示反正切函数，k_z＞0为俯仰通道抗饱和自适应项的幅值；

对于偏航通道，在偏航通道的基函数χ_y(t)中引入偏航通道抗饱和自适应项设计偏航通道预设性能边界函数ρ_y＝χ_y(t)+λ_y；式中k_y＞0为偏航通道抗饱和自适应项的幅值；

对于滚转通道，在滚转通道的基函数χ_x(t)中引入滚转通道抗饱和自适应项设计滚转通道预设性能边界函数ρ_x＝χ_x(t)+λ_x；式中k_x＞0为滚转通道抗饱和自适应项的幅值；

S203：利用预设性能边界函数，建立关于俯仰通道误差e_1z的不等式约束为：-ρ_z＜e_1z＜ρ_z；建立关于偏航通道误差e_1y的不等式约束为：-ρ_y＜e_1y＜ρ_y；建立关于滚转通道误差e_1x的不等式约束为：-ρ_x＜e_1x＜ρ_x。

S3：分别定义飞行器俯仰通道、偏航通道和滚转通道三个通道的无约束控制误差，对其求导得到对应的等价无约束控制模型；

S301：定义俯仰通道无约束控制误差为：其中，tan表示正切函数；定义偏航通道无约束控制误差为/>定义滚转通道无约束控制误差为定义无约束控制误差矢量为η＝[η_z,η_y,η_x]^T；

S302：求无约束控制误差矢量η关于时间的一阶导数与二阶导数/>得到等价无约束控制模型为：

式(6)中：

H、Γ、Ξ以及Θ均为中间量，无物理意义；

表示俯仰通道预设性能边界函数ρ_z对时间的一阶导数；

表示俯仰通道预设性能边界函数ρ_z对时间的二阶导数；

表示偏航通道预设性能边界函数ρ_y对时间的一阶导数；

表示偏航通道预设性能边界函数ρ_y对时间的二阶导数；

表示滚转通道预设性能边界函数ρ_x对时间的一阶导数；

表示滚转通道预设性能边界函数ρ_x对时间的二阶导数。

S4：对等价无约束控制模型设计终端滑模控制律，提高姿态控制误差的收敛速度，并引入边界层函数降低滑模控制律的抖振现象，从而实现姿态角控制误差始终处于预设性能边界函数内。

S401：设计滑模面S为：

式(7)中：

λ＞0为比例系数；

1＜κ＜2为幂次系数；

sign表示符号函数；

S402：设计终端滑模控制律为

式(8)中：

为边界层函数；

τ＝0.001为边界层厚度。

对于本领域技术人员而言，显然本发明不限于上述示范性实施例的细节，而且在不背离本发明的精神或基本特征的情况下，能够以其他的形式实现本发明。因此，无论从哪一点来看，均应将实施例看作是示范性的，而且是非限制性的，本发明的范围由所附权利要求而不是上述说明限定，因此旨在将落在权利要求的等同条件的含义和范围内的所有变化囊括在本发明内。

此外，应当理解，虽然本说明书按照实施方式加以描述，但并非每个实施方式仅包含一个独立的技术方案，说明书的这种叙述方式仅仅是为清楚起见，本领域技术人员应当将说明书作为一个整体，各实施例中的技术方案也可以经适当组合，形成本领域技术人员可以理解的其他实施方式。

Claims (2)

1.一种适应姿态大幅机动的飞行器预设性能控制方法，其特征在于：所述方法包括如下步骤：

S1：构建飞行器姿态动力学与运动学模型，并将姿态动力学与运动学模型和姿态指令作差，形成姿态控制误差模型；

S101：基于绕质心转动动力学和姿态运动学，构建飞行器姿态动力学与运动学模型如下：

式(1)中：

为Ω关于时间的一阶导数；

为飞行器的姿态角矢量；

为俯仰角；

ψ为偏航角；

γ为滚转角；

T代表向量的转置；

R为姿态转换矩阵，

ω＝[ω_x,ω_y,ω_z]^T为飞行器的姿态角速度矢量；

ω_x为滚转角速度；

ω_y为偏航角速度；

ω_z为俯仰角速度；

为ω关于时间的一阶导数；

J为飞行器的转动惯量矩阵，且

J_xx为飞行器绕x轴的转动惯量；

J_yy为飞行器绕y轴的转动惯量；

J_zz为飞行器绕z轴的转动惯量；

J_xy，J_xz，J_yz为惯性积；

ω^×表示叉乘矩阵；

B₁为控制力矩系数矩阵；

U＝[δ_x,δ_y,δ_z]^T表示控制输入量；

δ_x为副翼的偏转角；

δ_y为方向舵的偏转角；

δ_z为升降舵的偏转角；

D₁＝[d_x,d_y,d_z]^T为气动力矩与干扰力矩项；

d_x为作用在滚转通道的气动力矩与干扰力矩项；

d_y为作用在偏航通道的气动力矩与干扰力矩项；

d_z为作用在俯仰通道的气动力矩与干扰力矩项；

S102：将姿态动力学与运动学模型和姿态指令作差，形成姿态控制误差模型：

设定飞行器姿态角变化指令Ω_c为：

Ω_c＝[Ω_cz,Ω_cy,Ω_cx] (2)

式(2)中：

Ω_cz为俯仰通道指令；

Ω_cy为偏航通道指令；

Ω_cx为滚转通道指令；

定义姿态角跟踪误差e₁及姿态角跟踪误差对时间的一阶导数e₂为：

式(3)中：

为Ω_c关于时间的一阶导数；

e_1z为俯仰通道误差；

e_1y为偏航通道误差；

e_1x为滚转通道误差；

e_2z为俯仰通道误差对时间的一阶导数；

e_2y为偏航通道误差对时间的一阶导数；

e_2x为滚转通道误差对时间的一阶导数；

将式(1)转化为姿态控制误差模型

式(4)中：

B＝RJ^-1B₁为控制矩阵；

为总干扰；

为Ω_c关于时间的二阶导数；

S2：对于飞行器俯仰通道、偏航通道和滚转通道三个通道，分别设计引入抗饱和自适应项的预设性能边界函数，以对姿态角控制误差响应进行约束，并避免控制量长期饱和；

S201：偏航通道的基函数χ_y(t)、滚转通道的基函数χ_x(t)以及俯仰通道的基函数χ_z(t)形式相同；以俯仰通道为例，设计俯仰通道的基函数χ_z(t)为

χ_z(t)＝(χ_0z-χ_fz)exp(-c_zt)+χ_fz (5)

式(5)中：

χ_0z为χ_z(t)的初始值；

χ_fz为χ_z(t)的终值；

exp表示指数函数；

c_z＞0为控制基函数衰减速率的系数；

t为时间；

S202：对于俯仰通道，在俯仰通道的基函数χ_z(t)中引入俯仰通道抗饱和自适应项设计俯仰通道预设性能边界函数ρ_z＝χ_z(t)+λ_z；式中tanh表示反正切函数，k_z＞0为俯仰通道抗饱和自适应项的幅值；

对于偏航通道，在偏航通道的基函数χ_y(t)中引入偏航通道抗饱和自适应项设计偏航通道预设性能边界函数ρ_y＝χ_y(t)+λ_y；式中k_y＞0为偏航通道抗饱和自适应项的幅值；

对于滚转通道，在滚转通道的基函数χ_x(t)中引入滚转通道抗饱和自适应项设计滚转通道预设性能边界函数ρ_x＝χ_x(t)+λ_x；式中k_x＞0为滚转通道抗饱和自适应项的幅值；

S203：利用预设性能边界函数，建立关于俯仰通道误差e_1z的不等式约束为：-ρ_z＜e_1z＜ρ_z；建立关于偏航通道误差e_1y的不等式约束为：-ρ_y＜e_1y＜ρ_y；建立关于滚转通道误差e_1x的不等式约束为：-ρ_x＜e_1x＜ρ_x；

S3：分别定义飞行器俯仰通道、偏航通道和滚转通道三个通道的无约束控制误差，对其求导得到对应的等价无约束控制模型；

S301：定义俯仰通道无约束控制误差为：其中，tan表示正切函数；定义偏航通道无约束控制误差为/>定义滚转通道无约束控制误差为定义无约束控制误差矢量为η＝[η_z,η_y,η_x]^T；

S302：求无约束控制误差矢量η关于时间的一阶导数与二阶导数/>得到等价无约束控制模型为：

式(6)中：

H、Γ、Ξ以及Θ均为中间量，无物理意义；

表示俯仰通道预设性能边界函数ρ_z对时间的一阶导数；

表示俯仰通道预设性能边界函数ρ_z对时间的二阶导数；

表示偏航通道预设性能边界函数ρ_y对时间的一阶导数；

表示偏航通道预设性能边界函数ρ_y对时间的二阶导数；

表示滚转通道预设性能边界函数ρ_x对时间的一阶导数；

表示滚转通道预设性能边界函数ρ_x对时间的二阶导数；

S4：对等价无约束控制模型设计终端滑模控制律，并引入边界层函数降低滑模控制律的抖振现象。

2.根据权利要求1所述的一种适应姿态大幅机动的飞行器预设性能控制方法，其特征在于：所述S4包括如下步骤：

S401：设计滑模面S为：

式(7)中：

λ＞0为比例系数；

1＜κ＜2为幂次系数；

sign表示符号函数；

S402：设计终端滑模控制律为

式(8)中：

为边界层函数；

τ＝0.001为边界层厚度。