CN114756040B - 一种飞行器姿态非奇异预定时间滑模控制方法 - Google Patents
一种飞行器姿态非奇异预定时间滑模控制方法 Download PDFInfo
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 238000006243 chemical reaction Methods 0.000 claims abstract description 27
- 230000008569 process Effects 0.000 claims abstract description 19
- 238000009877 rendering Methods 0.000 claims description 9
- 230000001052 transient effect Effects 0.000 claims description 2
- 230000008878 coupling Effects 0.000 description 2
- 238000010168 coupling process Methods 0.000 description 2
- 238000005859 coupling reaction Methods 0.000 description 2
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000004044 response Effects 0.000 description 1
- 230000007704 transition Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0833—Control 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:建立飞行器再入过程姿态动力学和运动学模型的方程如下:
式(1)中:
α表示飞行器的攻角;
σ表示飞行器的倾侧角;
β表示飞行器的侧滑角;
ψ表示飞行器的飞行航迹角;
γ表示飞行器的飞行路径角;
θ表示飞行器飞行的经度;
ωE表示地球自转角速度;
p表示飞行器的滚转速度;
q表示飞行器的偏航速度;
r表示飞行器的俯仰角速度;
Jzz表示飞行器绕z轴的转动惯量;
Jxx表示飞行器绕x轴的转动惯量;
Jyy表示飞行器绕y轴的转动惯量;
Mx表示飞行器的滚转通道控制力;
My表示飞行器的俯仰角通道控制力;
Mz表示飞行器的偏航通道控制力;
Jxz表示飞行器的惯性积;
d1表示飞行器的滚转速度的偏差项;
d2表示飞行器的偏航速度的偏差项;
d3表示飞行器的俯仰角速度的偏差项;
设定:
Λ=[α,β,σ]T;
ω=[p,q,r]T;
则式(1)可进一步写成:
式(2)中:
Λ、ω、R、Ω以及f均为自定义转呈符号,无物理意义;
J∈R3×3表示转动惯量;
M∈R3表示控制力矩;
Δd表示***总扰动;
S103:求得姿态跟踪误差状态方程为:
式(3)中:
d为姿态跟踪误差状态方程中飞行器所受干扰,且
S2:建立预设性能函数使得姿态跟踪误差收敛的动态过程和稳态过程均限制在约束范围内,并利用误差转换将不等式约束转换为等式约束,建立误差转换模型;
S201:考虑飞行器姿态跟踪过程动态和稳态过程最大误差约束为-δDiρi(t)<z1i(t)<δUiρi(t),其中0<δDi<1,0<δUi<1,i=1,2,3。
构建性能函数如下:
式(4)中:
ρi表示性能函数;
a1、a2、a3以及a4均为自定义转呈符号,无物理意义;
ρi0表示定义的姿态跟踪误差的初始值;
ρi∞表示定义的姿态跟踪误差的终端值;
t表示时间;
Tf表示收敛到稳态ρi∞的时间,可任意设置;
e表示指数函数;
k表示收敛速率,通过调节k的值来改变瞬态过程的收敛速度,且0.5<k<3;
S202:在姿态跟踪误差状态方程的基础上将式(4)不等式约束转换为等式约束如下:
式(5)中:
σei表示自定义转呈符号;
δDi表示性能函数下届放大倍数;
δUi表示性能函数上界放大倍数;
z1i表示飞行器姿态跟踪误差状态方程中的姿态跟踪误差;
将式(5)进一步写为:
式(6)中:
ei表示自定义转呈符号,无物理意义;
S203:求得误差转换模型为:
式(7)中:
e1表示误差转换后二阶***外层;
e2表示误差转换后二阶***内层;
D表示误差转换后二阶***所受总干扰。
S3:根据姿态跟踪误差状态方程以及误差转换模型建立具有预定时间收敛特性的非奇异终端滑模面,将状态误差值运行至滑模面时能在预先定义的收敛时间内收敛到零;
S301:建立滑模面S如下:
式(8)中:
a为常数且-1.5<a<-0.75;
Tc表示运行在滑模面上时***收敛到零所用时间,且Tc>0;
S302:当转换状态误差运行至滑模面S=0时,将在运行在滑模面上时***收敛到零所用时间Tc内收敛到零。
S4:考虑预定时间收敛扩张观测器对***总扰动的估计,根据S3中的滑模面,建立具有预定时间收敛特性的非奇异滑模控制律,在避免奇异的前提下使得***状态误差在预先设定的时间内收敛到滑模面。
设置控制器如下:
式(9)中:
M表示控制力矩;
e1i表示误差转换后二阶***通道i外层状态变量;
η表示预设时间函数指数变量,且0<η<1;
Tp表示设定时间;
Si表示误差转换后二阶***通道i形成的滑模面大小;
由于控制律具有如下性质:
因此,控制律将在预先设定时间Tp内收敛到滑模面。
对于本领域技术人员而言,显然本发明不限于上述示范性实施例的细节,而且在不背离本发明的精神或基本特征的情况下,能够以其他的形式实现本发明。因此,无论从哪一点来看,均应将实施例看作是示范性的,而且是非限制性的,本发明的范围由所附权利要求而不是上述说明限定,因此旨在将落在权利要求的等同条件的含义和范围内的所有变化囊括在本发明内。不应将权利要求中的任何附图标记视为限制所涉及的权利要求。
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施例中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。
Claims (1)
1.一种飞行器姿态非奇异预定时间滑模控制方法,其特征在于:所述方法包括如下步骤:
S1:获得姿态跟踪误差状态方程;
S101:建立飞行器再入过程姿态动力学和运动学模型的方程如下:
式(1)中:
α表示飞行器的攻角;
σ表示飞行器的倾侧角;
β表示飞行器的侧滑角;
ψ表示飞行器的飞行航迹角;
γ表示飞行器的飞行路径角;
θ表示飞行器飞行的经度;
ωE表示地球自转角速度;
p表示飞行器的滚转速度;
q表示飞行器的偏航速度;
r表示飞行器的俯仰角速度;
Jzz表示飞行器绕z轴的转动惯量;
Jxx表示飞行器绕x轴的转动惯量;
Jyy表示飞行器绕y轴的转动惯量;
Mx表示飞行器的滚转通道控制力;
My表示飞行器的俯仰角通道控制力;
Mz表示飞行器的偏航通道控制力;
Jxz表示飞行器的惯性积;
d1表示飞行器的滚转速度的偏差项;
d2表示飞行器的偏航速度的偏差项;
d3表示飞行器的俯仰角速度的偏差项;
设定:
Λ=[α,β,σ]T;
ω=[p,q,r]T;
则式(1)可进一步写成:
式(2)中:
Λ、ω、R、Ω以及f均为自定义转呈符号,无物理意义;
J∈R3×3表示转动惯量;
M∈R3表示控制力矩;
Δd表示***总扰动;
S103:求得姿态跟踪误差状态方程为:
式(3)中:
d为姿态跟踪误差状态方程中飞行器所受干扰,且
S2:建立误差转换模型;
S201:构建性能函数如下:
式(4)中:
ρi表示性能函数;
a1=ρi0+3a4,a2=-4ke-ka4
a1、a2、a3以及a4均为自定义转呈符号,无物理意义;
ρi0表示定义的姿态跟踪误差的初始值;
ρi∞表示定义的姿态跟踪误差的终端值;
t表示时间;
Tf表示收敛到稳态ρi∞的时间;
e表示指数函数;
k表示收敛速率,通过调节k的值来改变瞬态过程的收敛速度,且0.5<k<3;
S202:在姿态跟踪误差状态方程的基础上将式(4)不等式约束转换为等式约束如下:
式(5)中:
σei表示自定义转呈符号;
δDi表示性能函数下届放大倍数;
δUi表示性能函数上界放大倍数;
z1i表示飞行器姿态跟踪误差状态方程中的姿态跟踪误差;
将式(5)进一步写为:
式(6)中:
ei表示自定义转呈符号,无物理意义;
S203:求得误差转换模型为:
式(7)中:
e1表示误差转换后二阶***外层;
e2表示误差转换后二阶***内层;
D表示误差转换后二阶***所受总干扰;
S3:建立具有预定时间收敛特性的非奇异终端滑模面,将状态误差值运行至滑模面时能在预先定义的收敛时间内收敛到零;
S301:建立滑模面S如下:
式(8)中:
a为常数且-1.5<a<-0.75;
Tc表示运行在滑模面上时***收敛到零所用时间,且Tc>0;
S302:当转换状态误差运行至滑模面S=0时,将在运行在滑模面上时***收敛到零所用时间Tc内收敛到零;
S4:建立具有预定时间收敛特性的非奇异滑模控制律,在避免奇异的前提下使得***状态误差在预先设定的时间内收敛到滑模面;
S4所述具有预定时间收敛特性非奇异滑模控制律的建立过程如下:
设置控制器如下:
式(9)中:
M表示控制力矩;
e1i表示误差转换后二阶***通道i外层状态变量;
η表示预设时间函数指数变量,且0<η<1;
Tp表示设定时间;
Si表示误差转换后二阶***通道i形成的滑模面大小;
由于控制律具有如下性质:
因此,控制律将在预先设定时间Tp内收敛到滑模面。
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)
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)
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)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR102164372B1 (ko) * | 2020-04-03 | 2020-10-12 | 주식회사 파블로항공 | 소형 고정익 무인항공기의 경로 추종 방법 및 이를 이용한 lgvf 경로 추종 제어기 |
-
2022
- 2022-04-19 CN CN202210412846.0A patent/CN114756040B/zh active Active
Patent Citations (5)
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)
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 |