CN109189087B - 一种垂直起降重复使用运载器的自适应容错控制方法 - Google Patents

一种垂直起降重复使用运载器的自适应容错控制方法 Download PDF

Info

Publication number
CN109189087B
CN109189087B CN201810949373.1A CN201810949373A CN109189087B CN 109189087 B CN109189087 B CN 109189087B CN 201810949373 A CN201810949373 A CN 201810949373A CN 109189087 B CN109189087 B CN 109189087B
Authority
CN
China
Prior art keywords
landing
fault
attitude
convergence
vertical take
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
CN201810949373.1A
Other languages
English (en)
Other versions
CN109189087A (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 Institute of Technology
Original Assignee
Harbin Institute of Technology
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 Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201810949373.1A priority Critical patent/CN109189087B/zh
Publication of CN109189087A publication Critical patent/CN109189087A/zh
Application granted granted Critical
Publication of CN109189087B publication Critical patent/CN109189087B/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
    • 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/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Feedback Control In General (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明提出了一种垂直起降重复使用运载器的自适应容错控制方法,包括以下步骤:步骤一:制导指令获取;步骤二:着陆段容错控制模型建立;步骤三:固定时间收敛扩张状态观测器设计;步骤四:非奇异快速终端滑模面设计;步骤五:自适应容错控制器设计。通过这种设计模式不仅有效提高了系统对复杂外部干扰抑制能力和多种发动机故障模式下的自适应容错能力,同时也能保证姿态制导指令的快速、精确跟踪。

Description

一种垂直起降重复使用运载器的自适应容错控制方法
技术领域
本发明属于飞行器控制技术领域,特别是涉及一种垂直起降重复使用运载器的自适应容错控制方法。
背景技术
垂直起降重复使用运载器从发射场起飞到最终定点软着陆需要经历主动飞行段、调姿飞行段、修航段、高空无动力再入段、高空点火减速飞行段、大气层内栅格舵控制飞行段和垂直着陆段等七个飞行过程。其中,垂直着陆段是最后一个飞行段,主要完成位置、姿态和速度的精确控制,使其位置控制精度在10m以内,着陆姿态精度2°以内,速度控制在2m/s以内。然而,在垂直着陆段由于速度较低(130m/s左右)、风干扰较大(风攻角可达50°~90°)、推力调节响应时间较慢、发动机工作时间短因而位置修正能力有限和发动机执行机构易出现故障等因素,给垂直起降重复使用运载器精确软着陆控制技术带来了极大挑战,亟需研究一种具有强鲁棒、快响应、高精度和自适应的容错控制器,这对于垂直起降重复使用运载器回收定点软着陆技术具有重要的研究意义。
通过对已有技术文献进行检索分析,目前针对运载器的容错控制系统设计主要分为主动容错控制技术和被动容错控制技术两类。其中被动容错控制主要基于鲁棒控制技术设计相应的控制器,不需要依赖于任何在线故障信息,只针对事先已知的故障设计固定的控制器以确保闭环系统的稳定性。而主动容错控制技术一般可直接利用在线故障信息,在线重构控制器以保证故障发生后系统良好的控制性能指标。此外,主动容错控制技术还可以利用间接的故障估计信号,在线调节控制器,从而保持系统的稳定性。在被动容错控制方面,主要有孟洲提出了一种时变的模型参考自适应容错控制方法,通过小扰动线性化方程设计自适应控制器,进而通过李亚普诺夫方法证明其渐进稳定性并保证闭环系统性能指标。然而大部分被动容错控制方法需要设计自适应控制律,存在参数设计复杂、初值选取难以确定、控制精度不高和鲁棒性有限等缺点,难以保证垂直起降重复使用运载器着陆段的高精度姿态控制需求。在主动容错控制器设计方面,赵琳针对执行机构不确定性、未知扰动和部分失效故障提出了一种自适应快速终端滑模容错控制器,利用自适应算法在线估计得到故障信息,进而设计相应的控制器以保证姿态跟踪误差在有限时间内收敛至零。然而该方法的收敛时间受初始状态误差影响较大,需要依赖较为精确的动力学模型及气动模型,鲁棒性不高,控制精度难以提高等缺点。
发明内容
本发明目的是为了解决垂直起降重复使用运载器在着陆段飞行时,存在发动机伺服机构故障条件下的高精度自主着陆控制问题,提出了一种垂直起降重复使用运载器的自适应容错控制方法。
本发明的目的通过以下技术方案实现:一种垂直起降重复使用运载器的自适应容错控制方法,包括以下步骤:
步骤一:设计垂直起降重复使用运载器着陆段的多约束制导律,转换后直接获得俯仰角、偏航角及滚转角的姿态制导指令;
步骤二:建立执行机构为发动机的故障动力学模型基础上的垂直起降重复使用运载器着陆段姿态控制模型;
步骤三:将发动机执行机构故障引起的附加动力学、外部干扰、模型不确定性和耦合干扰统一视为总干扰,采用具有固定时间收敛特性的扩张状态观测器进行估计;
步骤四:根据步骤三所述固定时间收敛扩张状态观测器状态估计结果,进行非奇异快速终端滑模面设计;
步骤五:将固定时间收敛扩张状态观测器和非奇异快速终端滑模面结合,设计自适应增益的容错控制器以实现高精度姿态跟踪控制。
进一步地,所述步骤一具体为:
在垂直起降重复使用运载器着陆段飞行过程中,采用多约束制导律以保证位置、姿态和速度的着陆要求;位置和姿态以过载形式给出的多约束制导律来保证精度要求,速度是通过推力调节控制律进行控制;其中过载制导律为:
u=a0-g (1)
其中a0为垂直起降重复使用运载器当前的加速度矢量,u为推力加速度矢量和气动力加速度矢量和,g为重力加速度;定义u=[ux uy uz]T,则获得推力大小及姿态角制导指令为:
Figure GDA0002406281830000021
式中m为垂直起降重复使用运载器当前飞行时刻的质量,P0用于火箭发动机推力大小控制,
Figure GDA0002406281830000031
ψc和γc为俯仰角、偏航角和滚转角制导指令;ux,uy和uz分别代表推力在体坐标系下的方向矢量值。
进一步地,所述步骤二具体为:
定义姿态角状态变量
Figure GDA0002406281830000032
姿态角速率向量X2=[ωx ωy ωz]T
Figure GDA0002406281830000033
为俯仰角,ψ为偏航角,γ为滚转角,ωx为俯仰角速率,ωy为偏航角速率,ωz为滚转角速率;发动机摆角的控制向量
Figure GDA0002406281830000034
其中MRCS为滚转通道RCS控制力矩,
Figure GDA0002406281830000035
和δψ分别代表俯仰方向和偏航方向的发动机摆角,由此可得姿态动力学方程有:
Figure GDA0002406281830000036
其中,Jx,Jy和Jz代表垂直起降重复使用运载器的转动惯量,
Figure GDA0002406281830000037
分别代表滚转角加速度、偏航角加速度和俯仰角加速度;xR为发动机摆动铰链点位置离箭体顶点的距离,xT为运载器质心离箭体顶点的距离,D1代表气动力矩及其他干扰力矩;
姿态运动学方程有:
Figure GDA0002406281830000038
式中
Figure GDA0002406281830000039
Figure GDA00024062818300000310
的导数,
Figure GDA00024062818300000311
为ψ的导数,
Figure GDA00024062818300000312
为γ的导数;
由式(3)和式(4)可得姿态控制状态空间模型为:
Figure GDA00024062818300000313
其中
Figure GDA00024062818300000314
Figure GDA00024062818300000315
Figure GDA00024062818300000317
为X1的导数,
Figure GDA00024062818300000316
为X2的导数;
考虑执行机构故障模式下,其故障动力学模型为:
UF=ΛU+ρ1 (6)
其中
Figure GDA0002406281830000041
为增益矩阵,满足0≤ΛA≤1,
Figure GDA0002406281830000042
当ΛA=1则表示执行机构无故障;当ΛA=0时,表明执行机构完全失效;当0<ΛA<1时,表明执行机构部分失效;而
Figure GDA0002406281830000043
代表执行机构输出随机偏差;UF代表发动机执行机构故障后的输出控制指令矢量值,ρ,ρ
Figure GDA0002406281830000044
是发动机执行机构在滚转、偏航和俯仰方向的等效摆角随机误差;
将故障动力学模型代入式(5)可得故障模式下的姿态控制模型:
Figure GDA0002406281830000045
对式(7)中第一个表达式求导可得:
Figure GDA0002406281830000046
其中
Figure GDA0002406281830000047
定义制导指令状态向量有
Figure GDA0002406281830000048
并令姿态角制导跟踪误差向量为
Figure GDA00024062818300000413
由此可得
Figure GDA00024062818300000410
进一步简化可得
Figure GDA00024062818300000411
其中
Figure GDA00024062818300000412
B=HJ-1B1
进一步地,所述步骤三具体为:
针对式(10),设计如下切换形式的扩张状态观测器:
Figure GDA0002406281830000051
其中
Figure GDA0002406281830000052
Tu为增益切换时间,k1,k2和k3为观测器增益系数;
Figure GDA0002406281830000053
sign(x)为符号函数;同理
Figure GDA0002406281830000054
Figure GDA0002406281830000055
Figure GDA0002406281830000056
α1∈(1-ε,1),α2=2α1-1,α3=3α1-2为幂次系数,ε为一个无穷小的正数;同理β1∈(1,1+ε1),β2=2β1-1,β3=3β1-2,ε1同样为一个无穷小的正数;Z1,Z2,Z3分别表示对e1、e2和D的估计值;
Figure GDA0002406281830000057
分别表示Z1,Z2和Z3的导数值;Υ表示与扰动有关的增益系数;则观测器观测误差ξ1=e1-Z1
Figure GDA0002406281830000059
和ξ3=D-Z3将在固定的时间T1内收敛至零。
进一步地,所述步骤四具体为:
将固定时间收敛的扩张状态观测器估计的跟踪误差导数Z2引入到滑模面设计中,可得到如下所示的滑模面:
Figure GDA00024062818300000510
其中1<γ2<2,K(e1)=diag([k1(e11),k2(e12),k3(e13)]),ki(e1i)>0,i=1,2,3,且有如下设计结果:
Figure GDA00024062818300000511
其中0<ε0≤1,λ1>0,λ2>0,γ1>1,
Figure GDA00024062818300000512
则其滑模面将在固定的时间内收敛至零;收敛时间上界为:
Figure GDA00024062818300000513
其中
Figure GDA00024062818300000514
进一步地,所述步骤五具体为:
首先依据前述所设计的扩张状态观测器式(11)及滑模面式(12),设计如下所示的具有固定时间收敛特性的自适应增益的容错控制器:
Figure GDA0002406281830000061
式中
Figure GDA0002406281830000062
||S||表示滑模面的模值,c表示幂次系数,sig(S)μ表示sigμ(S)=[|S(1)|μsign(S(1)) |S(2)|μsign(S(2)) |S(3)|μsign(S(3))]T,0<k<1,τ1>0,μ>1,0<η<1,K1>0,则
Figure GDA0002406281830000063
将随着||S||值的变化而变化,从而实现增益自适应调整,Z3为扰动的估计值,同时F定义如下:
Figure GDA0002406281830000064
其中
Figure GDA0002406281830000065
定义有如下所示:
Figure GDA0002406281830000066
其中Z2l代表的是跟踪误差角导数Z2向量的第l个分量值;其中l=1,2,3;
则姿态角制导跟踪误差向量e1和e2将在自适应增益的容错控制器的作用下在固定的时间T3内收敛至零域附近;即有收敛时间上界:
Figure GDA0002406281830000067
其中
Figure GDA0002406281830000068
Figure GDA0002406281830000069
(2VS)c中的上标c为幂次系数;则李亚普诺夫函数VS=(1/2)STS将收敛至下述零域附近:
Figure GDA0002406281830000071
其李亚普诺夫导数值满足如下所示:
Figure GDA0002406281830000072
式中ζ表示李亚普诺夫函数导数中大于零的值,θ1为缩放因子,满足0<θ1≤1;
特别地当Ψ(S)=1时,控制增益为K1,则收敛时间将变为
Figure GDA0002406281830000073
定义收敛时间误差
Figure GDA0002406281830000074
则将式(18)和式(21)相减可得:
Figure GDA0002406281830000075
由于VS=(1/2)STS,则可知VS≥0,因此
Figure GDA0002406281830000076
可推得t1<0,进而有
Figure GDA0002406281830000077
进一步可得姿态跟踪误差e1的收敛零域为:
Figure GDA0002406281830000078
e2或者
Figure GDA0002406281830000079
的收敛零域为:
Figure GDA00024062818300000710
其中
Figure GDA00024062818300000711
i|表示其绝对值;
综上,无论外部多大的扰动或任何模式的执行器故障,垂直起降重复使用运载器的姿态角将在固定时间内跟踪制导指令;收敛时间上界为:
Tc≤T1+T2+T3 (25)
至此,即完成了针对垂直起降重复使用运载器着陆段的自适应容错控制方法。
本发明有益效果:
本发明首先针对垂直起降重复使用运载器着陆段设计的多约束制导律,获得了姿态角制导指令。随后,建立了垂直着陆段考虑发动机执行机构故障条件下的姿态跟踪控制模型,并将其转化为简单的二阶系统。然后,利用固定时间收敛的扩张状态观测器对系统中的不确定性和故障进行估计,进而设计具有切换形式的非奇异快速终端滑模面。最后基于设计的滑模面和扩张状态观测器设计了具有自适应增益的固定时间收敛滑模容错控制器。该控制器首先将故障和干扰统一考虑,因而具有模型简单、设计过程简洁、无需依赖精确的故障动力学模型和动力学模型等优点。此外,固定时间收敛的扩张状态观测器可以在确定的时间内估计故障和扰动,具有设计参数较少、观测器结构简洁和收敛性好等优点。非奇异终端滑模面基于跟踪误差值大小采用了切换形式的两种传统非奇异终端滑模面,相对于已有方法具有收敛速度更快、可有效避免奇异问题等优点。此外,基于滑模面模值大小而进行自适应增益调节,可以实现滑模面在较小的情况下采用较小的增益,而在较大的条件采用较大增益,因而在减小滑模面抖振的同时,也提高了其收敛速度,具有鲁棒性更强、自适应性更好和控制结构更简单等优点。因而在垂直起降重复使用运载器垂直着陆段姿态容错控制器设计中具有广阔的应用前景。
附图说明
图1是本发明所述一种垂直起降重复使用运载器的自适应容错控制方法的流程图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
结合图1,本发明提出一种垂直起降重复使用运载器的自适应容错控制方法,包括以下步骤:
步骤一:设计垂直起降重复使用运载器着陆段的多约束制导律,转换后直接获得俯仰角、偏航角及滚转角的姿态制导指令;
步骤二:建立执行机构为发动机的故障动力学模型基础上的垂直起降重复使用运载器着陆段姿态控制模型;
步骤三:将发动机执行机构故障引起的附加动力学、外部干扰、模型不确定性和耦合干扰统一视为总干扰,采用具有固定时间收敛特性的扩张状态观测器进行估计;
步骤四:根据步骤三所述固定时间收敛扩张状态观测器状态估计结果,进行非奇异快速终端滑模面设计;
步骤五:将固定时间收敛扩张状态观测器和非奇异快速终端滑模面结合,设计自适应增益的容错控制器以实现高精度姿态跟踪控制,并克服多种常规的执行机构故障模式。
所述步骤一具体为:
在垂直起降重复使用运载器着陆段飞行过程中,采用多约束制导律以保证位置、姿态和速度的着陆要求;位置和姿态以过载形式给出的多约束制导律来保证精度要求,速度是通过推力调节控制律进行控制;其中过载制导律为:
u=a0-g (1)
其中a0为垂直起降重复使用运载器当前的加速度矢量,u为推力加速度矢量和气动力加速度矢量和,g为重力加速度;定义u=[ux uy uz]T,则获得推力大小及姿态角制导指令为:
Figure GDA0002406281830000091
式中m为垂直起降重复使用运载器当前飞行时刻的质量,P0用于火箭发动机推力大小控制,
Figure GDA0002406281830000092
ψc和γc为俯仰角、偏航角和滚转角制导指令。ux,uy和uz分别代表推力在体坐标系下的方向矢量值。
所述步骤二具体为:
定义姿态角状态变量
Figure GDA0002406281830000093
姿态角速率向量X2=[ωx ωy ωz]T
Figure GDA0002406281830000094
为俯仰角,ψ为偏航角,γ为滚转角,ωx为俯仰角速率,ωy为偏航角速率,ωz为滚转角速率;发动机摆角的控制向量
Figure GDA0002406281830000095
其中MRCS为滚转通道RCS控制力矩,
Figure GDA0002406281830000096
和δψ分别代表俯仰方向和偏航方向的发动机摆角,由此可得姿态动力学方程有:
Figure GDA0002406281830000101
其中,Jx,Jy和Jz代表垂直起降重复使用运载器的转动惯量,
Figure GDA0002406281830000102
分别代表滚转角加速度、偏航角加速度和俯仰角加速度。xR为发动机摆动铰链点位置离箭体顶点的距离,xT为运载器质心离箭体顶点的距离,D1代表气动力矩及其他干扰力矩;
姿态运动学方程有:
Figure GDA0002406281830000103
式中
Figure GDA0002406281830000104
Figure GDA0002406281830000105
的导数,
Figure GDA0002406281830000106
为ψ的导数,
Figure GDA0002406281830000107
为γ的导数;
由式(3)和式(4)可得姿态控制状态空间模型为:
Figure GDA0002406281830000108
其中
Figure GDA0002406281830000109
Figure GDA00024062818300001010
Figure GDA00024062818300001016
为X1的导数,
Figure GDA00024062818300001011
为X2的导数;
考虑执行机构故障模式下,其故障动力学模型为:
UF=ΛU+ρ1 (6)
其中
Figure GDA00024062818300001012
为增益矩阵,满足0≤ΛA≤1,
Figure GDA00024062818300001013
当ΛA=1则表示执行机构无故障;当ΛA=0时,表明执行机构完全失效;当0<ΛA<1时,表明执行机构部分失效;而
Figure GDA00024062818300001014
代表执行机构输出随机偏差;UF代表发动机执行机构故障后的输出控制指令矢量值,
Figure GDA00024062818300001015
是发动机执行机构在滚转、偏航和俯仰方向的等效摆角随机误差。
将故障动力学模型代入式(5)可得故障模式下的姿态控制模型:
Figure GDA0002406281830000111
对式(7)中第一个表达式求导可得:
Figure GDA0002406281830000112
其中
Figure GDA0002406281830000113
定义制导指令状态向量有
Figure GDA0002406281830000114
并令姿态角制导跟踪误差向量为
Figure GDA0002406281830000115
由此可得
Figure GDA0002406281830000116
进一步简化可得
Figure GDA0002406281830000117
其中
Figure GDA0002406281830000118
所述步骤三具体为:
针对式(10),设计如下切换形式的扩张状态观测器:
Figure GDA0002406281830000119
其中
Figure GDA00024062818300001110
Tu为增益切换时间,k1,k2和k3为观测器增益系数;
Figure GDA00024062818300001111
sign(x)为符号函数;同理
Figure GDA00024062818300001112
Figure GDA00024062818300001113
Figure GDA00024062818300001114
α1∈(1-ε,1),α2=2α1-1,α3=3α1-2为幂次系数,ε为一个无穷小的正数;同理β1∈(1,1+ε1),β2=2β1-1,β3=3β1-2,ε1同样为一个无穷小的正数;Z1,Z2,Z3分别表示对e1、e2和D的估计值;
Figure GDA00024062818300001115
分别表示Z1,Z2和Z3的导数值;Υ表示与扰动有关的增益系数。则观测器观测误差ξ1=e1-Z1
Figure GDA0002406281830000121
和ξ3=D-Z3将在固定的时间T1内收敛至零。
所述步骤四具体为:
将固定时间收敛的扩张状态观测器估计的跟踪误差导数Z2,即,e2的估计值,引入到滑模面设计中,可得到如下所示的滑模面:
Figure GDA0002406281830000122
其中1<γ2<2,K(e1)=diag([k1(e11),k2(e12),k3(e13)]),ki(e1i)>0,i=1,2,3,且有如下设计结果:
Figure GDA0002406281830000123
其中0<ε0≤1,λ1>0,λ2>0,γ1>1,
Figure GDA0002406281830000124
则其滑模面将在固定的时间内收敛至零;收敛时间上界为:
Figure GDA0002406281830000125
其中
Figure GDA0002406281830000126
所述步骤五具体为:
首先依据前述所设计的扩张状态观测器式(11)及滑模面式(12),设计如下所示的具有固定时间收敛特性的自适应增益的容错控制器:
Figure GDA0002406281830000127
式中
Figure GDA0002406281830000128
||S||表示滑模面的模值,c表示幂次系数,sig(S)μ表示sigμ(S)=[|S(1)|μsign(S(1)) |S(2)|μsign(S(2)) |S(3)|μsign(S(3))]T,0<k<1,τ1>0,μ>1,0<η<1,K1>0,则
Figure GDA0002406281830000129
将随着||S||值的变化而变化,从而实现增益自适应调整,Z3为扰动的估计值,即,D的估计值,同时F定义如下:
Figure GDA0002406281830000131
其中
Figure GDA0002406281830000132
定义有如下所示:
Figure GDA0002406281830000133
其中Z2l代表的是跟踪误差角导数Z2向量的第l个分量值;其中l=1,2,3。
则姿态角制导跟踪误差向量e1和e2将在自适应增益的容错控制器的作用下在固定的时间T3内收敛至零域附近;即有收敛时间上界:
Figure GDA0002406281830000134
其中
Figure GDA0002406281830000135
Figure GDA0002406281830000136
(2VS)c中的上标c为幂次系数;则李亚普诺夫函数VS=(1/2)STS将收敛至下述零域附近:
Figure GDA0002406281830000137
其李亚普诺夫导数值满足如下所示:
Figure GDA0002406281830000138
式中ζ表示李亚普诺夫函数导数中大于零的值,θ1为缩放因子,满足0<θ1≤1。
特别地当Ψ(S)=1时,控制增益为K1,则收敛时间将变为
Figure GDA0002406281830000141
定义收敛时间误差
Figure GDA0002406281830000142
则将式(18)和式(21)相减可得:
Figure GDA0002406281830000143
由于VS=(1/2)STS,则可知VS≥0,因此
Figure GDA0002406281830000144
可推得t1<0,进而有
Figure GDA0002406281830000145
进一步可得姿态跟踪误差e1的收敛零域为:
Figure GDA0002406281830000146
e2或者
Figure GDA0002406281830000147
的收敛零域为:
Figure GDA0002406281830000148
其中
Figure GDA0002406281830000149
i|表示其绝对值。
综上,无论外部多大的扰动或任何模式的执行器故障,垂直起降重复使用运载器的姿态角将在固定时间内跟踪制导指令;收敛时间上界为:
Tc≤T1+T2+T3 (25)
至此,即完成了针对垂直起降重复使用运载器着陆段的自适应容错控制方法。
本发明针对现有自适应容错控制器计算量较大、设计过程较为复杂和无法保证固定时间收敛特性的缺点而提出,将发动机等执行机构发生故障模式下引起的附加动力学、参数不确定性和外部干扰统一视为总干扰,从而利用固定时间收敛扩张状态观测器进行观测估计,进而设计相应的滑模面和具有自适应增益的滑模容错控制器。通过这种设计模式不仅有效提高了系统对复杂外部干扰抑制能力和多种发动机故障模式下的自适应容错能力,同时也能保证姿态制导指令的快速、精确跟踪。
以上对本发明所提供的一种垂直起降重复使用运载器的自适应容错控制方法,进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。

Claims (1)

1.一种垂直起降重复使用运载器的自适应容错控制方法,其特征在于,包括以下步骤:
步骤一:设计垂直起降重复使用运载器着陆段的多约束制导律,转换后直接获得俯仰角、偏航角及滚转角的姿态制导指令;
步骤二:建立执行机构为发动机的故障动力学模型基础上的垂直起降重复使用运载器着陆段姿态控制模型;
步骤三:将发动机执行机构故障引起的附加动力学、外部干扰、模型不确定性和耦合干扰统一视为总干扰,采用具有固定时间收敛特性的扩张状态观测器进行估计;
步骤四:根据步骤三所述固定时间收敛特性的扩张状态观测器状态估计结果,进行非奇异快速终端滑模面设计;
步骤五:将固定时间收敛特性的扩张状态观测器和非奇异快速终端滑模面结合,设计自适应增益的容错控制器以实现高精度姿态跟踪控制;
所述步骤一具体为:
在垂直起降重复使用运载器着陆段飞行过程中,采用多约束制导律以保证位置、姿态和速度的着陆要求;位置和姿态以过载形式给出的多约束制导律来保证精度要求,速度是通过推力调节控制律进行控制;其中过载制导律为:
u=a0-g (1)
其中a0为垂直起降重复使用运载器当前的加速度矢量,u为加速度矢量与重力加速度的差值,g为重力加速度;定义u=[ux uy uz]T,则获得推力大小及姿态角制导指令为:
Figure FDA0002480590180000011
式中m为垂直起降重复使用运载器当前飞行时刻的质量,P0用于火箭发动机推力大小控制,
Figure FDA0002480590180000012
ψc和γc为俯仰角、偏航角和滚转角制导指令;ux,uy和uz分别代表推力在体坐标系下的方向矢量值;
所述步骤二具体为:
定义姿态角状态变量
Figure FDA0002480590180000013
姿态角速率向量X2=[ωx ωy ωz]T
Figure FDA0002480590180000014
为俯仰角,ψ为偏航角,γ为滚转角,ωx为俯仰角速率,ωy为偏航角速率,ωz为滚转角速率;发动机摆角的控制向量
Figure FDA0002480590180000021
其中MRCS为滚转通道RCS控制力矩,
Figure FDA0002480590180000022
和δψ分别代表俯仰方向和偏航方向的发动机摆角,由此得姿态动力学方程有:
Figure FDA0002480590180000023
其中,Jx,Jy和Jz代表垂直起降重复使用运载器的转动惯量,
Figure FDA0002480590180000024
分别代表俯仰角加速度、偏航角加速度和滚转角加速度;xR为发动机摆动铰链点位置离箭体顶点的距离,xT为运载器质心离箭体顶点的距离,D1代表气动力矩及其他干扰力矩;
姿态运动学方程有:
Figure FDA0002480590180000025
式中
Figure FDA0002480590180000026
Figure FDA0002480590180000027
的导数,
Figure FDA0002480590180000028
为ψ的导数,
Figure FDA0002480590180000029
为γ的导数;
由式(3)和式(4)得姿态控制状态空间模型为:
Figure FDA00024805901800000210
其中
Figure FDA00024805901800000211
Figure FDA00024805901800000212
Figure FDA00024805901800000213
为X1的导数,
Figure FDA00024805901800000214
为X2的导数;
考虑执行机构故障模式下,其故障动力学模型为:
UF=ΛU+ρ1 (6)
其中
Figure FDA00024805901800000215
为增益矩阵,满足0≤ΛA≤1,
Figure FDA00024805901800000216
当ΛA=1则表示执行机构无故障;当ΛA=0时,表明执行机构完全失效;当0<ΛA<1时,表明执行机构部分失效;而
Figure FDA00024805901800000217
代表执行机构输出随机偏差;UF代表发动机执行机构故障后的输出控制指令矢量值,ρ,ρ
Figure FDA0002480590180000031
是发动机执行机构在滚转、偏航和俯仰方向的等效摆角随机误差;
将故障动力学模型代入式(5)得故障模式下的姿态控制模型:
Figure FDA0002480590180000032
对式(7)中第一个表达式求导得:
Figure FDA0002480590180000033
其中
Figure FDA0002480590180000034
定义制导指令状态向量有
Figure FDA0002480590180000035
并令姿态角制导跟踪误差向量为
Figure FDA0002480590180000036
由此得到
Figure FDA0002480590180000037
进一步简化得到:
Figure FDA0002480590180000038
其中
Figure FDA0002480590180000039
B=HJ-1B1
所述步骤三具体为:
针对式(10),设计如下切换形式的扩张状态观测器:
Figure FDA00024805901800000310
其中
Figure FDA00024805901800000311
Tu为增益切换时间,k1,k2和k3为扩张状态观测器增益系数;
Figure FDA00024805901800000312
sign(x)为符号函数;同理
Figure FDA00024805901800000313
Figure FDA00024805901800000314
Figure FDA00024805901800000315
α1∈(1-ε,1),α2=2α1-1,α3=3α1-2为幂次系数,ε为一个无穷小的正数;同理β1∈(1,1+ε1),β2=2β1-1,β3=3β1-2,ε1同样为一个无穷小的正数;Z1,Z2,Z3分别表示对e1、e2和D的估计值;
Figure FDA0002480590180000041
分别表示Z1,Z2和Z3的导数值;Υ表示与扰动有关的增益系数;则扩张状态观测器观测误差ξ1=e1-Z1
Figure FDA0002480590180000042
和ξ3=D-Z3将在固定的时间T1内收敛至零;
所述步骤四具体为:
将固定时间收敛的扩张状态观测器估计的跟踪误差角导数Z2,即,e2的估计值,引入到滑模面设计中,得到如下所示的滑模面:
Figure FDA0002480590180000043
其中1<γ2<2,K(e1)=diag([k1(e11),k2(e12),k3(e13)]),ki(e1i)>0,i=1,2,3,且有如下设计结果:
Figure FDA0002480590180000044
其中0<ε0≤1,λ1>0,λ2>0,γ1>1,
Figure FDA0002480590180000045
则其滑模面将在固定的时间内收敛至零;收敛时间上界为:
Figure FDA0002480590180000046
其中
Figure FDA0002480590180000047
所述步骤五具体为:
首先依据所设计的扩张状态观测器式(11)及滑模面式(12),设计如下所示的具有固定时间收敛特性的自适应增益的容错控制器:
Figure FDA0002480590180000048
式中
Figure FDA0002480590180000049
||S||表示滑模面的模值,c表示幂次系数,sig(S)μ表示sigμ(S)=[|S(1)|μsign(S(1)) |S(2)|μsign(S(2)) |S(3)|μsign(S(3))]T,0<k<1,τ1>0,μ>1,0<η<1,K1>0,则
Figure FDA0002480590180000051
将随着||S||值的变化而变化,从而实现增益自适应调整,Z3为扰动的估计值,即,D的估计值,同时F定义如下:
Figure FDA0002480590180000052
其中
Figure FDA0002480590180000053
Figure FDA0002480590180000054
定义有如下所示:
Figure FDA0002480590180000055
其中Z2l代表的是跟踪误差角导数Z2向量的第l个分量值;其中l=1,2,3;
则姿态角制导跟踪误差向量e1和e2将在自适应增益的容错控制器的作用下在固定的时间T3内收敛至零域附近;即有收敛时间上界:
Figure FDA0002480590180000056
其中
Figure FDA0002480590180000057
Figure FDA0002480590180000058
(2VS)c中的上标c为幂次系数;则李亚普诺夫函数VS=(1/2)STS将收敛至下述零域附近:
Figure FDA0002480590180000059
其李亚普诺夫导数值满足如下所示:
Figure FDA00024805901800000510
式中ζ表示李亚普诺夫函数导数中大于零的值,θ1为缩放因子,满足0<θ1≤1;
当Ψ(S)=1时,控制增益为K1,则收敛时间将变为
Figure FDA0002480590180000061
定义收敛时间误差
Figure FDA0002480590180000062
则将式(18)和式(21)相减得到:
Figure FDA0002480590180000063
由于VS=(1/2)STS,则可知VS≥0,因此
Figure FDA0002480590180000064
能够推得t1<0,进而有
Figure FDA0002480590180000065
进一步得到姿态跟踪误差e1的收敛零域为:
Figure FDA0002480590180000066
e2或者
Figure FDA0002480590180000067
的收敛零域为:
Figure FDA0002480590180000068
其中
Figure FDA0002480590180000069
i|表示其绝对值;
综上,无论外部多大的扰动或任何模式的执行器故障,垂直起降重复使用运载器的姿态角将在固定时间内跟踪制导指令;收敛时间上界为:
Tc≤T1+T2+T3 (25)
至此,即完成了针对垂直起降重复使用运载器着陆段的自适应容错控制方法。
CN201810949373.1A 2018-08-20 2018-08-20 一种垂直起降重复使用运载器的自适应容错控制方法 Active CN109189087B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810949373.1A CN109189087B (zh) 2018-08-20 2018-08-20 一种垂直起降重复使用运载器的自适应容错控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810949373.1A CN109189087B (zh) 2018-08-20 2018-08-20 一种垂直起降重复使用运载器的自适应容错控制方法

Publications (2)

Publication Number Publication Date
CN109189087A CN109189087A (zh) 2019-01-11
CN109189087B true CN109189087B (zh) 2020-07-14

Family

ID=64918429

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810949373.1A Active CN109189087B (zh) 2018-08-20 2018-08-20 一种垂直起降重复使用运载器的自适应容错控制方法

Country Status (1)

Country Link
CN (1) CN109189087B (zh)

Families Citing this family (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN108803649B (zh) * 2018-08-22 2019-07-09 哈尔滨工业大学 一种垂直起降重复使用运载器自抗扰滑模控制方法
CN110673616A (zh) * 2019-08-30 2020-01-10 张超凡 基于自适应滑模的固定翼无人机有限时间容错控制方法
CN110794863B (zh) * 2019-11-20 2021-05-28 中山大学 一种控制性能指标可定制的重型运载火箭姿态控制方法
CN111290421A (zh) * 2020-03-20 2020-06-16 湖南云顶智能科技有限公司 一种考虑输入饱和的高超声速飞行器姿态控制方法
CN111409869A (zh) * 2020-04-10 2020-07-14 湖南云顶智能科技有限公司 可重复使用运载火箭一子级回收容错控制方法
CN111506113B (zh) * 2020-05-15 2023-06-06 中国人民解放军国防科技大学 飞行器制导指令计算方法、侧滑角计算方法及制导方法
CN112835372B (zh) * 2020-11-30 2024-05-07 天津大学 四旋翼无人机的固定时间控制方法
CN112650291B (zh) * 2020-12-21 2022-04-15 北京理工大学 基于rcs推力器的飞行器快速姿态控制系统
CN112859600B (zh) * 2021-01-08 2024-02-09 航天时代飞鸿技术有限公司 一种基于扩张状态观测器的机械系统有限时间控制方法
CN112650303B (zh) * 2021-01-20 2022-01-11 南京航空航天大学 一种基于固定时间技术的无人机编队容错控制方法
CN113064349B (zh) * 2021-03-22 2022-06-07 中国人民解放军国防科技大学 固定时间收敛的非线性平台滑模控制方法、装置及系统
CN113110512B (zh) * 2021-05-19 2022-08-26 哈尔滨工程大学 一种减弱未知干扰与抖振影响的可底栖式auv自适应轨迹跟踪控制方法
CN113742840A (zh) * 2021-08-17 2021-12-03 航天科工火箭技术有限公司 垂直起降可重复使用运载器试验样机快速弹道迭代计算法

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102073755B (zh) * 2010-11-10 2013-04-10 南京航空航天大学 近空间高超声速飞行器运动控制仿真方法
FR3013829B1 (fr) * 2013-11-22 2016-01-08 Sagem Defense Securite Procede d'alignement d'une centrale inertielle
CN103942401B (zh) * 2014-05-14 2017-03-15 哈尔滨工业大学 一种航天器弹道多约束轨迹工具包及方法
CN105468007B (zh) * 2015-12-02 2018-07-06 哈尔滨工业大学 一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法
US10423167B2 (en) * 2016-04-25 2019-09-24 Uvionix Aerospace Corporation System and method for automated landing of an unmanned aerial vehicle

Also Published As

Publication number Publication date
CN109189087A (zh) 2019-01-11

Similar Documents

Publication Publication Date Title
CN109189087B (zh) 一种垂直起降重复使用运载器的自适应容错控制方法
Sun et al. Fixed-time sliding mode disturbance observer-based nonsmooth backstepping control for hypersonic vehicles
CN110908278B (zh) 一种折叠翼飞行器的动力学建模与稳定控制方法
CN111290421A (zh) 一种考虑输入饱和的高超声速飞行器姿态控制方法
CN113342025B (zh) 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法
CN112947067B (zh) 一种水下机器人三维轨迹精确跟踪控制方法
CN110850887A (zh) 一种四旋翼无人机复合动态逆抗干扰姿态控制方法
CN114281092B (zh) 一种基于滑模干扰观测器的高超声速飞行器协调姿态控制方法
CN111367182A (zh) 考虑输入受限的高超声速飞行器抗干扰反步控制方法
CN109164708B (zh) 一种高超声速飞行器神经网络自适应容错控制方法
CN110162067B (zh) 一种无人机非奇异自适应非光滑姿态跟踪控制方法
CN111831002A (zh) 一种基于预设性能的超高声速飞行器姿态控制方法
CN116339140B (zh) 一种基于瞬时自抗扰和自适应动态逆的复合容错控制方法
CN113741188A (zh) 执行器故障下固定翼无人机反步自适应容错控制方法
CN114721266B (zh) 飞机舵面结构性缺失故障情况下的自适应重构控制方法
CN113568423A (zh) 一种考虑电机故障的四旋翼无人机智能容错控制方法
CN110347036B (zh) 基于模糊滑模控制的无人机自主抗风智能控制方法
CN112882484B (zh) 一种无人机抗干扰容错控制方法
CN116382332B (zh) 一种基于ude的战斗机大机动鲁棒飞行控制方法
CN113093539A (zh) 基于多模态划分的宽域飞行鲁棒自适应切换控制方法
CN115685764B (zh) 变翼展飞行器任务自适应的抗干扰跟踪控制方法及系统
CN116203840A (zh) 可重复使用运载器自适应增益调度控制方法
CN115328185A (zh) 一种飞行器非线性非定常气动载荷修正系统
CN112947513B (zh) 一种基于容错和抗饱和机制的四旋翼无人机姿态控制方法
Pu et al. Time-varying spectrum based active disturbance rejection control for hypersonic reentry vehicle

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