法律状态公告日
法律状态信息
法律状态
2019-07-05
未缴年费专利权终止 IPC(主分类):G05D1/08 授权公告日:20180525 终止日期:20180715 申请日:20150715
专利权的终止
2018-05-25
授权
授权
2016-02-10
实质审查的生效 IPC(主分类):G05D1/08 申请日:20150715
实质审查的生效
2016-01-13
公开
公开
技术领域
本发明涉及一种有限时间收敛时变滑模再入飞行器姿态控制方法,尤其涉及一种基于高阶滑模观测器的有限时间收敛的时变滑模再入飞行器姿态控制方法,属于飞行器姿态控制技术领域。
背景技术
再入飞行器姿态控制设计问题由于再入飞行过程中飞行条件变化范围大,各通道间耦合严重,强烈的非线性动态特性,各种不确定外部扰动及不确定参数的存在,而变得异常复杂。再入式飞行器控制系统的设计关键是要解决上述强非线性、强耦合、快时变和不确定性对系统性能的影响。
滑模控制具有全局收敛,易实现,对外部扰动强鲁棒,对参数变化和模型误差不敏感的特点,这使得它广泛应用在飞行器姿态控制中。滑模控制通过控制器的输出使得系统状态沿着滑模面收敛到平衡点。控制过程可以分为到达段和滑动段。到达段鲁棒性差,而滑动段存在高频抖振。这是滑模控制存在的两大缺点。
高频抖振现象可能会导致低精度甚至状态的不稳定。为了降低抖振,有学者采用了边界层技术,能够很好地抑制抖振现象,采用光滑的连续函数代替饱和函数,虽然抖振现象得到抑制,但是降低了精确度。也有学者将控制量以积分的形式给出,消除了抖振现象,而且保留了系统的强鲁棒性和高精确度,然而控制律中涉及到的高阶项在工程实际应用中是不容易获得的。除此之外,还可以采用低通滤波器来消除由切换控制引起的抖振,得到了较好的控制效果。
针对到达段鲁棒性不足,有人中提出了时变滑模的概念,使系统的初始状态就在滑模面上,因此消除了到达段,增强了系统的鲁棒性。A.Bartoszewicz分别给出含有等速度时变项、等加速度时变项、指数时变项的三种时变滑模面。这三种滑模面消除了到达段从而使得系统全局收敛。有学者通过在普通滑模的基础上引入非线性项,保证全局滑模存在的同时还使得系统误差在设定时刻收敛到零。上面两种方法中由于时变函数可能在设定的收敛时刻是非连续的,因而控制量会在该时刻出现跳变。进一步改进了时变项,有学者增加了时变函数的次数,有效地解决了控制量在收敛时刻跳变的问题。但是,这样会缩小时变项的选择范围,增加计算量。
发明内容
针对现有技术存在的鲁棒性差、高频抖振、以及加入时变项可能引起的跳变问题。本发明公开的一种有限时间收敛的时变滑模姿态控制设计方法,要解决的技术问题是使得再入飞行器姿态控制跟踪误差能够在有限时间内收敛到0,并且能够消除由于时变项的一阶导数不连续造成的跳变现象,减弱高频振动,且能提高再入飞行器姿态控制系统鲁棒性。
本发明的目的是通过以下技术方案实现的:
本发明公开的一种有限时间收敛时变滑模姿态控制方法,在再入飞行器模型反馈线性化的基础上,基于低通滤波器减弱高频振动,通过引入时变项可消除滑模控制的到达段,增强了系统的鲁棒性,并且可消除时变函数一阶导数不连续而引起的跳变问题。
已有技术中滑模控制分为到达段与滑动段,本发明通过引入时变项可消除滑模控制的到达段,直接进入滑动段。
本发明公开的一种有限时间收敛时变滑模姿态控制方法,具体包括如下步骤:
步骤1,生成飞行器的状态向量。
结合飞行器的实际姿态角Ω=[α,β,μ]T,姿态角速度ω=[p,q,r]T,组成状态向量x:x=[αβμpqr]T。
步骤2,建立再入飞行器动态模型。
考虑无动力再入飞行器的姿态控制问题。采用倾斜转弯(BTT)控制,其姿态运动学方程为:
>
>
>
姿态动力学方程为:
>
>
>
式中,α,β,μ分别为攻角、侧滑角和倾侧角;ωx,ωy,ωz分别为滚转、偏航和俯仰角速度;Ixx,Iyy,Izz和Ixy分别为关于x,y,z轴的转动惯量和惯量积(假设飞行器关于x-o-y平面对称,故Ixz=Iyz=0),
Mi=qSlCmi(α,β,Ma,δe,δa,δr),i=x,y,z(3)
其中,动压q=0.5ρV2,ρ为大气密度,V为飞行器速度;S,l分别为飞行器参考面积和参考长度;δe,δa,δr分别为升降舵、副翼和方向舵偏转角;Cmx,Cmy,Cmz分别为关于α,β,Ma,δe,δa,δr的滚转、偏航和俯仰力矩系数,Ma为飞行器的马赫数。
步骤3,对步骤1建立的模型进行反馈线性化处理,提出有限时间姿态跟踪任务。
将系统模型写为MIMO非线性仿射系统的形式:
>
运用反馈线性化理论,对系统输出求导直至输出动态方程中出现控制量u,并引入辅助控制量v。将系统解耦成如下的不确定二阶系统:
>
其中△v=[△v1,△v2,△v3]T表示飞行过程中系统中存在的聚合扰动,假设该扰动有界。
提出有限时间姿态跟踪任务为:系统状态从任意初值出发,在期望的时刻(tf)跟踪上参考轨迹,并在该时刻之后,跟踪误差一直保持为0。即Ω1-Ω1d=0,t≥tf。定义跟踪误差如下:
>
式中Ω1是再入飞行器的姿态角,Ω1d是姿态角指令。
步骤4,设计高阶滑模观测器。
将再入飞行器模型展开为如下的形式:
>
>
根据再入飞行器模型展开形式可以设计出高阶滑模观测器,可以同时估计姿态角导数和系统中存在的聚合扰动。
>
>
>
>
>
>
>
式中γ1,γ2,γ3,γ4>0为观测器的待定系数;χ1=[χ11,χ12,χ13]T,χ2=[χ21,χ22,χ23]T;
对于上述高阶滑模观测器,假设系统的状态向量ζ和控制量v是可测的,则通过选择合适的参数γ1,γ2,γ3,γ4可使得状态观测值以及聚合扰动估计值在有限时间内收敛到其真实值,满足分离定理,因此控制器与观测器可分开设计。
步骤5,设计有限时间收敛的时变滑模控制律。
步骤5.1,设计有限时间收敛时变滑模函数。
设计有限时间收敛的时变滑模为:
>
上式满足q,r为正奇数,ε为任意正常数,且满足0.5<q/r=p<1,c>ε,k>a,其中,a的表达式为:
>
当S(t)=0,t≥t0时,系统状态会在有限时间t1收敛到0,且:
>
W(t)是连续时变函数:
>
其中,t2是时变项W(t)收敛到0的时刻。时变项的选择应当满足条件C1、C2:
>
C2W(t2)=0
条件C1表示系统的状态从初始时刻就保持在滑模面上;条件C2表示时变滑模面在时刻t2的变化是光滑的,没有突变。根据上述条件C1、C2,可以设计如下时变函数:
W1(t)=At+B(8)
式中,B=W1(0),A=-B/t2。由此可知滑模面会以恒速度A趋近期望的滑模面。
由于存在时变项W(t),系统状态从初始时刻就保持在滑模面上,实现全局收敛。系统性能得到提升。并且可知收敛时间
>
由于公式(6)中加入时变项可消除滑模控制的到达段,因此系统从初始时刻就进入滑动段,增强了系统的鲁棒性。
步骤5.2,设计有限时间收敛时变滑模控制律。
根据步骤5.1可得控制器的输出:
v=veq+vsw(10)
>
vsw+Tvsw=un(12)
un=-(Kd+Kt+η)sgn(S)(13)
其中Kt=diag{kt,1,kt,2,kt,3}和η=diag{η1,η2,η3}是待定正系数矩阵;T=[T1,T2,T3]T是常值矩阵,且要满足Kt,i≥Tild,i,i=1,2,3。式(12)可以写为一低通滤波器的形式:
>
该低通滤波器可以很好地减弱切换项引起的抖振问题。
式(11)在计算等效控制时,没有对滑模面求导,因此可消除时变函数一阶导数不连续而引起的跳变问题。
步骤6,控制分配,得到舵偏角指令δ=[δeδaδr]T
根据公式(15)和(16)得到舵偏角指令δ=[δeδaδr]T:
u=M=E-1(x)(-F(x)+v)(15)
δ=G-1u(10)(16)
分配至舵面执行机构,由公式(16)得到δ=[δeδaδr]T,δe,δa,δr分别为升降舵、副翼、方向舵的偏角。M=[Mx,My,Mz]是由步骤5.2中得到的姿态控制输出v计算得到的控制力矩,G是转换矩阵,由气动参数决定。
步骤7,将步骤6得到的舵偏角指令输入飞行器,对其进行姿态控制;同时,飞行器输出当前飞行器的各个状态α,β,μ,p,q,r作为姿态控制的输入,重复步骤1至步骤6,从而使得飞行器实现实际姿态角Ω=[α,β,μ]T跟踪制导系统给出的姿态角指令Ωc=[αc,βc,μc]T的目的。
有益效果:
1、本发明可实现再入飞行器的姿态角误差能够有限时间内收敛到0,并且有较高的精度,并可提高收敛速度。
2、本发明采用低通滤波器减弱了切换控制导致的高频振动问题。
3、本发明采用时变滑模,使系统状态从初始时刻就保持在滑模面上,增强了系统的鲁棒性,并且消除了由于时变项一阶导数不连续引起的控制量跳变现象。
附图说明
图1为本发明的一种有限时间收敛的时变滑模姿态控制方法的流程图;
图2为本发明的再入飞行器姿态控制系统结构图;
图3为具体实施方式中加扰动时,有限时间收敛的时变滑模控制器控制时的姿态角跟踪曲线图;
图4为具体实施方式中加扰动时,有限时间收敛的时变滑模控制器控制时的姿态角跟踪曲线在11~15s的放大图;
图5为具体实施方式中加扰动时,有限时间收敛的时变滑模控制器控制时的舵面偏转曲线图;
图6为具体实施方式中加扰动时,有限时间收敛的时变滑模控制器控制时的滑模面曲线图;
图7为加扰动时,采用边界层技术的传统时变滑控制器控制时的姿态角跟踪曲线图;
图8为加扰动时,采用边界层技术的传统时变滑控制器控制时的姿态角跟踪曲线在11~15s的放大图;
图9为加扰动时,采用边界层技术的传统时变滑控制器控制时的舵面偏转曲线图;
图10为加扰动时,采用边界层技术的传统时变滑控制器控制时的滑模面曲线图;
图11为存在外部扰动和参数摄动时使用传统时变滑模飞行器姿态控制方法并且采用边界层消抖技术的滑模面曲线图。
具体实施方式
为了更好地说明本发明的目的和优点,下面结合附图和实例对技术方案做进一步详细的说明
实施例1:
以NASA公布的Winged-Cone构型的高超声速模型为仿真平台,针对其再入飞行过程进行数值仿真。仿真中,初始高度为28km,速度为2800m/s,姿态角初始值为[3120]deg,期望的姿态角为[000]deg。初始姿态角速度为0。
由于再入飞行器飞行条件大范围变化,且常常具有气动参数摄动等不确定性,因此,对于再入飞行器的姿态控制问题,不仅要检验标称情况下的控制性能,还需要检验控制器在环境参数剧烈变化和系统具有较强不确定性情况下,能否进行鲁棒、精确地控制。为了进一步验证系统的鲁棒性,添加大外部扰动(直接施加于三轴的控制力矩上)d=[d1,d2,d3]T:
通过将本实施例公开的一种有限时间收敛时变滑模姿态控制方法给出的控制结果与传统时变滑模控制方法给出的控制结果进行对比,说明本发明的有益效果。
本实施例公开的一种有限时间收敛时变滑模姿态控制方法,包括如下步骤:
步骤1,生成飞行器的状态向量。
结合飞行器的实际姿态角Ω=[α,β,μ]T,姿态角速度ω=[p,q,r]T,组成状态向量x:x=[αβμpqr]T。
步骤2,建立再入飞行器动态模型。
考虑无动力再入飞行器的姿态控制问题。采用倾斜转弯(BTT)控制,其姿态运动学方程为:
>
>
>
姿态动力学方程为:
>
>
>
式中,α,β,μ分别为攻角、侧滑角和倾侧角;ωx,ωy,ωz分别为滚转、偏航和俯仰角速度;Ixx,Iyy,Izz和Ixy分别为关于x,y,z轴的转动惯量和惯量积(假设飞行器关于x-o-y平面对称,故Ixz=Iyz=0),
Mi=qSlCmi(α,β,Ma,δe,δa,δr),i=x,y,z(3)
其中,动压q=0.5ρV2,ρ为大气密度,V为飞行器速度;S,l分别为飞行器参考面积和参考长度;δe,δa,δr分别为升降舵、副翼和方向舵偏转角;Cmx,Cmy,Cmz分别为关于α,β,Ma,δe,δa,δr的滚转、偏航和俯仰力矩系数,Ma为飞行器的马赫数。
步骤3,对步骤1建立的模型进行反馈线性化处理,提出有限时间姿态跟踪任务。
将系统模型写为MIMO非线性仿射系统的形式:
>
运用反馈线性化理论,对系统输出求导直至输出动态方程中出现控制量u,并引入辅助控制量v。将系统解耦成如下的不确定二阶系统:
>
其中△v=[△v1,△v2,△v3]T表示飞行过程中系统中存在的聚合扰动,假设该扰动有界。
提出有限时间姿态跟踪任务为:系统状态从任意初值出发,在期望的时刻(tf)跟踪上参考轨迹,并在该时刻之后,跟踪误差一直保持为0。即Ω1-Ω1d=0,t≥tf。定义跟踪误差如下:
>
式中Ω1是再入飞行器的姿态角,Ω1d是姿态角指令。
步骤4,设计高阶滑模观测器。
将再入飞行器模型展开为如下的形式:
>
>
根据再入飞行器模型展开形式可以设计出高阶滑模观测器,可以同时估计姿态角导数和系统中存在的聚合扰动。
>
>
>
>
>
>
>
式中γ1,γ2,γ3,γ4>0为观测器的待定系数;χ1=[χ11,χ12,χ13]T,χ2=[χ21,χ22,χ23]T;△v分别是ζ0,ζ1,△v的估计值。
由图7可知,聚合扰动估计值在有限时间内收敛到其真实值,满足分离定理,因此控制器与观测器可分开设计。
步骤5,设计有限时间收敛的时变滑模控制律。
步骤5.1,设计有限时间收敛时变滑模函数。
设计有限时间收敛的时变滑模为:
>
上式满足q,r为正奇数,ε为任意正常数,且满足0.5<q/r=p<1,c>ε,k>a,其中,a的表达式为:
>
当S(t)=0,t≥t0时,系统状态会在有限时间t1收敛到0,且:
>
W(t)是连续时变函数:
>
其中,t2是时变项W(t)收敛到0的时刻。时变项的选择应当满足条件C1、C2:
>
C2W(t2)=0
条件C1表示系统的状态从初始时刻就保持在滑模面上;条件C2表示时变滑模面在时刻t2的变化是光滑的,没有突变。根据上述条件C1、C2,可以设计如下时变函数:
W1(t)=At+B(8)
式中,B=W1(0),A=-B/t2。由此可知滑模面会以恒速度A趋近期望的滑模面。
由于存在时变项W(t),系统状态从初始时刻就保持在滑模面上,实现全局收敛。系统性能得到提升。并且可知收敛时间
>
由于公式(6)中加入时变项可消除滑模控制的到达段,因此系统从初始时刻就进入滑动段,增强了系统的鲁棒性。
步骤5.2,设计有限时间收敛时变滑模控制律。
根据步骤5.1可得控制器的输出:
v=veq+vsw(10)
>
vsw+Tvsw=un(12)
un=-(Kd+Kt+η)sgn(S)(13)
其中Kt=diag{kt,1,kt,2,kt,3}和η=diag{η1,η2,η3}是待定正系数矩阵;T=[T1,T2,T3]T是常值矩阵,且要满足Kt,i≥Tild,i,i=1,2,3。式(12)可以写为一低通滤波器的形式:
>
该低通滤波器可以很好地减弱切换项引起的抖振问题。
式(11)在计算等效控制时,没有对滑模面求导,因此可消除时变函数一阶导数不连续而引起的跳变问题。
步骤6,控制分配,得到舵偏角指令δ=[δeδaδr]T
根据公式(15)和(16)得到舵偏角指令δ=[δeδaδr]T:
u=M=E-1(x)(-F(x)+v)(15)
δ=G-1u(10)(16)
分配至舵面执行机构,由公式(16)得到δ=[δeδaδr]T,δe,δa,δr分别为升降舵、副翼、方向舵的偏角。M=[Mx,My,Mz]是由步骤5.2中得到的姿态控制输出v计算得到的控制力矩,G是转换矩阵,由气动参数决定。
步骤7,将步骤6得到的舵偏角指令输入飞行器,对其进行姿态控制;同时,飞行器输出当前飞行器的各个状态α,β,μ,p,q,r作为姿态控制的输入,重复步骤1至步骤6,从而使得飞行器实现实际姿态角Ω=[α,β,μ]T跟踪制导系统给出的姿态角指令Ωc=[αc,βc,μc]T的目的。
通过将本实施例公开的一种再入飞行器有限时间收敛的时变滑模姿态控制方法给出的控制结果与传统时变滑模姿态控制方法给出的控制结果进行对比,说明本实施例的优点。
①验证本实施例的一种有限时间收敛时变滑模姿态控制方法能够在有限时间内使误差收敛到0。
图3给出了存在外部扰动和参数摄动时使用本实施例的一种有限时间收敛时变滑模姿态控制方法的姿态角跟踪曲线。图4是图3在11~15s的放大图,系统误差保持为0。由图3、4可知,采用本实施例的方法,系统误差能够在有限时间内收敛到0。图7给出了存在外部扰动和参数摄动时使用传统时变滑模飞行器姿态控制方法并且采用边界层消抖技术的姿态角跟踪曲线图。图8是图7在11~15s的放大图,系统误差非0。由图8、9可知,采用传统时变滑模控制方法,系统误差收敛,但是不能够收敛到0。由此表明,有限时间收敛的时变滑模控制方法与传统时变滑模方法相比,能够使得系统跟踪误差在有限时间内收敛到0,提高了跟踪速度与精度。
②验证本实施例的一种有限时间收敛时变滑模姿态控制方法能够减弱控制量抖振的问题。
图5给出了在存在外界扰动和参数摄动时使用本实施例的一种有限时间收敛时变滑模姿态控制方法的舵面偏转曲线图。由图5可知,舵面偏转曲线光滑无抖振。图10给出了存在外部扰动和参数摄动时使用传统时变滑模飞行器姿态控制方法并且采用边界层消抖技术的舵面偏转曲线图。由图9可知,采用传统时变滑模控制方法,舵面偏转曲线除了在2s的时候有跳变外,都是光滑的。由此表明,本实施例能够在保持高精度的同时,保持舵面偏转平滑。
③验证本实施例的一种有限时间收敛时变滑模姿态控制方法能够使系统的状态从一开始就保持在滑模面上,并且克服了由于时变项的一阶导数不连续引起的控制量跳变现象,增强了系统的鲁棒性。
图5给出了在存在外界扰动和参数摄动时使用本实施例的一种有限时间收敛时变滑模姿态控制方法的舵面偏转曲线图。图6给出了在存在外界扰动和参数摄动时使用本实施例的一种有限时间收敛时变滑模姿态控制方法的滑模面曲线图。由图5、6可知,本实施例的系统状态从一开始就保持在滑模面上,并且控制量没有跳变现象。图10给出了存在外部扰动和参数摄动时使用传统时变滑模飞行器姿态控制方法并且采用边界层消抖技术的舵面偏转曲线图。图11给出了存在外部扰动和参数摄动时使用传统时变滑模飞行器姿态控制方法并且采用边界层消抖技术的滑模面曲线图。由图10、11可知,采用传统时变滑模控制方法,系统状态能够从初始时刻就保持在滑模面上,然而,舵面偏转在2s的时候有跳变现象产生。由此表明,本实施例能够在保持传统时变滑模控制的优点的同时,能够避免由于时变项的一阶导数不连续导致的跳变现象,增强了系统的鲁棒性。
本发明保护范围不仅局限于实施例,实施例用于解释本发明,凡与本发明在相同原理和构思条件下的变更或修改均在本法民公开保护范围之内。
机译: 在有限时间内具有终端收敛性的滑模控制方法
机译: 基于有限时间摩擦估计的挠性航天器姿态控制方法
机译: 一种用于水下车辆的模型预测控制器的姿态和姿态控制方法