CN109189087A - 一种垂直起降重复使用运载器的自适应容错控制方法 - Google Patents
一种垂直起降重复使用运载器的自适应容错控制方法 Download PDFInfo
- Publication number
- CN109189087A CN109189087A CN201810949373.1A CN201810949373A CN109189087A CN 109189087 A CN109189087 A CN 109189087A CN 201810949373 A CN201810949373 A CN 201810949373A CN 109189087 A CN109189087 A CN 109189087A
- Authority
- CN
- China
- Prior art keywords
- formula
- angle
- attitude
- follows
- launch vehicles
- 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
- 230000003044 adaptive effect Effects 0.000 title claims abstract description 31
- 238000007500 overflow downdraw method Methods 0.000 title claims abstract description 10
- 230000001133 acceleration Effects 0.000 claims description 21
- 238000000034 method Methods 0.000 claims description 17
- 238000005096 rolling process Methods 0.000 claims description 9
- 238000009415 formwork Methods 0.000 claims description 4
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 3
- 230000009471 action Effects 0.000 claims description 3
- 230000008859 change Effects 0.000 claims description 3
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 230000008878 coupling Effects 0.000 claims description 3
- 238000010168 coupling process Methods 0.000 claims description 3
- 238000005859 coupling reaction Methods 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 239000011159 matrix material Substances 0.000 claims description 3
- 238000006467 substitution reaction Methods 0.000 claims description 3
- 235000013399 edible fruits Nutrition 0.000 claims 1
- 230000004927 fusion Effects 0.000 abstract description 2
- 238000005516 engineering process Methods 0.000 description 7
- 230000006870 function Effects 0.000 description 6
- 230000004888 barrier function Effects 0.000 description 2
- 238000012938 design process Methods 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000004458 analytical method Methods 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 230000008450 motivation Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000004064 recycling Methods 0.000 description 1
- 230000008439 repair process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 239000007787 solid Substances 0.000 description 1
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
-
- 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/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous 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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明提出了一种垂直起降重复使用运载器的自适应容错控制方法,包括以下步骤:步骤一:制导指令获取;步骤二:着陆段容错控制模型建立;步骤三:固定时间收敛扩张状态观测器设计;步骤四:非奇异快速终端滑模面设计;步骤五:自适应容错控制器设计。通过这种设计模式不仅有效提高了系统对复杂外部干扰抑制能力和多种发动机故障模式下的自适应容错能力,同时也能保证姿态制导指令的快速、精确跟踪。
Description
技术领域
本发明属于飞行器控制技术领域,特别是涉及一种垂直起降重复使用运载器的自适应容错控制方法。
背景技术
垂直起降重复使用运载器从发射场起飞到最终定点软着陆需要经历主动飞行段、调姿飞行段、修航段、高空无动力再入段、高空点火减速飞行段、大气层内栅格舵控制飞行段和垂直着陆段等七个飞行过程。其中,垂直着陆段是最后一个飞行段,主要完成位置、姿态和速度的精确控制,使其位置控制精度在10m以内,着陆姿态精度2°以内,速度控制在2m/s以内。然而,在垂直着陆段由于速度较低(130m/s左右)、风干扰较大(风攻角可达50°~90°)、推力调节响应时间较慢、发动机工作时间短因而位置修正能力有限和发动机执行机构易出现故障等因素,给垂直起降重复使用运载器精确软着陆控制技术带来了极大挑战,亟需研究一种具有强鲁棒、快响应、高精度和自适应的容错控制器,这对于垂直起降重复使用运载器回收定点软着陆技术具有重要的研究意义。
通过对已有技术文献进行检索分析,目前针对运载器的容错控制系统设计主要分为主动容错控制技术和被动容错控制技术两类。其中被动容错控制主要基于鲁棒控制技术设计相应的控制器,不需要依赖于任何在线故障信息,只针对事先已知的故障设计固定的控制器以确保闭环系统的稳定性。而主动容错控制技术一般可直接利用在线故障信息,在线重构控制器以保证故障发生后系统良好的控制性能指标。此外,主动容错控制技术还可以利用间接的故障估计信号,在线调节控制器,从而保持系统的稳定性。在被动容错控制方面,主要有孟洲提出了一种时变的模型参考自适应容错控制方法,通过小扰动线性化方程设计自适应控制器,进而通过李亚普诺夫方法证明其渐进稳定性并保证闭环系统性能指标。然而大部分被动容错控制方法需要设计自适应控制律,存在参数设计复杂、初值选取难以确定、控制精度不高和鲁棒性有限等缺点,难以保证垂直起降重复使用运载器着陆段的高精度姿态控制需求。在主动容错控制器设计方面,赵琳针对执行机构不确定性、未知扰动和部分失效故障提出了一种自适应快速终端滑模容错控制器,利用自适应算法在线估计得到故障信息,进而设计相应的控制器以保证姿态跟踪误差在有限时间内收敛至零。然而该方法的收敛时间受初始状态误差影响较大,需要依赖较为精确的动力学模型及气动模型,鲁棒性不高,控制精度难以提高等缺点。
发明内容
本发明目的是为了解决垂直起降重复使用运载器在着陆段飞行时,存在发动机伺服机构故障条件下的高精度自主着陆控制问题,提出了一种垂直起降重复使用运载器的自适应容错控制方法。
本发明的目的通过以下技术方案实现:一种垂直起降重复使用运载器的自适应容错控制方法,包括以下步骤:
步骤一:设计垂直起降重复使用运载器着陆段的多约束制导律,转换后直接获得俯仰角、偏航角及滚转角的姿态制导指令;
步骤二:建立执行机构为发动机的故障动力学模型基础上的垂直起降重复使用运载器着陆段姿态控制模型;
步骤三:将发动机执行机构故障引起的附加动力学、外部干扰、模型不确定性和耦合干扰统一视为总干扰,采用具有固定时间收敛特性的扩张状态观测器进行估计;
步骤四:根据步骤三所述固定时间收敛扩张状态观测器状态估计结果,进行非奇异快速终端滑模面设计;
步骤五:将固定时间收敛扩张状态观测器和非奇异快速终端滑模面结合,设计自适应增益的容错控制器以实现高精度姿态跟踪控制。
进一步地,所述步骤一具体为:
在垂直起降重复使用运载器着陆段飞行过程中,采用多约束制导律以保证位置、姿态和速度的着陆要求;位置和姿态以过载形式给出的多约束制导律来保证精度要求,速度是通过推力调节控制律进行控制;其中过载制导律为:
u=a0-g (1)
其中a0为垂直起降重复使用运载器当前的加速度矢量,u为推力加速度矢量和气动力加速度矢量和,g为重力加速度;定义u=[ux uy uz]T,则获得推力大小及姿态角制导指令为:
式中m为垂直起降重复使用运载器当前飞行时刻的质量,P0用于火箭发动机推力大小控制,ψc和γc为俯仰角、偏航角和滚转角制导指令;ux,uy和uz分别代表推力在体坐标系下的方向矢量值。
进一步地,所述步骤二具体为:
定义姿态角状态变量姿态角速率向量X2=[ωx ωy ωz]T;为俯仰角,ψ为偏航角,γ为滚转角,ωx为俯仰角速率,ωy为偏航角速率,ωz为滚转角速率;发动机摆角的控制向量其中MRCS为滚转通道RCS控制力矩,和δψ分别代表俯仰方向和偏航方向的发动机摆角,由此可得姿态动力学方程有:
其中,Jx,Jy和Jz代表垂直起降重复使用运载器的转动惯量,分别代表滚转角加速度、偏航角加速度和俯仰角加速度;xR为发动机摆动铰链点位置离箭体顶点的距离,xT为运载器质心离箭体顶点的距离,D1代表气动力矩及其他干扰力矩;
姿态运动学方程有:
式中为的导数,为ψ的导数,为γ的导数;
由式(3)和式(4)可得姿态控制状态空间模型为:
其中
为X1的导数,为X2的导数;
考虑执行机构故障模式下,其故障动力学模型为:
UF=ΛU+ρ1 (6)
其中为增益矩阵,满足0≤Λi≤1,当Λi=1则表示执行机构无故障;当Λi=0时,表明执行机构完全失效;当0<Λi<1时,表明执行机构部分失效;而代表执行机构输出随机偏差;UF代表发动机执行机构故障后的输出控制指令矢量值,ρ1γρ1ψ 是发动机执行机构在滚转、偏航和俯仰方向的等效摆角随机误差;
将故障动力学模型代入式(5)可得故障模式下的姿态控制模型:
对式(7)中第一个表达式求导可得:
其中
定义制导指令状态向量有并令姿态角制导跟踪误差向量为由此可得
进一步简化可得
其中B=HJ-1B1。
进一步地,所述步骤三具体为:
针对式(10),设计如下切换形式的扩张状态观测器:
其中Tu为增益切换时间,k1,k2和k3为观测器增益系数;sign(x)为符号函数;同理 和α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的估计值;分别表示Z1,Z2和Z3的导数值;Υ表示与扰动有关的增益系数;则观测器观测误差ξ1=e1-Z1,和ξ3=D-Z3将在固定的时间T1内收敛至零。
进一步地,所述步骤四具体为:
将固定时间收敛的扩张状态观测器估计的跟踪误差导数Z2引入到滑模面设计中,可得到如下所示的滑模面:
其中1<γ2<2,K(e1)=diag([k1(e11),k2(e12),k3(e13)]),ki(e1i)>0,且有如下设计结果:
其中0<ε0≤1,λ1>0,λ2>0,γ1>1,则其滑模面将在固定的时间内收敛至零;收敛时间上界为:
其中
进一步地,所述步骤五具体为:
首先依据前述所设计的扩张状态观测器式(11)及滑模面式(12),设计如下所示的具有固定时间收敛特性的自适应增益的容错控制器:
式中||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,则将随着||S||值的变化而变化,从而实现增益自适应调整,Z3为扰动的估计值,同时F定义如下:
其中定义有如下所示:
其中Z2i代表的是观测值Z2向量的第i个分量值,其他下标符号具有类似含义;
则姿态角制导跟踪误差向量e1和e2将在自适应增益的容错控制器的作用下在固定的时间T3内收敛至零域附近;即有收敛时间上界:
其中 (2VS)c中的上标c为幂次系数;则李亚普诺夫函数VS=(1/2)STS将收敛至下述零域附近:
其李亚普诺夫导数值满足如下所示:
式中ζ表示李亚普诺夫函数导数中大于零的值,θ1为缩放因子,满足0<θ1≤1;
特别地当Ψ(S)=1时,控制增益为K1,则收敛时间将变为
定义收敛时间误差则将式(18)和式(21)相减可得:
由于VS=(1/2)STS,则可知VS≥0,因此可推得t1<0,进而有进一步可得姿态跟踪误差e1的收敛零域为:
e2或者的收敛零域为:
其中|Ξi|表示其绝对值;
综上,无论外部多大的扰动或任何模式的执行器故障,垂直起降重复使用运载器的姿态角将在固定时间内跟踪制导指令;收敛时间上界为:
Tc≤T1+T2+T3 (25)
至此,即完成了针对垂直起降重复使用运载器着陆段的自适应容错控制方法。
本发明有益效果:
本发明首先针对垂直起降重复使用运载器着陆段设计的多约束制导律,获得了姿态角制导指令。随后,建立了垂直着陆段考虑发动机执行机构故障条件下的姿态跟踪控制模型,并将其转化为简单的二阶系统。然后,利用固定时间收敛的扩张状态观测器对系统中的不确定性和故障进行估计,进而设计具有切换形式的非奇异快速终端滑模面。最后基于设计的滑模面和扩张状态观测器设计了具有自适应增益的固定时间收敛滑模容错控制器。该控制器首先将故障和干扰统一考虑,因而具有模型简单、设计过程简洁、无需依赖精确的故障动力学模型和动力学模型等优点。此外,固定时间收敛的扩张状态观测器可以在确定的时间内估计故障和扰动,具有设计参数较少、观测器结构简洁和收敛性好等优点。非奇异终端滑模面基于跟踪误差值大小采用了切换形式的两种传统非奇异终端滑模面,相对于已有方法具有收敛速度更快、可有效避免奇异问题等优点。此外,基于滑模面模值大小而进行自适应增益调节,可以实现滑模面在较小的情况下采用较小的增益,而在较大的条件采用较大增益,因而在减小滑模面抖振的同时,也提高了其收敛速度,具有鲁棒性更强、自适应性更好和控制结构更简单等优点。因而在垂直起降重复使用运载器垂直着陆段姿态容错控制器设计中具有广阔的应用前景。
附图说明
图1是本发明所述一种垂直起降重复使用运载器的自适应容错控制方法的流程图。
具体实施方式
下面将结合本发明实施例中的附图对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
结合图1,本发明提出一种垂直起降重复使用运载器的自适应容错控制方法,包括以下步骤:
步骤一:设计垂直起降重复使用运载器着陆段的多约束制导律,转换后直接获得俯仰角、偏航角及滚转角的姿态制导指令;
步骤二:建立执行机构为发动机的故障动力学模型基础上的垂直起降重复使用运载器着陆段姿态控制模型;
步骤三:将发动机执行机构故障引起的附加动力学、外部干扰、模型不确定性和耦合干扰统一视为总干扰,采用具有固定时间收敛特性的扩张状态观测器进行估计;
步骤四:根据步骤三所述固定时间收敛扩张状态观测器状态估计结果,进行非奇异快速终端滑模面设计;
步骤五:将固定时间收敛扩张状态观测器和非奇异快速终端滑模面结合,设计自适应增益的容错控制器以实现高精度姿态跟踪控制,并克服多种常规的执行机构故障模式。
所述步骤一具体为:
在垂直起降重复使用运载器着陆段飞行过程中,采用多约束制导律以保证位置、姿态和速度的着陆要求;位置和姿态以过载形式给出的多约束制导律来保证精度要求,速度是通过推力调节控制律进行控制;其中过载制导律为:
u=a0-g (1)
其中a0为垂直起降重复使用运载器当前的加速度矢量,u为推力加速度矢量和气动力加速度矢量和,g为重力加速度;定义u=[ux uy uz]T,则获得推力大小及姿态角制导指令为:
式中m为垂直起降重复使用运载器当前飞行时刻的质量,P0用于火箭发动机推力大小控制,ψc和γc为俯仰角、偏航角和滚转角制导指令。ux,uy和uz分别代表推力在体坐标系下的方向矢量值。
所述步骤二具体为:
定义姿态角状态变量姿态角速率向量为俯仰角,ψ为偏航角,γ为滚转角,ωx为俯仰角速率,ωy为偏航角速率,ωz为滚转角速率;发动机摆角的控制向量其中MRCS为滚转通道RCS控制力矩,和δψ分别代表俯仰方向和偏航方向的发动机摆角,由此可得姿态动力学方程有:
其中,Jx,Jy和Jz代表垂直起降重复使用运载器的转动惯量,分别代表滚转角加速度、偏航角加速度和俯仰角加速度。xR为发动机摆动铰链点位置离箭体顶点的距离,xT为运载器质心离箭体顶点的距离,D1代表气动力矩及其他干扰力矩;
姿态运动学方程有:
式中为的导数,为ψ的导数,为γ的导数;
由式(3)和式(4)可得姿态控制状态空间模型为:
其中
为X1的导数,为X2的导数;
考虑执行机构故障模式下,其故障动力学模型为:
UF=ΛU+ρ1 (6)
其中为增益矩阵,满足0≤Λi≤1,当Λi=1则表示执行机构无故障;当Λi=0时,表明执行机构完全失效;当0<Λi<1时,表明执行机构部分失效;而代表执行机构输出随机偏差;UF代表发动机执行机构故障后的输出控制指令矢量值,ρ1γ ρ1ψ 是发动机执行机构在滚转、偏航和俯仰方向的等效摆角随机误差。
将故障动力学模型代入式(5)可得故障模式下的姿态控制模型:
对式(7)中第一个表达式求导可得:
其中
定义制导指令状态向量有并令姿态角制导跟踪误差向量为由此可得
进一步简化可得
其中B=HJ-1B1。
所述步骤三具体为:
针对式(10),设计如下切换形式的扩张状态观测器:
其中Tu为增益切换时间,k1,k2和k3为观测器增益系数;sign(x)为符号函数;同理 和α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的估计值;分别表示Z1,Z2和Z3的导数值;Υ表示与扰动有关的增益系数。则观测器观测误差ξ1=e1-Z1,和ξ3=D-Z3将在固定的时间T1内收敛至零。
所述步骤四具体为:
将固定时间收敛的扩张状态观测器估计的跟踪误差导数Z2引入到滑模面设计中,可得到如下所示的滑模面:
其中1<γ2<2,K(e1)=diag([k1(e11),k2(e12),k3(e13)]),ki(e1i)>0,且有如下设计结果:
其中0<ε0≤1,λ1>0,λ2>0,γ1>1,则其滑模面将在固定的时间内收敛至零;收敛时间上界为:
其中
所述步骤五具体为:
首先依据前述所设计的扩张状态观测器式(11)及滑模面式(12),设计如下所示的具有固定时间收敛特性的自适应增益的容错控制器:
式中||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,则将随着||S||值的变化而变化,从而实现增益自适应调整,Z3为扰动的估计值,同时F定义如下:
其中定义有如下所示:
其中Z2i代表的是观测值Z2向量的第i个分量值,其他下标符号具有类似含义。
则姿态角制导跟踪误差向量e1和e2将在自适应增益的容错控制器的作用下在固定的时间T3内收敛至零域附近;即有收敛时间上界:
其中 (2VS)c中的上标c为幂次系数;则李亚普诺夫函数VS=(1/2)STS将收敛至下述零域附近:
其李亚普诺夫导数值满足如下所示:
式中ζ表示李亚普诺夫函数导数中大于零的值,θ1为缩放因子,满足0<θ1≤1。
特别地当Ψ(S)=1时,控制增益为K1,则收敛时间将变为
定义收敛时间误差则将式(18)和式(21)相减可得:
由于VS=(1/2)STS,则可知VS≥0,因此可推得t1<0,进而有进一步可得姿态跟踪误差e1的收敛零域为:
e2或者的收敛零域为:
其中|Ξi|表示其绝对值。
综上,无论外部多大的扰动或任何模式的执行器故障,垂直起降重复使用运载器的姿态角将在固定时间内跟踪制导指令;收敛时间上界为:
Tc≤T1+T2+T3 (25)
至此,即完成了针对垂直起降重复使用运载器着陆段的自适应容错控制方法。
本发明针对现有自适应容错控制器计算量较大、设计过程较为复杂和无法保证固定时间收敛特性的缺点而提出,将发动机等执行机构发生故障模式下引起的附加动力学、参数不确定性和外部干扰统一视为总干扰,从而利用固定时间收敛扩张状态观测器进行观测估计,进而设计相应的滑模面和具有自适应增益的滑模容错控制器。通过这种设计模式不仅有效提高了系统对复杂外部干扰抑制能力和多种发动机故障模式下的自适应容错能力,同时也能保证姿态制导指令的快速、精确跟踪。
以上对本发明所提供的一种垂直起降重复使用运载器的自适应容错控制方法,进行了详细介绍,本文中应用了具体个例对本发明的原理及实施方式进行了阐述,以上实施例的说明只是用于帮助理解本发明的方法及其核心思想;同时,对于本领域的一般技术人员,依据本发明的思想,在具体实施方式及应用范围上均会有改变之处,综上所述,本说明书内容不应理解为对本发明的限制。
Claims (6)
1.一种垂直起降重复使用运载器的自适应容错控制方法,其特征在于,包括以下步骤:
步骤一:设计垂直起降重复使用运载器着陆段的多约束制导律,转换后直接获得俯仰角、偏航角及滚转角的姿态制导指令;
步骤二:建立执行机构为发动机的故障动力学模型基础上的垂直起降重复使用运载器着陆段姿态控制模型;
步骤三:将发动机执行机构故障引起的附加动力学、外部干扰、模型不确定性和耦合干扰统一视为总干扰,采用具有固定时间收敛特性的扩张状态观测器进行估计;
步骤四:根据步骤三所述固定时间收敛扩张状态观测器状态估计结果,进行非奇异快速终端滑模面设计;
步骤五:将固定时间收敛扩张状态观测器和非奇异快速终端滑模面结合,设计自适应增益的容错控制器以实现高精度姿态跟踪控制。
2.根据权利要求1所述的方法,其特征在于,所述步骤一具体为:
在垂直起降重复使用运载器着陆段飞行过程中,采用多约束制导律以保证位置、姿态和速度的着陆要求;位置和姿态以过载形式给出的多约束制导律来保证精度要求,速度是通过推力调节控制律进行控制;其中过载制导律为:
u=a0-g (1)
其中a0为垂直起降重复使用运载器当前的加速度矢量,u为推力加速度矢量和气动力加速度矢量和,g为重力加速度;定义u=[ux uy uz]T,则获得推力大小及姿态角制导指令为:
式中m为垂直起降重复使用运载器当前飞行时刻的质量,P0用于火箭发动机推力大小控制,ψc和γc为俯仰角、偏航角和滚转角制导指令;ux,uy和uz分别代表推力在体坐标系下的方向矢量值。
3.根据权利要求2所述的方法,其特征在于,所述步骤二具体为:
定义姿态角状态变量姿态角速率向量X2=[ωx ωy ωz]T;为俯仰角,ψ为偏航角,γ为滚转角,ωx为俯仰角速率,ωy为偏航角速率,ωz为滚转角速率;发动机摆角的控制向量其中MRCS为滚转通道RCS控制力矩,和δψ分别代表俯仰方向和偏航方向的发动机摆角,由此可得姿态动力学方程有:
其中,Jx,Jy和Jz代表垂直起降重复使用运载器的转动惯量,分别代表滚转角加速度、偏航角加速度和俯仰角加速度;xR为发动机摆动铰链点位置离箭体顶点的距离,xT为运载器质心离箭体顶点的距离,D1代表气动力矩及其他干扰力矩;
姿态运动学方程有:
式中为的导数,为ψ的导数,为γ的导数;
由式(3)和式(4)可得姿态控制状态空间模型为:
其中
为X1的导数,为X2的导数;
考虑执行机构故障模式下,其故障动力学模型为:
UF=ΛU+ρ1 (6)
其中为增益矩阵,满足0≤Λi≤1,当Λi=1则表示执行机构无故障;当Λi=0时,表明执行机构完全失效;当0<Λi<1时,表明执行机构部分失效;而代表执行机构输出随机偏差;UF代表发动机执行机构故障后的输出控制指令矢量值,ρ1γρ1ψ 是发动机执行机构在滚转、偏航和俯仰方向的等效摆角随机误差;
将故障动力学模型代入式(5)可得故障模式下的姿态控制模型:
对式(7)中第一个表达式求导可得:
其中
定义制导指令状态向量有并令姿态角制导跟踪误差向量为由此可得
进一步简化可得:
其中B=HJ-1B1。
4.根据权利要求3所述的方法,其特征在于,所述步骤三具体为:
针对式(10),设计如下切换形式的扩张状态观测器:
其中Tu为增益切换时间,k1,k2和k3为观测器增益系数;sign(x)为符号函数;同理 和α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的估计值;分别表示Z1,Z2和Z3的导数值;Υ表示与扰动有关的增益系数;则观测器观测误差ξ1=e1-Z1,和ξ3=D-Z3将在固定的时间T1内收敛至零。
5.根据权利要求4所述的方法,其特征在于,所述步骤四具体为:
将固定时间收敛的扩张状态观测器估计的跟踪误差角导数Z2引入到滑模面设计中,可得到如下所示的滑模面:
其中1<γ2<2,K(e1)=diag([k1(e11),k2(e12),k3(e13)]),ki(e1i)>0,且有如下设计结果:
其中0<ε0≤1,λ1>0,λ2>0,γ1>1,则其滑模面将在固定的时间内收敛至零;收敛时间上界为:
其中
6.根据权利要求5所述的方法,其特征在于,所述步骤五具体为:
首先依据前述所设计的扩张状态观测器式(11)及滑模面式(12),设计如下所示的具有固定时间收敛特性的自适应增益的容错控制器:
式中||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,则将随着||S||值的变化而变化,从而实现增益自适应调整,Z3为扰动的估计值,同时F定义如下:
其中 定义有如下所示:
其中Z2i代表的是观测值Z2向量的第i个分量值,其他下标符号具有类似含义;
则姿态角制导跟踪误差向量e1和e2将在自适应增益的容错控制器的作用下在固定的时间T3内收敛至零域附近;即有收敛时间上界:
其中 (2VS)c中的上标c为幂次系数;则李亚普诺夫函数VS=(1/2)STS将收敛至下述零域附近:
其李亚普诺夫导数值满足如下所示:
式中ζ表示李亚普诺夫函数导数中大于零的值,θ1为缩放因子,满足0<θ1≤1;
特别地当Ψ(S)=1时,控制增益为K1,则收敛时间将变为
定义收敛时间误差则将式(18)和式(21)相减可得:
由于VS=(1/2)STS,则可知VS≥0,因此可推得t1<0,进而有进一步可得姿态跟踪误差e1的收敛零域为:
e2或者的收敛零域为:
其中|Ξi|表示其绝对值;
综上,无论外部多大的扰动或任何模式的执行器故障,垂直起降重复使用运载器的姿态角将在固定时间内跟踪制导指令;收敛时间上界为:
Tc≤T1+T2+T3 (25)
至此,即完成了针对垂直起降重复使用运载器着陆段的自适应容错控制方法。
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 true CN109189087A (zh) | 2019-01-11 |
CN109189087B 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) |
Cited By (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108803649A (zh) * | 2018-08-22 | 2018-11-13 | 哈尔滨工业大学 | 一种垂直起降重复使用运载器自抗扰滑模控制方法 |
CN110673616A (zh) * | 2019-08-30 | 2020-01-10 | 张超凡 | 基于自适应滑模的固定翼无人机有限时间容错控制方法 |
CN110794863A (zh) * | 2019-11-20 | 2020-02-14 | 中山大学 | 一种控制性能指标可定制的重型运载火箭姿态控制方法 |
CN111290421A (zh) * | 2020-03-20 | 2020-06-16 | 湖南云顶智能科技有限公司 | 一种考虑输入饱和的高超声速飞行器姿态控制方法 |
CN111409869A (zh) * | 2020-04-10 | 2020-07-14 | 湖南云顶智能科技有限公司 | 可重复使用运载火箭一子级回收容错控制方法 |
CN111506113A (zh) * | 2020-05-15 | 2020-08-07 | 中国人民解放军国防科技大学 | 飞行器制导指令计算方法、侧滑角计算方法及制导方法 |
CN112631317A (zh) * | 2020-11-26 | 2021-04-09 | 航天科工火箭技术有限公司 | 一种运载火箭的控制方法、装置及计算机可读存储介质 |
CN112650291A (zh) * | 2020-12-21 | 2021-04-13 | 北京理工大学 | 基于rcs推力器的飞行器快速姿态控制系统 |
CN112650303A (zh) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | 一种基于固定时间技术的无人机编队容错控制方法 |
CN112835372A (zh) * | 2020-11-30 | 2021-05-25 | 天津大学 | 四旋翼无人机的固定时间控制方法 |
CN112859600A (zh) * | 2021-01-08 | 2021-05-28 | 航天时代飞鸿技术有限公司 | 一种基于扩张状态观测器的机械系统有限时间控制方法 |
CN113064349A (zh) * | 2021-03-22 | 2021-07-02 | 中国人民解放军国防科技大学 | 固定时间收敛的非线性平台滑模控制方法、装置及系统 |
CN113110512A (zh) * | 2021-05-19 | 2021-07-13 | 哈尔滨工程大学 | 一种减弱未知干扰与抖振影响的可底栖式auv自适应轨迹跟踪控制方法 |
CN113742840A (zh) * | 2021-08-17 | 2021-12-03 | 航天科工火箭技术有限公司 | 垂直起降可重复使用运载器试验样机快速弹道迭代计算法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102073755A (zh) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | 近空间高超声速飞行器运动控制仿真方法 |
CN103942401A (zh) * | 2014-05-14 | 2014-07-23 | 哈尔滨工业大学 | 一种优化高精度自适应模块化的航天器弹道多约束轨迹工具包及方法 |
CN105468007A (zh) * | 2015-12-02 | 2016-04-06 | 哈尔滨工业大学 | 一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法 |
CN106068441A (zh) * | 2013-11-22 | 2016-11-02 | 萨基姆防卫安全 | 惯性单元的校准方法 |
US20170308100A1 (en) * | 2016-04-25 | 2017-10-26 | Uvionix Aerospace Corporation | System and method for automated landing of an unmanned aerial vehicle |
-
2018
- 2018-08-20 CN CN201810949373.1A patent/CN109189087B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102073755A (zh) * | 2010-11-10 | 2011-05-25 | 南京航空航天大学 | 近空间高超声速飞行器运动控制仿真方法 |
CN106068441A (zh) * | 2013-11-22 | 2016-11-02 | 萨基姆防卫安全 | 惯性单元的校准方法 |
CN103942401A (zh) * | 2014-05-14 | 2014-07-23 | 哈尔滨工业大学 | 一种优化高精度自适应模块化的航天器弹道多约束轨迹工具包及方法 |
CN105468007A (zh) * | 2015-12-02 | 2016-04-06 | 哈尔滨工业大学 | 一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法 |
US20170308100A1 (en) * | 2016-04-25 | 2017-10-26 | Uvionix Aerospace Corporation | System and method for automated landing of an unmanned aerial vehicle |
Cited By (21)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108803649A (zh) * | 2018-08-22 | 2018-11-13 | 哈尔滨工业大学 | 一种垂直起降重复使用运载器自抗扰滑模控制方法 |
CN108803649B (zh) * | 2018-08-22 | 2019-07-09 | 哈尔滨工业大学 | 一种垂直起降重复使用运载器自抗扰滑模控制方法 |
CN110673616A (zh) * | 2019-08-30 | 2020-01-10 | 张超凡 | 基于自适应滑模的固定翼无人机有限时间容错控制方法 |
CN110794863A (zh) * | 2019-11-20 | 2020-02-14 | 中山大学 | 一种控制性能指标可定制的重型运载火箭姿态控制方法 |
CN110794863B (zh) * | 2019-11-20 | 2021-05-28 | 中山大学 | 一种控制性能指标可定制的重型运载火箭姿态控制方法 |
CN111290421A (zh) * | 2020-03-20 | 2020-06-16 | 湖南云顶智能科技有限公司 | 一种考虑输入饱和的高超声速飞行器姿态控制方法 |
CN111409869A (zh) * | 2020-04-10 | 2020-07-14 | 湖南云顶智能科技有限公司 | 可重复使用运载火箭一子级回收容错控制方法 |
CN111506113A (zh) * | 2020-05-15 | 2020-08-07 | 中国人民解放军国防科技大学 | 飞行器制导指令计算方法、侧滑角计算方法及制导方法 |
CN111506113B (zh) * | 2020-05-15 | 2023-06-06 | 中国人民解放军国防科技大学 | 飞行器制导指令计算方法、侧滑角计算方法及制导方法 |
CN112631317A (zh) * | 2020-11-26 | 2021-04-09 | 航天科工火箭技术有限公司 | 一种运载火箭的控制方法、装置及计算机可读存储介质 |
CN112835372A (zh) * | 2020-11-30 | 2021-05-25 | 天津大学 | 四旋翼无人机的固定时间控制方法 |
CN112835372B (zh) * | 2020-11-30 | 2024-05-07 | 天津大学 | 四旋翼无人机的固定时间控制方法 |
CN112650291B (zh) * | 2020-12-21 | 2022-04-15 | 北京理工大学 | 基于rcs推力器的飞行器快速姿态控制系统 |
CN112650291A (zh) * | 2020-12-21 | 2021-04-13 | 北京理工大学 | 基于rcs推力器的飞行器快速姿态控制系统 |
CN112859600A (zh) * | 2021-01-08 | 2021-05-28 | 航天时代飞鸿技术有限公司 | 一种基于扩张状态观测器的机械系统有限时间控制方法 |
CN112859600B (zh) * | 2021-01-08 | 2024-02-09 | 航天时代飞鸿技术有限公司 | 一种基于扩张状态观测器的机械系统有限时间控制方法 |
CN112650303A (zh) * | 2021-01-20 | 2021-04-13 | 南京航空航天大学 | 一种基于固定时间技术的无人机编队容错控制方法 |
CN113064349A (zh) * | 2021-03-22 | 2021-07-02 | 中国人民解放军国防科技大学 | 固定时间收敛的非线性平台滑模控制方法、装置及系统 |
CN113110512A (zh) * | 2021-05-19 | 2021-07-13 | 哈尔滨工程大学 | 一种减弱未知干扰与抖振影响的可底栖式auv自适应轨迹跟踪控制方法 |
CN113110512B (zh) * | 2021-05-19 | 2022-08-26 | 哈尔滨工程大学 | 一种减弱未知干扰与抖振影响的可底栖式auv自适应轨迹跟踪控制方法 |
CN113742840A (zh) * | 2021-08-17 | 2021-12-03 | 航天科工火箭技术有限公司 | 垂直起降可重复使用运载器试验样机快速弹道迭代计算法 |
Also Published As
Publication number | Publication date |
---|---|
CN109189087B (zh) | 2020-07-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109189087A (zh) | 一种垂直起降重复使用运载器的自适应容错控制方法 | |
CN108646778B (zh) | 一种垂直起降重复使用运载器的非线性自抗扰控制方法 | |
CN108803649B (zh) | 一种垂直起降重复使用运载器自抗扰滑模控制方法 | |
CN109597303B (zh) | 一种复合式旋翼飞行器全模式飞行控制方法 | |
CN106997208B (zh) | 一种面向不确定条件下的高超声速飞行器的控制方法 | |
CN104950898B (zh) | 一种再入飞行器全阶非奇异终端滑模姿态控制方法 | |
CN104155990B (zh) | 考虑攻角约束的高超声速飞行器俯仰通道姿态控制方法 | |
CN104950901B (zh) | 无人直升机姿态误差有限时间收敛非线性鲁棒控制方法 | |
CN107608367A (zh) | 多变量干扰补偿四旋翼无人机轨迹与姿态协同控制方法 | |
CN108803317A (zh) | 自适应多变量四旋翼无人机有限时间容错控制方法 | |
CN110162933B (zh) | 一种共轴多旋翼仿真方法及系统 | |
CN111367182A (zh) | 考虑输入受限的高超声速飞行器抗干扰反步控制方法 | |
CN112180960A (zh) | 一种面向执行器故障的无人机容错飞行方法及飞行系统 | |
CN108873929A (zh) | 一种固定翼飞机自主着舰方法及系统 | |
CN109164708B (zh) | 一种高超声速飞行器神经网络自适应容错控制方法 | |
CN110320927A (zh) | 智能变形飞行器的飞行控制方法及系统 | |
CN106527128B (zh) | 兼顾瞬态响应与鲁棒稳定性的飞行控制律设计方法 | |
CN107515612A (zh) | 基于侧喷流控制的弹性振动抑制方法 | |
CN111831002A (zh) | 一种基于预设性能的超高声速飞行器姿态控制方法 | |
de Vries et al. | Backstepping based nested multi-loop control laws for a quadrotor | |
Li et al. | Attitude tracking control of an airborne wind energy system | |
CN114721266A (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
Hussein et al. | Modeling and control of quadrotor systems | |
Choi et al. | Aircraft longitudinal auto-landing guidance law using time delay control scheme | |
Liu et al. | Actuator fault tolerant control based on neuroadaptive smc for quadrotor UAVs |
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 |