CN115390447A - 一种适应姿态大幅机动的飞行器预设性能控制方法 - Google Patents
一种适应姿态大幅机动的飞行器预设性能控制方法 Download PDFInfo
- Publication number
- CN115390447A CN115390447A CN202210982562.5A CN202210982562A CN115390447A CN 115390447 A CN115390447 A CN 115390447A CN 202210982562 A CN202210982562 A CN 202210982562A CN 115390447 A CN115390447 A CN 115390447A
- Authority
- CN
- China
- Prior art keywords
- channel
- control
- attitude
- aircraft
- function
- 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
- 238000000034 method Methods 0.000 title claims abstract description 21
- 230000007774 longterm Effects 0.000 claims abstract description 6
- 238000005096 rolling process Methods 0.000 claims description 21
- 230000003044 adaptive effect Effects 0.000 claims description 11
- 239000011159 matrix material Substances 0.000 claims description 10
- 238000006243 chemical reaction Methods 0.000 claims description 2
- 238000009795 derivation Methods 0.000 abstract 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 229920006395 saturated elastomer Polymers 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种适应姿态大幅机动的飞行器预设性能控制方法,属于飞行器控制技术领域。方法如下:形成姿态控制误差模型;对于三个通道分别设计预设性能边界函数,以对姿态角控制误差响应进行约束;分别定义三个通道的无约束控制误差,求导得到对应的等价无约束控制模型;对等价无约束控制模型设计终端滑模控制律,并引入边界层函数降低滑模控制律的抖振现象。本发明优化了控制律的动态特性;在飞行器需进行大幅机动,姿态指令快速变化时适当放宽约束边界,从而避免了控制输入的长期饱和;此外,设计了终端滑模控制提高姿态角控制误差收敛速度,并引入边界层函数避免了控制量的抖振现象,便于工程应用。
Description
技术领域
本发明涉及一种适应姿态大幅机动的飞行器预设性能控制方法,属于飞行器控制技术领域。
背景技术
传统飞行器的控制系统设计往往仅考虑稳定性,而忽略了对控制动态性能的约束;同时飞行器执行任务过程中常需要大幅机动,在机动过程中控制输入易饱和,对动态性能的实现与满足带来一定影响。因此需要开发一种既能够约束控制动态性能,又能避免控制输入长期饱和的控制方法。
发明内容
为解决背景技术中存在的问题,本发明提供一种适应姿态大幅机动的飞行器预设性能控制方法。
实现上述目的,本发明采取下述技术方案:一种适应姿态大幅机动的飞行器预设性能控制方法,方法包括如下步骤:
S1:构建飞行器姿态动力学与运动学模型,并将姿态动力学与运动学模型和姿态指令作差,形成姿态控制误差模型;
S2:对于飞行器俯仰通道、偏航通道和滚转通道三个通道,分别设计引入抗饱和自适应项的预设性能边界函数,以对姿态角控制误差响应进行约束,并避免控制量长期饱和;
S3:分别定义飞行器俯仰通道、偏航通道和滚转通道三个通道的无约束控制误差,对其求导得到对应的等价无约束控制模型;
S4:对等价无约束控制模型设计终端滑模控制律,并引入边界层函数降低滑模控制律的抖振现象。
与现有技术相比,本发明的有益效果是:
本发明采用预设性能边界函数对姿态角控制误差收敛动态过程进行约束,优化了控制律的动态特性;同时在预设性能边界函数中引入与姿态指令变化速率相关的抗饱和自适应项,在飞行器需进行大幅机动,姿态指令快速变化时适当放宽约束边界,从而避免了控制输入的长期饱和;此外,设计了终端滑模控制提高姿态角控制误差收敛速度,并引入边界层函数避免了控制量的抖振现象,便于工程应用。
具体实施方式
下面对本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是发明的一部分实施例,而不是全部的实施例,基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
一种适应姿态大幅机动的飞行器预设性能控制方法,所述方法包括如下步骤:
S1:构建飞行器姿态动力学与运动学模型,并将姿态动力学与运动学模型和姿态指令作差,形成姿态控制误差模型;
S101:基于绕质心转动动力学和姿态运动学,构建飞行器姿态动力学与运动学模型如下:
式(1)中:
ψ为偏航角;
γ为滚转角;
T代表向量的转置;
ω=[ωx,ωy,ωz]T为飞行器的姿态角速度矢量;
ωx为滚转角速度;
ωy为偏航角速度;
ωz为俯仰角速度;
Jxx为飞行器绕x轴的转动惯量;
Jyy为飞行器绕y轴的转动惯量;
Jzz为飞行器绕z轴的转动惯量;
Jxy,Jxz,Jyz为惯性积;
ω×表示叉乘矩阵;
B1为控制力矩系数矩阵;
U=[δx,δy,δz]T表示控制输入量;
δx为副翼的偏转角;
δy为方向舵的偏转角;
δz为升降舵的偏转角;
D1=[dx,dy,dz]T为气动力矩与干扰力矩项;
dx为作用在滚转通道的气动力矩与干扰力矩项;
dy为作用在偏航通道的气动力矩与干扰力矩项;
dz为作用在俯仰通道的气动力矩与干扰力矩项;
S102:将姿态动力学与运动学模型和姿态指令作差,形成姿态控制误差模型:
设定飞行器姿态角变化指令Ωc为:
Ωc=[Ωcz,Ωcy,Ωcx] (2)
式(2)中:
Ωcz为俯仰通道指令;
Ωcy为偏航通道指令;
Ωcx为滚转通道指令;
定义姿态角跟踪误差e1及姿态角跟踪误差对时间的一阶导数e2为:
式(3)中:
e1z为俯仰通道误差;
e1y为偏航通道误差;
e1x为滚转通道误差;
e2z为俯仰通道误差的导数;
e2y为偏航通道误差的导数;
e2x为滚转通道误差的导数;
将式(1)转化为姿态控制误差模型
式(4)中:
B=RJ-1B1为控制矩阵;
S2:对于飞行器俯仰通道、偏航通道和滚转通道三个通道,分别设计引入抗饱和自适应项的预设性能边界函数,以对姿态角控制误差响应进行约束,并避免控制量长期饱和;
S201:偏航通道的基函数χy(t)、滚转通道的基函数χx(t)以及俯仰通道的基函数χz(t)形式相同;以俯仰通道为例,设计俯仰通道的基函数χz(t)为
χz(t)=(χ0z-χfz)exp(-czt)+χfz (5)
式(5)中:
χ0z为χz(t)的初始值;
χfz为χz(t)的终值;
exp表示指数函数;
cz>0为控制基函数衰减速率的系数;
t为时间;
S202:对于俯仰通道,在俯仰通道的基函数χz(t)中引入俯仰通道抗饱和自适应项设计俯仰通道预设性能边界函数ρz=χz(t)+λz;式中tanh表示反正切函数,kz>0为俯仰通道抗饱和自适应项的幅值;
S203:利用预设性能边界函数,建立关于俯仰通道误差e1z的不等式约束为:-ρz<e1z<ρz;建立关于偏航通道误差e1y的不等式约束为:-ρy<e1y<ρy;建立关于滚转通道误差e1x的不等式约束为:-ρx<e1x<ρx。
S3:分别定义飞行器俯仰通道、偏航通道和滚转通道三个通道的无约束控制误差,对其求导得到对应的等价无约束控制模型;
式(6)中:
H、Γ、Ξ以及Θ均为中间量,无物理意义;
S4:对等价无约束控制模型设计终端滑模控制律,提高姿态控制误差的收敛速度,并引入边界层函数降低滑模控制律的抖振现象,从而实现姿态角控制误差始终处于预设性能边界函数内。
S401:设计滑模面S为:
式(7)中:
λ>0为比例系数;
1<κ<2为幂次系数;
sign表示符号函数;
S402:设计终端滑模控制律为
式(8)中:
τ=0.001为边界层厚度。
对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同条件的含义和范围内的所有变化囊括在本发明内。
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。
Claims (5)
1.一种适应姿态大幅机动的飞行器预设性能控制方法,其特征在于:所述方法包括如下步骤:
S1:构建飞行器姿态动力学与运动学模型,并将姿态动力学与运动学模型和姿态指令作差,形成姿态控制误差模型;
S2:对于飞行器俯仰通道、偏航通道和滚转通道三个通道,分别设计引入抗饱和自适应项的预设性能边界函数,以对姿态角控制误差响应进行约束,并避免控制量长期饱和;
S3:分别定义飞行器俯仰通道、偏航通道和滚转通道三个通道的无约束控制误差,对其求导得到对应的等价无约束控制模型;
S4:对等价无约束控制模型设计终端滑模控制律,并引入边界层函数降低滑模控制律的抖振现象。
2.根据权利要求1所述的一种适应姿态大幅机动的飞行器预设性能控制方法,其特征在于:所述S1包括如下步骤:
S101:基于绕质心转动动力学和姿态运动学,构建飞行器姿态动力学与运动学模型如下:
式(1)中:
ψ为偏航角;
γ为滚转角;
T代表向量的转置;
ω=[ωx,ωy,ωz]T为飞行器的姿态角速度矢量;
ωx为滚转角速度;
ωy为偏航角速度;
ωz为俯仰角速度;
Jxx为飞行器绕x轴的转动惯量;
Jyy为飞行器绕y轴的转动惯量;
Jzz为飞行器绕z轴的转动惯量;
Jxy,Jxz,Jyz为惯性积;
ω×表示叉乘矩阵;
B1为控制力矩系数矩阵;
U=[δx,δy,δz]T表示控制输入量;
δx为副翼的偏转角;
δy为方向舵的偏转角;
δz为升降舵的偏转角;
D1=[dx,dy,dz]T为气动力矩与干扰力矩项;
dx为作用在滚转通道的气动力矩与干扰力矩项;
dy为作用在偏航通道的气动力矩与干扰力矩项;
dz为作用在俯仰通道的气动力矩与干扰力矩项;
S102:将姿态动力学与运动学模型和姿态指令作差,形成姿态控制误差模型:
设定飞行器姿态角变化指令Ωc为:
Ωc=[Ωcz,Ωcy,Ωcx] (2)
式(2)中:
Ωcz为俯仰通道指令;
Ωcy为偏航通道指令;
Ωcx为滚转通道指令;
定义姿态角跟踪误差e1及姿态角跟踪误差对时间的一阶导数e2为:
式(3)中:
e1z为俯仰通道误差;
e1y为偏航通道误差;
e1x为滚转通道误差;
e2z为俯仰通道误差对时间的一阶导数;
e2y为偏航通道误差对时间的一阶导数;
e2x为滚转通道误差对时间的一阶导数;
将式(1)转化为姿态控制误差模型
式(4)中:
B=RJ-1B1为控制矩阵;
3.根据权利要求1所述的一种适应姿态大幅机动的飞行器预设性能控制方法,其特征在于:所述S2包括如下步骤:
S201:偏航通道的基函数χy(t)、滚转通道的基函数χx(t)以及俯仰通道的基函数χz(t)形式相同;以俯仰通道为例,设计俯仰通道的基函数χz(t)为
χz(t)=(χ0z-χfz)exp(-czt)+χfz (5)
式(5)中:
χ0z为χz(t)的初始值;
χfz为χz(t)的终值;
exp表示指数函数;
cz>0为控制基函数衰减速率的系数;
t为时间;
S202:对于俯仰通道,在俯仰通道的基函数χz(t)中引入俯仰通道抗饱和自适应项设计俯仰通道预设性能边界函数ρz=χz(t)+λz;式中tanh表示反正切函数,kz>0为俯仰通道抗饱和自适应项的幅值;
S203:利用预设性能边界函数,建立关于俯仰通道误差e1z的不等式约束为:-ρz<e1z<ρz;建立关于偏航通道误差e1y的不等式约束为:-ρy<e1y<ρy;建立关于滚转通道误差e1x的不等式约束为:-ρx<e1x<ρx。
4.根据权利要求1所述的一种适应姿态大幅机动的飞行器预设性能控制方法,其特征在于:所述S3包括如下步骤:
式(6)中:
H、Γ、Ξ以及Θ均为中间量,无物理意义;
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210982562.5A CN115390447B (zh) | 2022-08-16 | 2022-08-16 | 一种适应姿态大幅机动的飞行器预设性能控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202210982562.5A CN115390447B (zh) | 2022-08-16 | 2022-08-16 | 一种适应姿态大幅机动的飞行器预设性能控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115390447A true CN115390447A (zh) | 2022-11-25 |
CN115390447B CN115390447B (zh) | 2024-05-14 |
Family
ID=84119995
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202210982562.5A Active CN115390447B (zh) | 2022-08-16 | 2022-08-16 | 一种适应姿态大幅机动的飞行器预设性能控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115390447B (zh) |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5100084A (en) * | 1990-04-16 | 1992-03-31 | Space Systems/Loral, Inc. | Method and apparatus for inclined orbit attitude control for momentum bias spacecraft |
CN108803649A (zh) * | 2018-08-22 | 2018-11-13 | 哈尔滨工业大学 | 一种垂直起降重复使用运载器自抗扰滑模控制方法 |
CN109870912A (zh) * | 2018-03-15 | 2019-06-11 | 浙江工业大学 | 一种采用非对称时不变约束函数的飞行器姿态控制方法 |
CN109917650A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种非对称时变约束的飞行器姿态控制方法 |
US20200141699A1 (en) * | 2018-11-02 | 2020-05-07 | Bae Systems Information And Electronic Systems Integration Inc. | Multi-mode adaptive nonlinear trajectory shaping (nts) guidance law |
CN111766889A (zh) * | 2020-05-06 | 2020-10-13 | 东北电力大学 | 基于输出反馈的四旋翼自适应动态面滑模控制器 |
CN112486193A (zh) * | 2020-11-19 | 2021-03-12 | 南京航空航天大学 | 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法 |
CN113110554A (zh) * | 2021-04-30 | 2021-07-13 | 南京航空航天大学 | 一种四旋翼无人机复合连续快速终端滑模姿态控制方法 |
CN114706309A (zh) * | 2022-04-11 | 2022-07-05 | 北京理工大学 | 基于分数阶时变滑模预设时间收敛的冲击角约束制导方法 |
CN114756040A (zh) * | 2022-04-19 | 2022-07-15 | 哈尔滨逐宇航天科技有限责任公司 | 一种飞行器姿态非奇异预定时间滑模控制方法 |
-
2022
- 2022-08-16 CN CN202210982562.5A patent/CN115390447B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5100084A (en) * | 1990-04-16 | 1992-03-31 | Space Systems/Loral, Inc. | Method and apparatus for inclined orbit attitude control for momentum bias spacecraft |
CN109870912A (zh) * | 2018-03-15 | 2019-06-11 | 浙江工业大学 | 一种采用非对称时不变约束函数的飞行器姿态控制方法 |
CN109917650A (zh) * | 2018-03-15 | 2019-06-21 | 浙江工业大学 | 一种非对称时变约束的飞行器姿态控制方法 |
CN108803649A (zh) * | 2018-08-22 | 2018-11-13 | 哈尔滨工业大学 | 一种垂直起降重复使用运载器自抗扰滑模控制方法 |
US20200141699A1 (en) * | 2018-11-02 | 2020-05-07 | Bae Systems Information And Electronic Systems Integration Inc. | Multi-mode adaptive nonlinear trajectory shaping (nts) guidance law |
CN111766889A (zh) * | 2020-05-06 | 2020-10-13 | 东北电力大学 | 基于输出反馈的四旋翼自适应动态面滑模控制器 |
CN112486193A (zh) * | 2020-11-19 | 2021-03-12 | 南京航空航天大学 | 一种基于自适应增广控制理论的飞翼无人机三轴全权限控制方法 |
CN113110554A (zh) * | 2021-04-30 | 2021-07-13 | 南京航空航天大学 | 一种四旋翼无人机复合连续快速终端滑模姿态控制方法 |
CN114706309A (zh) * | 2022-04-11 | 2022-07-05 | 北京理工大学 | 基于分数阶时变滑模预设时间收敛的冲击角约束制导方法 |
CN114756040A (zh) * | 2022-04-19 | 2022-07-15 | 哈尔滨逐宇航天科技有限责任公司 | 一种飞行器姿态非奇异预定时间滑模控制方法 |
Non-Patent Citations (1)
Title |
---|
谢子涵等: "有向拓扑条件下有限时间收敛协同制导律设计", 《战术导弹技术》, no. 4, 1 August 2022 (2022-08-01), pages 60 - 68 * |
Also Published As
Publication number | Publication date |
---|---|
CN115390447B (zh) | 2024-05-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109062042B (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
CN104881035B (zh) | 飞行器操纵耦合补偿方法、姿态运动控制方法及系统 | |
CN107807657B (zh) | 一种基于路径规划的挠性航天器姿态自适应控制方法 | |
CN107272719B (zh) | 基于协调因子的高超声速飞行器姿态运动协调控制方法 | |
CN102880060A (zh) | 再入飞行器自适应指数时变滑模姿态控制方法 | |
CN117289598B (zh) | 一种飞行器的反步滑模控制方法及系统 | |
CN107491088B (zh) | 一种输入饱和的飞艇航迹控制方法 | |
CN111650837B (zh) | 一种推进器故障时水面船轨迹跟踪的二阶预设性能容错控制方法 | |
CN113110554B (zh) | 一种四旋翼无人机复合连续快速终端滑模姿态控制方法 | |
CN104216417A (zh) | 一种基于四矢量螺旋桨的平流层飞艇的动态控制分配方法 | |
CN106200665A (zh) | 携带不确定负载的四轴飞行器的建模与自适应控制方法 | |
CN111007877A (zh) | 一种四旋翼飞行器的全局鲁棒自适应轨迹跟踪控制方法 | |
CN113778129A (zh) | 一种干扰补偿的高超声速变后掠翼飞行器跟踪控制方法 | |
CN111026160A (zh) | 一种四旋翼无人机轨迹跟踪控制方法 | |
CN114756040A (zh) | 一种飞行器姿态非奇异预定时间滑模控制方法 | |
CN115390447A (zh) | 一种适应姿态大幅机动的飞行器预设性能控制方法 | |
CN112009669B (zh) | 一种基于空气舵的飞行器的减速方法及装置 | |
CN116923730B (zh) | 一种具有自调节预设性能约束的航天器姿态主动容错控制方法 | |
CN111007867B (zh) | 一种可预设调整时间的高超声速飞行器姿态控制设计方法 | |
CN117492478A (zh) | 一种再入滑翔飞行器最优超螺旋滑模控制方法 | |
CN116382332B (zh) | 一种基于ude的战斗机大机动鲁棒飞行控制方法 | |
CN107450319A (zh) | 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 | |
CN113009932B (zh) | 一种基于扰动观测器控制的四旋翼无人机抗干扰控制方法 | |
CN112327626B (zh) | 基于数据分析的飞行器通道耦合协调控制方法 | |
CN116203840A (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 | ||
TR01 | Transfer of patent right |
Effective date of registration: 20240702 Address after: 150000 No. 92, West Da Zhi street, Nangang District, Harbin, Heilongjiang. Patentee after: HARBIN INSTITUTE OF TECHNOLOGY Country or region after: China Address before: 150000 No. 3, floor 1, unit 1, building 15, No. 2, tiesan street, Nangang District, Harbin, Heilongjiang Province Patentee before: Harbin Zhuyu Aerospace Technology Co.,Ltd. Country or region before: China |
|
TR01 | Transfer of patent right |