首页 > 专利 > 金陵科技学院 > 一种输入输出饱和的飞行器鲁棒控制方法专利详情

一种输入输出饱和的飞行器鲁棒控制方法   0    0

有效专利 查看PDF
专利申请流程有哪些步骤?
专利申请流程图
申请
申请号:指国家知识产权局受理一件专利申请时给予该专利申请的一个标示号码。唯一性原则。
申请日:提出专利申请之日。
2017-06-27
申请公布
申请公布指发明专利申请经初步审查合格后,自申请日(或优先权日)起18个月期满时的公布或根据申请人的请求提前进行的公布。
申请公布号:专利申请过程中,在尚未取得专利授权之前,国家专利局《专利公报》公开专利时的编号。
申请公布日:申请公开的日期,即在专利公报上予以公开的日期。
2017-10-27
授权
授权指对发明专利申请经实质审查没有发现驳回理由,授予发明专利权;或对实用新型或外观设计专利申请经初步审查没有发现驳回理由,授予实用新型专利权或外观设计专利权。
2020-05-26
预估到期
发明专利权的期限为二十年,实用新型专利权期限为十年,外观设计专利权期限为十五年,均自申请日起计算。专利届满后法律终止保护。
2037-06-27
基本信息
有效性 有效专利 专利类型 发明专利
申请号 CN201710500505.8 申请日 2017-06-27
公开/公告号 CN107203138B 公开/公告日 2020-05-26
授权日 2020-05-26 预估到期日 2037-06-27
申请年 2017年 公开/公告年 2020年
缴费截止日
分类号 G05B13/04 主分类号 G05B13/04
是否联合申请 独立申请 文献类型号 B
独权数量 1 从权数量 2
权利要求数量 3 非专利引证数量 1
引用专利数量 5 被引证专利数量 0
非专利引证 1、全文. 周洪成 等《.考虑执行器动态的飞行器姿态分散式容错控制》《.南昌航空大学学报: 自然科学版》.2014,第1-6页.;
引用专利 CN102880053A、CN106444368A、CN107203138A、CN102508692A、US2017153650A1 被引证专利
专利权维持 5 专利申请国编码 CN
专利事件 事务标签 公开、实质审查、授权
申请人信息
申请人 第一申请人
专利权人 金陵科技学院 当前专利权人 金陵科技学院
发明人 周洪成、刘畅 第一发明人 周洪成
地址 江苏省南京市江宁区弘景大道99号 邮编 211169
申请人数量 1 发明人数量 2
申请人所在省 江苏省 申请人所在市 江苏省南京市
代理人信息
代理机构
专利代理机构是经省专利管理局审核,国家知识产权局批准设立,可以接受委托人的委托,在委托权限范围内以委托人的名义办理专利申请或其他专利事务的服务机构。
南京钟山专利代理有限公司 代理人
专利代理师是代理他人进行专利申请和办理其他专利事务,取得一定资格的人。
戴朝荣
摘要
本发明公开了一种输入输出饱和的飞行器鲁棒控制方法,包含以下步骤:步骤一:建立近空间飞行器的姿态运动模型;步骤二:给出引理和假设;步骤三:设计二阶滑模干扰观测器对未知外部干扰进行估计,为消除外部干扰的影响;步骤四:引入系统转换技术,并设计辅助系统,借助backstepping方法进行近空间飞行器姿态鲁棒自适应控制器设计。本发明同时考虑了输入输出饱和,能够有效快速的跟踪期望信号。
  • 摘要附图
    一种输入输出饱和的飞行器鲁棒控制方法
  • 说明书附图:图1
    一种输入输出饱和的飞行器鲁棒控制方法
  • 说明书附图:图2
    一种输入输出饱和的飞行器鲁棒控制方法
  • 说明书附图:图3
    一种输入输出饱和的飞行器鲁棒控制方法
  • 说明书附图:图4
    一种输入输出饱和的飞行器鲁棒控制方法
法律状态
序号 法律状态公告日 法律状态 法律状态信息
1 2020-05-26 授权
2 2017-10-27 实质审查的生效 IPC(主分类): G05B 13/04 专利申请号: 201710500505.8 申请日: 2017.06.27
3 2017-09-26 公开
权利要求
权利要求书是申请文件最核心的部分,是申请人向国家申请保护他的发明创造及划定保护范围的文件。
1.一种输入输出饱和的飞行器鲁棒控制方法,其特征在于包含以下步骤:
步骤一:建立近空间飞行器的姿态运动模型;
所述步骤一具体为,
近空间飞行器的姿态运动模型可以表示为如下形式:
其中,姿态角向量Ω=[α,β,μ]T包含了迎角、侧滑角和滚转角,姿态角速度向量ω=[p,T T
q,r] 包含了滚转角速率、俯仰角速率和偏航角速率,控制力矩向量Mc=[lc,mc,nc]包含了滚转角、俯仰角和偏航角力矩;F1∈R3和F2∈R3为已知的系统状态函数,G1∈R3×3和G2∈R3×3为已知的系统控制矩阵,△F1∈R3和△F2∈R3为未知的光滑函数,d1∈R3和d2∈R3代表外部扰动;
由近空间飞行器的动力学特性可知,外部扰动多作用在系统力矩上,因此将所有干扰等效为力矩扰动,即只考虑干扰d2,同时将不确定项△F2与力矩干扰综合考虑为复合干扰,系统(1)可以改写为如下形式:
其中D=[D1,D2,D3]T=△F2(Ω,ω)+d2为未知的复合干扰,sat(·)是标准的饱和函数,满足:
sat(ui)=sgn(ui)min{umaxi,|ui|},i=1,2,3        (3)
其中umaxi表示系统第i个输入的已知饱和度;
另外,系统输出向量y也存在输出约束,即满足:
yli≤yi≤yui,i=1,2,
3.                (4)
其中,yl=[yl1,yl2,yl3]T和yu=[yu1,yu2,yu3]T分别代表系统输出的下界和上界约束;
步骤二:给出引理和假设;
步骤三:设计二阶滑模干扰观测器对未知外部干扰进行估计,为消除外部干扰的影响;
步骤四:引入系统转换技术,并设计辅助系统,借助backstepping方法进行近空间飞行器姿态鲁棒自适应控制器设计;
所述步骤四中系统转换技术包含,
定义跟踪误差为e(t)=y-yd,根据式(4)可知,跟踪误差满足:
yli-ydi≤ei(t)≤yui-ydi,i=1,2,3         (21)
定义e=[e1,e2,e3]T, ei=yli-ydi<0,
因此,式(21)可以改写为:
从而系统输出饱和问题转换为误差约束问题;为了将受约束的误差信号转换为无约束的信号,引入误差转换函数
或者
其中ξ=[ξ1,ξ2,ξ3]T无约束的转换信号;
由式(23),可以得到如下性质:
另外又由 可知,系统跟踪误差和转换信号存在着严格的递增关系,因
此,根据式(25)的性质可知,当转换信号有界时,系统原误差满足式(26)的约束条件;
下面,证明转换信号ξ的有界性;
由 和一般函数的性质可知,转换信号ξi关于系统原误差ei的偏导数满足因此定义函数 为如下形式:
从而可知函数 为可逆正定矩阵;
根据系统(2)和误差的定义,对误差信号e(t)进行求导可得:
由上式及式(24)和(26)可得,对转换信号ξ进行求导可得:
其中 由于系统输出饱和边界 e,跟踪误差e及转换信号ξ均已知,
函数 也可以直接获得的,作为已知量使用;
综合上述分析,可以得到如下新的转化动态系统
所述步骤四中,近空间飞行器姿态鲁棒自适应控制器设计具体为,
未消除输入饱和对控制器性能的影响,设计如下形式的辅助系统Σ=[σ1,σ2]T [22]:
其中σ1∈R3,σ2∈R3为辅助系统状态向量,C1,C2为正定设计矩阵,分别满足其中a1>0为设计参数;
定义误差变量:
其中z1=[z11,z12,z13]T,z2=[z21,z22,z23]T;
由系统(29)和(30),对z1求导可得:
由于系统中存在不确定项△F1,引入神经网络对其进行逼近,采用RBF神经网络来逼近该不确定项,其最佳逼近可以写为:
其中W1*∈Rp×3位权值矩阵,S(Ω)∈Rp为基函数向量,最优逼近误差
从而式(32)改写为
又由变量z2的定义,上式可写为
设计虚拟控制律α1为如下形式:
其中 为设计矩阵,
*
b11>0,b12>0,b13>0, 为W1的逼近值,为逼近误差 的估计值,其自适应律设计为:
其中δ1>0;
定义神经网络参数逼近误差为 将设计的虚拟控制律α1入式(35)可得:
选取Lyapunov函数为
其中 为正定矩阵,定义自适应估计误差 根据式(38),对V1进行求
导可得:
自适应律设计为:
其中ρ1>0为设计参数,同时由引理1可得:
另有:
其中a1>0为设计参数。
因此根据式(40)-(44)及假设2可得:
其中
另有
因此,式(46)可以改写为:
根据系统(29)和(30),对变量z2进行求导可得:
由于复合干扰D的存在,使用式(6)所设计的干扰观测器对其进行逼近;设估计误差 有界,即 其中
设计控制器Mc为如下形式:
其中 为设计矩阵,
b11>0,b12>0,b13>0。 为估计误差 的估计值,其自适应律设计为:
其中δ2>0为设计参数。
将控制器Mc带入式(46)可得:
选取Lyapunov函数为:
定义估计误差 根据式(51),对V2进行求导可得:
引理1可得:
可得
又根据假设2和假设3可得:
综合式(23),(47)和(53)-(56)可得:
其中
因此,由Lyapunov稳定性理论可知,闭环系统信号z1,z2,估计误差 及神经网络参数逼近误差 及辅助系统变量σ1 ,σ2均半全局一致有界;由式(57)可知
因此根据式(31)变量z1的定义可得:
从而可知转换信号ξ范数有界,根据性质(29)及系统跟踪误差与转换信号之间的严格递增关系,可知转换信号ξ的有界性可以保证跟踪误差约束性能(26)的成立;因此,根据跟踪误差e(t)的定义可知,系统输出y满足约束条件(4)。

2.按照权利要求1所述的一种输入输出饱和的飞行器鲁棒控制方法,其特征在于:所述步骤二的引理和假设包含,
引理1:对于任意常数b>0,变量 下面的不等式总是成立:
其中ζ=0.2785为常数;
假设1:对于近空间飞行器姿态模型(2),复合干扰D满足||D(i)||≤τi,其中τi>0,i=0,
1,2;
假设2:对于近空间飞行器姿态模型(2),增益矩阵G1和G2均可逆,同时存在着未知正常数 使得
假设3:对于近空间飞行器姿态系统(2),△u范数有界,即||△u||≤η,其中△u=sat(u)-u,η为未知正实数;
假设4:对于近空间飞行器姿态系统(2),期望信号yd满足 其中

3.按照权利要求2所述的一种输入输出饱和的飞行器鲁棒控制方法,其特征在于:所述步骤三具体为,
干扰观测器设计为如下形式:
其中L1=diag{L11,L12,L13},s=[s1,s2,s3]T,L2=diag{L21,L22,L23},L3=diag{L31,L32,L33},sgn(s)=[sgn(s1),sgn(s2),sgn(s3)]T;
定义干扰估计误差 由上式可以看出
同时引入滤波误差变量
参考式(6)和式(7),对其进行求导可得:
定义 Μ=[Μ1,Μ2,Μ3]T,由假设1可知Μ和 均有界,即||Μ||≤τ3,
其中τ3>0,τ4>0;因此式(9)可以改写为:
选择Lyapunov函数VS为:
对VS进行求导可得:
又知si sgn(si)=|si|,因此对上式两边同时求积分可得:
其中
将式(13)改写为:
其中
另有||Μ||≤τ3, 因此通过选择
使得o1为小于或者等于零的变量,从而有
又根据式(18)可得
0因此S∈L∞,另外由式(18)可得
因此S∈L2,因此由式(8)的定义可知, 又由Μ有界及式(10)可知 从而由S∈L∞, 及S∈L2可得||S||→0,因此 即干扰估计误差
说明书

技术领域

[0001] 本发明设计一种飞行器鲁棒控制方法,特别是一种输入输出饱和的飞行器鲁棒控制方法。

背景技术

[0002] 与传统航空飞行器相比,近空间飞行器飞行主要的飞行空域为20-100km,从而造成其飞行环境多变;又由于其特殊物理特性,造成飞行速度变化范围大,这些特性都使得近空间飞行器成为一个复杂的不确定非线性系统,对其控制系统的设计也提出了较大的挑战。近年来,已经有多种非线性控制方法得到了发展,如滑模控制,基于鲁棒性或自适应性的控制和预测控制等,并大量应用于进空间飞行器。
[0003] 与其他实际物理系统一样,近空间飞行器在控制舵面及发动机推力上存在着诸多的物理限制,如幅值,带宽,偏转速度等,导致了控制输入和系统部分状态受到约束,又由近空间飞行器的特性可知,受约束的控制输入会导致系统部分或全部输出也受到约束,从而导致控制系统中输入输出饱和问题的产生。如果在控制系统的设计过程中,不考虑该问题的影响,会严重影响控制器性能。
[0004] 目前,针对近空间飞行器中输入饱和问题已经有了部分研究。现有技术未有相关文献在近空间飞行器控制系统设计与研究中同时考虑存在输入输出饱和。另外,由于近空间飞行器多变的飞行环境,不可避免会受到外部扰动的影响。

发明内容

[0005] 本发明所要解决的技术问题是提供一种输入输出饱和的飞行器鲁棒控制方法。
[0006] 为解决上述技术问题,本发明所采用的技术方案是:
[0007] 一种输入输出饱和的飞行器鲁棒控制方法,其特征在于包含以下步骤:
[0008] 步骤一:建立近空间飞行器的姿态运动模型;
[0009] 步骤二:给出引理和假设;
[0010] 步骤三:设计二阶滑模干扰观测器对未知外部干扰进行估计,为消除外部干扰的影响;
[0011] 步骤四:引入系统转换技术,并设计辅助系统,借助backstepping方法进行近空间飞行器姿态鲁棒自适应控制器设计。
[0012] 进一步地,所述步骤一具体为,
[0013] 近空间飞行器的姿态运动模型可以表示为如下形式:
[0014]
[0015] 其中,姿态角向量Ω=[α,β,μ]T包含了迎角、侧滑角和滚转角,姿态角速度向量ωT T=[p,q,r]包含了滚转角速率、俯仰角速率和偏航角速率,控制力矩向量Mc=[lc,mc,nc] 包含了滚转角、俯仰角和偏航角力矩;F1∈R3和F2∈R3为已知的系统状态函数,G1∈R3×3和G2∈R3×3为已知的系统控制矩阵,ΔF1∈R3和ΔF2∈R3为未知的光滑函数,d1∈R3和d2∈R3代表外部扰动;
[0016] 由近空间飞行器的动力学特性可知,外部扰动多作用在系统力矩上,因此将所有干扰等效为力矩扰动,即只考虑干扰d2,同时将不确定项ΔF2与力矩干扰综合考虑为复合干扰,系统(1)可以改写为如下形式:
[0017]
[0018] 其中D=[D1,D2,D3]T=ΔF2(Ω,ω)+d2为未知的复合干扰,sat(·)是标准的饱和函数,满足:
[0019] sat(ui)=sgn(ui)min{umaxi,|ui|},i=1,2,3                (3)[0020] 其中umaxi表示系统第i个输入的已知饱和度;
[0021] 另外,系统输出向量y也存在输出约束,即满足:
[0022] yli≤yi≤yui,i=1,2,3.            (4)
[0023] 其中,yl=[yl1,yl2,yl3]T和yu=[yu1,yu2,yu3]T分别代表系统输出的下界和上界约束。
[0024] 进一步地,所述步骤二的引理和假设包含,
[0025] 引理1:对于任意常数b>0,变量z,下面的不等式总是成立:
[0026]
[0027] 其中ζ=0.2785为常数;
[0028] 假设1:对于近空间飞行器姿态模型(2),复合干扰D满足||D(i)||≤τi,其中τi>0,i=0,1,2;
[0029] 假设2:对于近空间飞行器姿态模型(2),增益矩阵G1和G2均可逆,同时存在着未知正常数 使得
[0030] 假设3:对于近空间飞行器姿态系统(2),Δu范数有界,即||Δu||≤η,[0031] 其中Δu=sat(u)-u,η为未知正实数;
[0032] 假设4:对于近空间飞行器姿态系统(2),期望信号yd满足 其中
[0033] 进一步地,所述步骤三具体为,
[0034] 干扰观测器设计为如下形式:
[0035]
[0036] 其中L1=diag{L11,L12,L13},s=[s1,s2,s3]T,L2=diag{L21,L22,L23},L3=diag{L31,L32,L33},sgn(s)=[sgn(s1),sgn(s2),sgn(s3)]T;
[0037] 定义干扰估计误差 由上式可以看出
[0038]
[0039] 同时引入滤波误差变量
[0040]
[0041] 参考式(6)和式(7),对其进行求导可得:
[0042]
[0043] 定义 M=[M1,M2,M3]T,由假设1可知M和 均有界,即||M||≤τ3,其中τ3>0,τ4>0;因此式(9)可以改写为:
[0044]
[0045] 选择Lyapunov函数VS为:
[0046]
[0047] 对VS进行求导可得:
[0048]
[0049] 又知si sgn(si)=|si|,因此对上式两边同时求积分可得:
[0050]
[0051] 其中
[0052]
[0053] 将式(13)改写为:
[0054]
[0055] 其中
[0056]
[0057]
[0058] 另有||M||≤τ3, 因此通过选择
[0059]
[0060] 使得o1为小于或者等于零的变量,从而有
[0061]
[0062] 又根据式(18)可得
[0063] 0
[0064] 因此S∈L∞,另外由式(18)可得
[0065]
[0066] 因此S∈L2,因此由式(8)的定义可知, 又由M有界及式(10)可知 从而由S∈L∞, 及S∈L2可得||S||→0,因此 即干扰估计误差
[0067] 进一步地,所述步骤四中系统转换技术包含,
[0068] 定义跟踪误差为e(t)=y-yd,根据式(4)可知,跟踪误差满足:
[0069] yli-ydi≤ei(t)≤yui-ydi,i=1,2,3        (21)
[0070] 定义e=[e1,e2,e3]T, ei=yli-ydi<0,
[0071] 因此,式(21)可以改写为:
[0072]
[0073] 从而系统输出饱和问题转换为误差约束问题;为了将受约束的误差信号转换为无约束的信号,引入误差转换函数
[0074]
[0075] 或者
[0076]
[0077] 其中ξ=[ξ1,ξ2,ξ3]T无约束的转换信号;
[0078] 由式(23),可以得到如下性质:
[0079]
[0080] 另外又由 可知,系统跟踪误差和转换信号存在着严格的递增关系,因此,根据式(25)的性质可知,当转换信号有界时,系统原误差满足式(26)的约束条件;
[0081] 下面,证明转换信号ξ的有界性;
[0082] 由 和一般函数的性质可知,转换信号ξi关于系统原误差ei的偏导数满足[0083] 因此定义函数 为如下形式:
[0084]
[0085] 从而可知函数 为可逆正定矩阵;
[0086] 根据系统(2)和误差的定义,对误差信号e(t)进行求导可得:
[0087]
[0088] 由上式及式(24)和(26)可得,对转换信号ξ进行求导可得:
[0089]
[0090] 其中 由于系统输出饱和边界 e,跟踪误差e及转换信号ξ均已知,函数 也可以直接获得的,作为已知量使用;
[0091] 综合上述分析,可以得到如下新的转化动态系统
[0092]
[0093] 进一步地,所述步骤四中,近空间飞行器姿态鲁棒自适应控制器设计具体为,[0094] 未消除输入饱和对控制器性能的影响,设计如下形式的辅助系统Σ=[σ1,σ2]T[22]:
[0095]
[0096] 其中σ1∈R3,σ2∈R3为辅助系统状态向量,C1,C2为正定设计矩阵,分别满足其中a1>0为设计参数;
[0097] 定义误差变量:
[0098]
[0099] 其中z1=[z11,z12,z13]T,z2=[z21,z22,z23]T;
[0100] 由系统(29)和(30),对z1求导可得:
[0101]
[0102] 由于系统中存在不确定项ΔF1,引入神经网络对其进行逼近,采用RBF神经网络来逼近该不确定项,其最佳逼近可以写为:
[0103]
[0104] 其中 位权值矩阵,S(Ω)∈Rp为基函数向量,最优逼近误差
[0105]
[0106] 从而式(32)改写为
[0107]
[0108] 又由变量z2的定义,上式可写为
[0109]
[0110] 设计虚拟控制律α1为如下形式:
[0111]
[0112] 其中 为设计矩阵,
[0113]
[0114] b11>0,b12>0,b13>0, 为 的逼近值,为逼近误差 的估计值,其自适应律设计为:
[0115]
[0116] 其中δ1>0;
[0117] 定义神经网络参数逼近误差为 将设计的虚拟控制律α1入式(35)可得:
[0118]
[0119] 选取Lyapunov函数为
[0120]
[0121] 其中 为正定矩阵,定义自适应估计误差 根据式(38),对V1进行求导可得:
[0122]
[0123] 自适应律设计为:
[0124]
[0125] 其中ρ1>0为设计参数,同时由引理1可得:
[0126]
[0127] 另有:
[0128]
[0129]
[0130] 其中a1>0为设计参数。
[0131] 因此根据式(40)-(44)及假设2可得:
[0132]
[0133] 其中
[0134] 另有
[0135]
[0136]
[0137] 因此,式(46)可以改写为:
[0138]
[0139] 根据系统(29)和(30),对变量z2进行求导可得:
[0140]
[0141] 由于复合干扰D的存在,使用式(6)所设计的干扰观测器对其进行逼近;设估计误差 有界,即 其中
[0142] 设计控制器Mc为如下形式:
[0143]
[0144] 其中 为设计矩阵,
[0145]
[0146] b11>0,b12>0,b13>0。 为估计误差 的估计值,其自适应律设计为:
[0147]
[0148] 其中δ2>0为设计参数。
[0149] 将控制器Mc带入式(46)可得:
[0150]
[0151] 选取Lyapunov函数为:
[0152]
[0153] 定义估计误差 根据式(51),对V2进行求导可得:
[0154]
[0155] 引理1可得:
[0156]
[0157] 可得
[0158]
[0159] 又根据假设2和假设3可得:
[0160]
[0161] 综合式(23),(47)和(53)-(56)可得:
[0162]
[0163] 其中
[0164]
[0165] 因此,由Lyapunov稳定性理论可知,闭环系统信号z1,z2,估计误差 及神经网络参数逼近误差 及辅助系统变量σ1,σ2均半全局一致有界;由式(57)可知
[0166] 因此根据式(31)变量z1的定义可得:
[0167]
[0168] 从而可知转换信号ξ范数有界,根据性质(29)及系统跟踪误差与转换信号之间的严格递增关系,可知转换信号ξ的有界性可以保证跟踪误差约束性能(26)的成立;因此,根据跟踪误差e(t)的定义可知,系统输出y满足约束条件(4)。
[0169] 本发明与现有技术相比,具有以下优点和效果:
[0170] 1)本发明的辅助系统能够有效的抵消输入饱和的影响;
[0171] 2)本发明系统误差转换方法有效的抑制输出约束对控制性能的影响;
[0172] 3)本发明所设计的基于干扰观测器的鲁棒自适应控制器能够有效快速的跟踪期望信号。

实施方案

[0177] 下面结合附图并通过实施例对本发明作进一步的详细说明,以下实施例是对本发明的解释而本发明并不局限于以下实施例。
[0178] 如图所示,本发明的一种输入输出饱和的飞行器鲁棒控制方法,其特征在于包含以下步骤:
[0179] 步骤一:建立近空间飞行器的姿态运动模型;
[0180] 步骤二:给出引理和假设;
[0181] 步骤三:设计二阶滑模干扰观测器对未知外部干扰进行估计,为消除外部干扰的影响;
[0182] 步骤四:引入系统转换技术,并设计辅助系统,借助backstepping方法进行近空间飞行器姿态鲁棒自适应控制器设计。
[0183] 1、问题描述
[0184] 近空间飞行器的姿态运动模型可以表示为如下形式:
[0185]
[0186] 其中,姿态角向量Ω=[α,β,μ]T包含了迎角,侧滑角和滚转角,姿态角速度向量ω=[p,q,r]T包含了滚转角速率,俯仰角速率和偏航角速率,控制力矩向量Mc=[lc,mc,nc]T包含了滚转角,俯仰角和偏航角力矩。F1∈R3和F2∈R3为已知的系统状态函数。G1∈R3×3和G2∈R3×3为已知的系统控制矩阵。ΔF1∈R3和ΔF2∈R3为未知的光滑函数,代表未知的系统建模误差。d1∈R3和d2∈R3代表外部扰动,主要由力和力矩干扰组成。由近空间飞行器的动力学特性可知,外部扰动多作用在系统力矩上,因此文中将所有干扰等效为力矩扰动,即只考虑干扰d2。同时将不确定项ΔF2与力矩干扰综合考虑为复合干扰。因此系统(1)可以改写为如下形式:
[0187]
[0188] 其中D=[D1,D2,D3]T=ΔF2(Ω,ω)+d2为未知的复合干扰。sat(·)是标准的饱和函数,满足:
[0189] sat(ui)=sgn(ui)min{umaxi,|ui|},i=1,2,3                  (3)[0190] 其中umaxi表示系统第i个输入的已知饱和度。另外,一般来说系统输出向量y也存在输出约束,即满足:
[0191] yli≤yi≤yui,i=1,2,3.                              (4)
[0192] 其中,yl=[yl1,yl2,yl3]T和yu=[yu1,yu2,yu3]T分别代表系统输出的下界和上界约束。
[0193] 本文的控制目标为:针对存在着未知外部扰动和输入输出受限的近空间飞行器姿态模型,设计基于干扰观测器的鲁棒自适应控制器,从而使得系统输出y在保证所有的闭环系统信号有界的情况下能够快速跟踪期望信号yd。
[0194] 首先,为了设计控制器设计,给出如下引理和假设:
[0195] 引理1:对于任意常数b>0,变量 下面的不等式总是成立:
[0196]
[0197] 其中ζ=0.2785为常数。
[0198] 假设1:对于近空间飞行器姿态模型(2),复合干扰D满足||D(i)||≤τi,其中τi>0,i=0,1,2。
[0199] 假设2:对于近空间飞行器姿态模型(2),增益矩阵G1和G2均可逆,同时存在着未知正常数 使得
[0200] 假设3:对于近空间飞行器姿态系统(2),Δu范数有界,即||Δu||≤η,其中Δu=sat(u)-u,η为未知正实数。
[0201] 假设4:对于近空间飞行器姿态系统(2),期望信号yd满足 其中
[0202] 注1:假设1和4是跟踪控制研究中的一般假设。由近空间飞行器的特性可知,其姿态角一般在一定范围内,而G1是关于姿态角的函数矩阵,从而G1是有界的,因此假设2也是合理的。假设3表明理想控制量和实际控制量的差值在一定的范围内,若其差值过大则系统不可控。
[0203] 2、干扰观测器的设计
[0204] 为消除外部干扰的影响,本节设计二阶滑模干扰观测器对未知外部干扰进行估计。干扰观测器设计为如下形式:
[0205]
[0206] 其中L1=diag{L11,L12,L13},s=[s1,s2,s3]T,
[0207] L2=diag{L21,L22,L23},L3=diag{L31,L32,L33},sgn(s)=[sgn(s1),sgn(s2),sgn(s3)]T。
[0208] 定义干扰估计误差 由上式可以看出
[0209]
[0210] 同时引入滤波误差变量
[0211]
[0212] 参考式(6)和式(7),对其进行求导可得:
[0213]
[0214] 定义 M=[M1,M2,M3]T.由假设1可知M和 均有界,即其中τ3>0,τ4>0。因此式(9)可以改写为:
[0215]
[0216] 选择Lyapunov函数VS为:
[0217]
[0218] 对VS进行求导可得:
[0219]
[0220] 又知si sgn(si)=|si|,因此对上式两边同时求积分可得:
[0221]
[0222] 其中 将式(13)改写为:
[0223]
[0224] 其中
[0225]
[0226]
[0227] 另有||M||≤τ3, 因此通过选择
[0228]
[0229] 使得o1为小于或者等于零的变量,从而有
[0230]
[0231] 又根据式(18)可得
[0232] 0
[0233] 因此S∈L∞。另外由式(18)可得
[0234]
[0235] 因此S∈L2。因此由式(8)的定义可知, 又由M有界及式(10)可知 从而由S∈L∞, 及S∈L2可得||S||→0,因此 即干扰估计误差
[0236] 3、输入输出受限鲁棒自适应跟踪控制器设计
[0237] 为处理输入输出饱和问题,引入系统转换技术,并设计辅助系统,借助backstepping方法进行近空间飞行器姿态鲁棒自适应控制器设计。
[0238] 3.1系统输出约束转换
[0239] 由于系统输出受到一定的约束,为了得到较为理想的跟踪性能,将受约束的系统输出转化为不受约束的信号。
[0240] 首先,定义跟踪误差为e(t)=y-yd,根据式(4)可知,跟踪误差满足:
[0241] yli-ydi≤ei(t)≤yui-ydi,i=1,2,3            (21)
[0242] 为方便起见,定义e=[e1,e2,e3]T, ei=yli-ydi<0, 因此,式(21)可以改写为:
[0243]
[0244] 从而系统输出饱和问题转换为误差约束问题。为了将受约束的误差信号转换为无约束的信号,引入误差转换函数
[0245] 或者
[0246] 其中ξ=[ξ1,ξ2,ξ3]T无约束的转换信号。由式(23),可以得到如下性质:
[0247]
[0248] 另外又由 可知,系统跟踪误差和转换信号存在着严格的递增关系。因此,根据式(25)的性质可知,当转换信号有界时,系统原误差满足式(26)的约束条件。
下面,只需证明转换信号ξ的有界性。
[0249] 由 和一般函数的性质可知,转换信号ξi关于系统原误差ei的偏导数满足[0250] 因此定义函数 为如下形式:
[0251]
[0252] 从而可知函数 为可逆正定矩阵。根据系统(2)和误差的定义,对误差信号e(t)进行求导可得:
[0253]
[0254] 由上式及式(24)和(26)可得,对转换信号ξ进行求导可得:
[0255]
[0256] 其中 由于系统输出饱和边界 e,跟踪误差e及转换信号ξ均已知,函数 也可以直接获得的,在后面的控制器设计中作为已知量使用。
[0257] 综合上述分析,可以得到如下新的转化动态系统
[0258]
[0259] 3.2控制器设计
[0260] 在新的转换系统的基础上,结合干扰观测器与辅助系统进行控制器的设计。首先,未消除输入饱和对控制器性能的影响,设计如下形式的辅助系统Σ=[σ1,σ2]T:
[0261]
[0262] 其中σ1∈R3,σ2∈R3为辅助系统状态向量,C1,C2为正定设计矩阵,分别满足。其中a1>0为设计参数。
[0263] 下面借助backstepping方法进行输入输出饱和鲁棒自适应控制器的设计。
[0264] 第1步:定义误差变量:
[0265]
[0266] 其中z1=[z11,z12,z13]T,z2=[z21,z22,z23]T。由系统(29)和(30),对z1求导可得:
[0267]
[0268] 由于系统中存在不确定项ΔF1,引入神经网络对其进行逼近。作为一种参数化线性神经网络,RBF(radial basis function)神经网络被广泛的用于未知建模不确定的逼近。因此,本文采用RBF神经网络来逼近该不确定项。其最佳逼近可以写为:
[0269]
[0270] 其中 位权值矩阵,S(Ω)∈Rp为基函数向量,一般选择为高斯函数,最优逼近误差 从而式(32)可以改写为
[0271]
[0272] 又由变量z2的定义,上式可写为
[0273]
[0274] 设计虚拟控制律α1为如下形式:
[0275]
[0276] 其中 为设计矩阵,
[0277]
[0278] b11>0,b12>0,b13>0。 为 的逼近值。 为逼近误差 的估计值,其自适应律设计为:
[0279]
[0280] 其中δ1>0。
[0281] 定义神经网络参数逼近误差为 将设计的虚拟控制律α1入式(35)可得:
[0282]
[0283] 选取Lyapunov函数为
[0284]
[0285] 其中 为正定矩阵。定义自适应估计误差 根据式(38),对V1进行求导可得:
[0286]
[0287] 自适应律设计为:
[0288]
[0289] 其中ρ1>0为设计参数。同时由引理1可得:
[0290]
[0291] 另有:
[0292]
[0293]
[0294] 其中a1>0为设计参数。
[0295] 因此根据式(40)-(44)及假设2可得:
[0296]
[0297] 其中
[0298] 另有
[0299] 因此,式(46)可以改写为:
[0300]
[0301] 第2步:根据系统(29)和(30),对变量z2进行求导可得:
[0302]
[0303] 由于复合干扰D的存在,使用如式(6)所设计的干扰观测器对其进行逼近。在第二节中已经证明了估计误差 有限时间内收敛到零,但是在实际情况中,干扰观测器不可避免的存在一定的干扰误差。因此,不妨设估计误差 有界,即 其中
[0304] 设计控制器Mc为如下形式:
[0305]
[0306] 其中 为设计矩阵,
[0307] b11>0,b12>0,b13>0。 为估计误差 的估计值,其自适应律设计为:
[0308]
[0309] 其中δ2>0为设计参数。将控制器Mc带入式(46)可得:
[0310]
[0311] 选取Lyapunov函数为:
[0312]
[0313] 定义估计误差 根据式(51),对V2进行求导可得:
[0314]
[0315] 引理1可得:
[0316] 与第一步类似,可得
[0317] 又根据假设2和假设3可得:
[0318] 综合式(23),(47)和(53)-(56)可得:
[0319]
[0320] 其中
[0321]
[0322] 因此,由Lyapunov稳定性理论可知,闭环系统信号z1,z2,估计误差 及神经网络参数逼近误差 及辅助系统变量σ1 ,σ2均半全局一致有界。由式(57)可知[0323] 因此根据式(31)变量z1的定义可得: (59)
[0324] 从而可知转换信号ξ范数有界。根据性质(29)及系统跟踪误差与转换信号之间的严格递增关系,可知转换信号ξ的有界性可以保证跟踪误差约束性能(26)的成立。因此,根据跟踪误差e(t)的定义可知,系统输出y满足约束条件(4)。
[0325] 4仿真分析
[0326] 本节将所设计的控制方法应用于近空间飞行器姿态跟踪控制中,应该该算法的有效性。
[0327] 近空间飞行器的姿态运动模型如式(1)所示,具体各矩阵的参数可以在文献[10]中找到。由于系统中存在不确定,假设近空间飞行器空气动力学和运动学系数存在30%的不确定性。同时外部力矩扰动d2为如下形式:
[0328]
[0329] 控制力矩向量Mc的饱和度为:Mcmax=104×[0.2,2,2]TkN·m
[0330] 系统初始状态为:α0=-2°,β0=1°,,μ0=2°,p=q=r=0deg/s,高度为H0=210km,速度为V0=4000m/s,期望信号yd为
[0331]
[0332] 为避免期望信号αd可能产生的不连续性,在期望信号后加入一阶滤波器 如式(4)所示,系统输出上下界可以表示为:
[0333]
[0334]
[0335] 鲁棒跟踪控制器设计为式(49),辅助系统设计为式(30),干扰观测器设计为式(6),虚拟控制律设计为式(23),自适应律设计为式(37)和(50)所示,各参数设计为如下形式:
[0336] K1=diag{0.04,0.04,0.04},K2=diag{80,80,80},
[0337] C1=diag{10,10,10},C2=diag{120,120,120},
[0338] L1=diag{1,1,2},L2=diag{2,2,4},L3=diag{30,30,60},
[0339] Π1=1,ρ1=2,δ1=10,δ2=1,a1=0.01,
[0340] b11=b12=b13=1000,b21=b22=b23=1。
[0341] 控制器作用下的近空间飞行器控制控制仿真结果如图1-4所示。由图1可以看出,在设计的控制器作用下,系统输出能够快速跟踪到期望信号,且稳态误差趋向于零。同时,由图2可知,系统的状态姿态角速率在跟踪控制过程能够保持稳定。从图3可以知道系统跟踪误差一致保持在约束边界中,因此,由图3可得,系统输出在存在约束情况下也能快速跟踪到期望信号。最后,从图4可以得到,通过所设计控制器的作用,系统在存在输入饱和情况下仍然能保持稳定。
[0342] 综上所述,仿真结果证明了该控制方法的有效性。
[0343] 本说明书中所描述的以上内容仅仅是对本发明所作的举例说明。本发明所属技术领域的技术人员可以对所描述的具体实施例做各种修改或补充或采用类似的方式替代,只要不偏离本发明说明书的内容或者超越本权利要求书所定义的范围,均应属于本发明的保护范围。

附图说明

[0173] 图1是本发明的飞行器姿态角跟踪输出响应图。
[0174] 图2是本发明的飞行器姿态角速率输出响应图。
[0175] 图3是本发明的系统跟踪误差响应及约束示意图。
[0176] 图4是本发明的系统控制输入示意图。
专利联系人(活跃度排行)
版权所有:盲专网 ©2023 zlpt.xyz  蜀ICP备2023003576号