CN114756040B - 一种飞行器姿态非奇异预定时间滑模控制方法 - Google Patents

一种飞行器姿态非奇异预定时间滑模控制方法 Download PDF

Info

Publication number
CN114756040B
CN114756040B CN202210412846.0A CN202210412846A CN114756040B CN 114756040 B CN114756040 B CN 114756040B CN 202210412846 A CN202210412846 A CN 202210412846A CN 114756040 B CN114756040 B CN 114756040B
Authority
CN
China
Prior art keywords
aircraft
representing
sliding mode
error
attitude
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.)
Active
Application number
CN202210412846.0A
Other languages
English (en)
Other versions
CN114756040A (zh
Inventor
韦常柱
浦甲伦
朱光楠
张峪浩
王铭泽
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Zhuyu Aerospace Technology Co ltd
Original Assignee
Harbin Zhuyu Aerospace Technology Co ltd
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Harbin Zhuyu Aerospace Technology Co ltd filed Critical Harbin Zhuyu Aerospace Technology Co ltd
Priority to CN202210412846.0A priority Critical patent/CN114756040B/zh
Publication of CN114756040A publication Critical patent/CN114756040A/zh
Application granted granted Critical
Publication of CN114756040B publication Critical patent/CN114756040B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0833Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using limited authority control

Landscapes

  • Engineering & Computer Science (AREA)
  • Computer Security & Cryptography (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (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:建立具有预定时间收敛特性的非奇异滑模控制律,在避免奇异的前提下使得***状态误差在预先设定的时间内收敛到滑模面。
与现有技术相比,本发明的有益效果是:
本发明是一种高精度、高可靠性的飞行器姿态精确控制方法,采用预定时间非奇异滑模控制器,保证了飞行器姿态跟踪过程中无论动态过程还是稳态过程姿态跟踪误差均限制在预先定义的边界范围内,避免了动态过程超调过大,使得控制器能够在预定的任意时间内实现收敛,同时避免了奇异现象,保证了控制指令的合理性。
附图说明
图1是本发明的控制流程图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅是发明的一部分实施例,而不是全部的实施例,基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
一种飞行器姿态非奇异预定时间滑模控制方法,所述方法包括如下步骤:
S1:建立飞行器再入过程姿态动力学和运动学模型,将姿态变量与制导指令做差后获得姿态跟踪误差状态方程;
S101:建立飞行器再入过程姿态动力学和运动学模型的方程如下:
Figure BDA0003604500970000031
式(1)中:
α表示飞行器的攻角;
σ表示飞行器的倾侧角;
β表示飞行器的侧滑角;
ψ表示飞行器的飞行航迹角;
γ表示飞行器的飞行路径角;
θ表示飞行器飞行的经度;
Figure BDA0003604500970000032
表示飞行器飞行的纬度;
ωE表示地球自转角速度;
p表示飞行器的滚转速度;
q表示飞行器的偏航速度;
r表示飞行器的俯仰角速度;
Jzz表示飞行器绕z轴的转动惯量;
Jxx表示飞行器绕x轴的转动惯量;
Jyy表示飞行器绕y轴的转动惯量;
Mx表示飞行器的滚转通道控制力;
My表示飞行器的俯仰角通道控制力;
Mz表示飞行器的偏航通道控制力;
Jxz表示飞行器的惯性积;
d1表示飞行器的滚转速度的偏差项;
d2表示飞行器的偏航速度的偏差项;
d3表示飞行器的俯仰角速度的偏差项;
设定:
Λ=[α,β,σ]T
ω=[p,q,r]T
Figure BDA0003604500970000041
Figure BDA0003604500970000042
Figure BDA0003604500970000043
则式(1)可进一步写成:
Figure BDA0003604500970000044
式(2)中:
Λ、ω、R、Ω以及f均为自定义转呈符号,无物理意义;
J∈R3×3表示转动惯量;
M∈R3表示控制力矩;
Δd表示***总扰动;
S102:考虑姿态跟踪误差z1=Λ-ΛC以及
Figure BDA0003604500970000051
其中,ΛC=[αCCC]T表示制导指令,αC表示攻角的制导指令,βC表示侧滑角的制导指令,σC表示倾侧角的制导指令;
S103:求得姿态跟踪误差状态方程为:
Figure BDA0003604500970000052
式(3)中:
d为姿态跟踪误差状态方程中飞行器所受干扰,且
Figure BDA0003604500970000053
S2:建立预设性能函数使得姿态跟踪误差收敛的动态过程和稳态过程均限制在约束范围内,并利用误差转换将不等式约束转换为等式约束,建立误差转换模型;
S201:考虑飞行器姿态跟踪过程动态和稳态过程最大误差约束为-δDiρi(t)<z1i(t)<δUiρi(t),其中0<δDi<1,0<δUi<1,i=1,2,3。
构建性能函数如下:
Figure BDA0003604500970000054
式(4)中:
ρi表示性能函数;
Figure BDA0003604500970000055
a1、a2、a3以及a4均为自定义转呈符号,无物理意义;
ρi0表示定义的姿态跟踪误差的初始值;
ρi∞表示定义的姿态跟踪误差的终端值;
t表示时间;
Tf表示收敛到稳态ρi∞的时间,可任意设置;
e表示指数函数;
k表示收敛速率,通过调节k的值来改变瞬态过程的收敛速度,且0.5<k<3;
S202:在姿态跟踪误差状态方程的基础上将式(4)不等式约束转换为等式约束如下:
Figure BDA0003604500970000061
式(5)中:
σei表示自定义转呈符号;
δDi表示性能函数下届放大倍数;
δUi表示性能函数上界放大倍数;
z1i表示飞行器姿态跟踪误差状态方程中的姿态跟踪误差;
将式(5)进一步写为:
Figure BDA0003604500970000062
式(6)中:
ei表示自定义转呈符号,无物理意义;
S203:求得误差转换模型为:
Figure BDA0003604500970000071
式(7)中:
e1表示误差转换后二阶***外层;
A表示自定义转呈符号,
Figure BDA0003604500970000072
其中:I表示矢量;
e2表示误差转换后二阶***内层;
P表示自定义转呈符号,
Figure BDA0003604500970000073
其中:z2i表示姿态跟踪误差z2的第i个分量,i=1,2,3;ρ表示式(4)的矢量形式,ρ=[ρ1,ρ2,ρ3]T
Φ表示自定义转呈符号,
Figure BDA0003604500970000074
D表示误差转换后二阶***所受总干扰。
S3:根据姿态跟踪误差状态方程以及误差转换模型建立具有预定时间收敛特性的非奇异终端滑模面,将状态误差值运行至滑模面时能在预先定义的收敛时间内收敛到零;
S301:建立滑模面S如下:
Figure BDA0003604500970000075
式(8)中:
a为常数且-1.5<a<-0.75;
Tc表示运行在滑模面上时***收敛到零所用时间,且Tc>0;
S302:当转换状态误差运行至滑模面S=0时,将在运行在滑模面上时***收敛到零所用时间Tc内收敛到零。
S4:考虑预定时间收敛扩张观测器对***总扰动的估计,根据S3中的滑模面,建立具有预定时间收敛特性的非奇异滑模控制律,在避免奇异的前提下使得***状态误差在预先设定的时间内收敛到滑模面。
设置控制器如下:
Figure BDA0003604500970000081
式(9)中:
M表示控制力矩;
Θ为自定义转呈符号,且
Figure BDA0003604500970000082
e1i表示误差转换后二阶***通道i外层状态变量;
Γ表示自定义转呈符号,且
Figure BDA0003604500970000083
η表示预设时间函数指数变量,且0<η<1;
Tp表示设定时间;
Si表示误差转换后二阶***通道i形成的滑模面大小;
Figure BDA0003604500970000084
表示对扰动的估计值,由预定时间收敛观测器获得;
由于控制律具有如下性质:
Figure BDA0003604500970000085
因此,控制律将在预先设定时间Tp内收敛到滑模面。
对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同条件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。

Claims (1)

1.一种飞行器姿态非奇异预定时间滑模控制方法,其特征在于:所述方法包括如下步骤:
S1:获得姿态跟踪误差状态方程;
S101:建立飞行器再入过程姿态动力学和运动学模型的方程如下:
Figure FDA0003867161740000011
式(1)中:
α表示飞行器的攻角;
σ表示飞行器的倾侧角;
β表示飞行器的侧滑角;
ψ表示飞行器的飞行航迹角;
γ表示飞行器的飞行路径角;
θ表示飞行器飞行的经度;
Figure FDA0003867161740000012
表示飞行器飞行的纬度;
ωE表示地球自转角速度;
p表示飞行器的滚转速度;
q表示飞行器的偏航速度;
r表示飞行器的俯仰角速度;
Jzz表示飞行器绕z轴的转动惯量;
Jxx表示飞行器绕x轴的转动惯量;
Jyy表示飞行器绕y轴的转动惯量;
Mx表示飞行器的滚转通道控制力;
My表示飞行器的俯仰角通道控制力;
Mz表示飞行器的偏航通道控制力;
Jxz表示飞行器的惯性积;
d1表示飞行器的滚转速度的偏差项;
d2表示飞行器的偏航速度的偏差项;
d3表示飞行器的俯仰角速度的偏差项;
设定:
Λ=[α,β,σ]T
ω=[p,q,r]T
Figure FDA0003867161740000021
Figure FDA0003867161740000022
Figure FDA0003867161740000023
则式(1)可进一步写成:
Figure FDA0003867161740000031
式(2)中:
Λ、ω、R、Ω以及f均为自定义转呈符号,无物理意义;
J∈R3×3表示转动惯量;
M∈R3表示控制力矩;
Δd表示***总扰动;
S102:考虑姿态跟踪误差z1=Λ-ΛC以及
Figure FDA0003867161740000032
其中,ΛC=[αCCC]T表示制导指令,αC表示攻角的制导指令,βC表示侧滑角的制导指令,σC表示倾侧角的制导指令;
S103:求得姿态跟踪误差状态方程为:
Figure FDA0003867161740000033
式(3)中:
d为姿态跟踪误差状态方程中飞行器所受干扰,且
Figure FDA0003867161740000034
S2:建立误差转换模型;
S201:构建性能函数如下:
Figure FDA0003867161740000035
式(4)中:
ρi表示性能函数;
a1=ρi0+3a4,a2=-4ke-ka4
a3=-4a4,
Figure FDA0003867161740000041
a1、a2、a3以及a4均为自定义转呈符号,无物理意义;
ρi0表示定义的姿态跟踪误差的初始值;
ρi∞表示定义的姿态跟踪误差的终端值;
t表示时间;
Tf表示收敛到稳态ρi∞的时间;
e表示指数函数;
k表示收敛速率,通过调节k的值来改变瞬态过程的收敛速度,且0.5<k<3;
S202:在姿态跟踪误差状态方程的基础上将式(4)不等式约束转换为等式约束如下:
Figure FDA0003867161740000042
式(5)中:
σei表示自定义转呈符号;
δDi表示性能函数下届放大倍数;
δUi表示性能函数上界放大倍数;
z1i表示飞行器姿态跟踪误差状态方程中的姿态跟踪误差;
将式(5)进一步写为:
Figure FDA0003867161740000043
式(6)中:
ei表示自定义转呈符号,无物理意义;
S203:求得误差转换模型为:
Figure FDA0003867161740000051
式(7)中:
e1表示误差转换后二阶***外层;
A表示自定义转呈符号,
Figure FDA0003867161740000052
其中:I表示矢量;
e2表示误差转换后二阶***内层;
P表示自定义转呈符号,
Figure FDA0003867161740000053
其中:z2i表示姿态跟踪误差z2的第i个分量,i=1,2,3;ρ表示式(4)的矢量形式,ρ=[ρ1,ρ2,ρ3]T
Φ表示自定义转呈符号,
Figure FDA0003867161740000054
D表示误差转换后二阶***所受总干扰;
S3:建立具有预定时间收敛特性的非奇异终端滑模面,将状态误差值运行至滑模面时能在预先定义的收敛时间内收敛到零;
S301:建立滑模面S如下:
Figure FDA0003867161740000055
式(8)中:
a为常数且-1.5<a<-0.75;
Tc表示运行在滑模面上时***收敛到零所用时间,且Tc>0;
S302:当转换状态误差运行至滑模面S=0时,将在运行在滑模面上时***收敛到零所用时间Tc内收敛到零;
S4:建立具有预定时间收敛特性的非奇异滑模控制律,在避免奇异的前提下使得***状态误差在预先设定的时间内收敛到滑模面;
S4所述具有预定时间收敛特性非奇异滑模控制律的建立过程如下:
设置控制器如下:
Figure FDA0003867161740000061
式(9)中:
M表示控制力矩;
Θ为自定义转呈符号,且
Figure FDA0003867161740000062
e1i表示误差转换后二阶***通道i外层状态变量;
Γ表示自定义转呈符号,且
Figure FDA0003867161740000063
η表示预设时间函数指数变量,且0<η<1;
Tp表示设定时间;
Si表示误差转换后二阶***通道i形成的滑模面大小;
Figure FDA0003867161740000065
表示对扰动的估计值,由预定时间收敛观测器获得;
由于控制律具有如下性质:
Figure FDA0003867161740000064
因此,控制律将在预先设定时间Tp内收敛到滑模面。
CN202210412846.0A 2022-04-19 2022-04-19 一种飞行器姿态非奇异预定时间滑模控制方法 Active CN114756040B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202210412846.0A CN114756040B (zh) 2022-04-19 2022-04-19 一种飞行器姿态非奇异预定时间滑模控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202210412846.0A CN114756040B (zh) 2022-04-19 2022-04-19 一种飞行器姿态非奇异预定时间滑模控制方法

Publications (2)

Publication Number Publication Date
CN114756040A CN114756040A (zh) 2022-07-15
CN114756040B true CN114756040B (zh) 2022-11-25

Family

ID=82331470

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202210412846.0A Active CN114756040B (zh) 2022-04-19 2022-04-19 一种飞行器姿态非奇异预定时间滑模控制方法

Country Status (1)

Country Link
CN (1) CN114756040B (zh)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115390447B (zh) * 2022-08-16 2024-05-14 哈尔滨逐宇航天科技有限责任公司 一种适应姿态大幅机动的飞行器预设性能控制方法
CN116804853B (zh) * 2023-08-25 2023-11-07 季华实验室 挠性航天器姿态控制方法、装置、电子设备及存储介质

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104950898A (zh) * 2015-06-10 2015-09-30 北京理工大学 一种再入飞行器全阶非奇异终端滑模姿态控制方法
CN108873927A (zh) * 2018-09-25 2018-11-23 浙江工业大学 一种刚性飞行器的非奇异固定时间自适应姿态跟踪控制方法
CN109144084A (zh) * 2018-07-11 2019-01-04 哈尔滨工业大学 一种基于固定时间收敛观测器的垂直起降重复使用运载器姿态跟踪控制方法
CN109143866A (zh) * 2018-09-25 2019-01-04 浙江工业大学 一种考虑执行器受限问题的刚性飞行器自适应固定时间姿态跟踪控制方法
CN111409869A (zh) * 2020-04-10 2020-07-14 湖南云顶智能科技有限公司 可重复使用运载火箭一子级回收容错控制方法

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR102164372B1 (ko) * 2020-04-03 2020-10-12 주식회사 파블로항공 소형 고정익 무인항공기의 경로 추종 방법 및 이를 이용한 lgvf 경로 추종 제어기

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104950898A (zh) * 2015-06-10 2015-09-30 北京理工大学 一种再入飞行器全阶非奇异终端滑模姿态控制方法
CN109144084A (zh) * 2018-07-11 2019-01-04 哈尔滨工业大学 一种基于固定时间收敛观测器的垂直起降重复使用运载器姿态跟踪控制方法
CN108873927A (zh) * 2018-09-25 2018-11-23 浙江工业大学 一种刚性飞行器的非奇异固定时间自适应姿态跟踪控制方法
CN109143866A (zh) * 2018-09-25 2019-01-04 浙江工业大学 一种考虑执行器受限问题的刚性飞行器自适应固定时间姿态跟踪控制方法
CN111409869A (zh) * 2020-04-10 2020-07-14 湖南云顶智能科技有限公司 可重复使用运载火箭一子级回收容错控制方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
火箭垂直返回双幂次固定时间收敛滑模控制方法;崔乃刚 等;《哈尔滨工业大学学报》;20200430;第52卷(第04期);15-24 *

Also Published As

Publication number Publication date
CN114756040A (zh) 2022-07-15

Similar Documents

Publication Publication Date Title
CN114756040B (zh) 一种飞行器姿态非奇异预定时间滑模控制方法
CN109144084B (zh) 一种基于固定时间收敛观测器的垂直起降重复使用运载器姿态跟踪控制方法
CN104950898B (zh) 一种再入飞行器全阶非奇异终端滑模姿态控制方法
CN105242676B (zh) 一种有限时间收敛时变滑模姿态控制方法
CN109062042B (zh) 一种旋翼飞行器的有限时间航迹跟踪控制方法
CN111324138B (zh) 一种四旋翼姿态指定时间保性能输出反馈控制方法
CN110377045A (zh) 一种基于抗干扰技术的飞行器全剖面控制方法
CN107688295A (zh) 一种基于快速终端滑模的四旋翼飞行器有限时间自适应控制方法
CN110850887B (zh) 一种四旋翼无人机复合动态逆抗干扰姿态控制方法
CN105912009B (zh) 基于极点配置和模糊自抗扰控制技术的四旋翼飞行器控制方法
CN108037662A (zh) 一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
CN104793629B (zh) 一种飞艇三维航迹跟踪的反步神经网络控制方法
CN104950671A (zh) 基于自适应模糊的再入飞行器pid型滑模姿态控制方法
CN109542112B (zh) 一种针对垂直起降可重复使用火箭返回飞行的固定时间收敛抗扰控制方法
CN110224639B (zh) 一种基于滑模控制器的偏差耦合控制方法
CN113359472B (zh) 一种四旋翼无人机自适应鲁棒轨迹跟踪控制方法
CN112965510B (zh) 飞行器高速机动的全通道自抗扰控制方法
CN104536448B (zh) 一种基于Backstepping法的无人机姿态***控制方法
CN112631316B (zh) 变负载四旋翼无人机的有限时间控制方法
CN107817818B (zh) 一种模型不确定飞艇航迹跟踪有限时间控制方法
CN111413996B (zh) 一种基于事件触发eso的四旋翼保性能轨迹跟踪控制方法
CN107942672A (zh) 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
CN107450319A (zh) 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法
CN116430828A (zh) 一种基于观测器的四旋翼故障容灾降级控制方法
CN109032163B (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