航天器近距离相对轨道的滑模控制
航天器快速绕飞任务的六自由度滑模控制研究

航天器快速绕飞任务的六自由度滑模控制研究
朱彦伟;杨乐平
【期刊名称】《宇航学报》
【年(卷),期】2009(030)004
【摘要】随着航天器在轨服务的发展,快速绕飞成为当前航天任务设计的一个重要课题.快速绕飞采用受限相对运动轨迹,为了实现任务目标需要考虑航天器位置与姿态的六自由度耦合控制问题.采用滑模变结构控制理论,解决了航天器快速绕飞的六自由度推力控制问题.首先.从完全非线性相对轨道动力学方程和修正罗德里格斯参数表示的姿态运动学方程出发,建立了包含未知有界干扰的六自由度动力学模型,该模型形式简单,适用于任意偏心率的目标轨道;其次,以圆形绕飞为例,给出了任意方位快速绕飞轨迹的数学表示和任意位置期望姿态的计算模型;然后,考虑航天器形状及推力器配置,应用滑模变结构控制的趋近律方法,设计了对未知有界干扰具有鲁棒性的控制律.最后的仿真算例验证了控制律的有效性.
【总页数】7页(P1482-1488)
【作者】朱彦伟;杨乐平
【作者单位】国防科技大学航天与材料工程学院,长沙410073;国防科技大学航天与材料工程学院,长沙410073
【正文语种】中文
【中图分类】V448.2
【相关文献】
1.基于滚动优化和微分Theta-D方法的快速绕飞航天器姿轨协同控制 [J], 朱志斌;李果;何英姿;魏春岭
2.航天器快速绕飞姿控脉宽调制研究 [J], 张兵;王东亚;王珂;王冠军
3.PSO优化的六自由度机械臂全局快速终端滑模控制 [J], 王琥;胡立坤;谭颖
4.空间绕飞任务中航天器姿态跟踪的鲁棒控制 [J], 宋申民;张保群;陈兴林
5.非合作目标绕飞任务的航天器鲁棒姿轨耦合控制 [J], 黄艺;贾英民
因版权原因,仅展示原文概要,查看原文内容请购买。
空天飞行器全局终端滑模控制23页PPT

(r cos q sin ) / cos
p (J y J z) qr M x
Jx
Jx
q (J z J x) pr M y
Jy
Jy
r (Jx J y) pr M z
Jz
Jz
(1)
飞行器姿态模型
令 x1
x2
x3 x4
p
x5
q
x 6 r
u1
Lg1Lfh1(x) A(x)Lg1Lfh2(x)
Lg1Lfh3(x)
Lg2Lfh1(x) Lg2Lfh2(x) Lg2Lfh3(x)
L L Lg g g3 3 3L L Lfffh h h1 2 3(((x x x)))100
sinx1tanx2 cosx1
sinx1secx2
cosx1tanx2
(3)
b(x) b1(x) b2(x)
式中
bi
(x)
Lri f
hi
(x),i
1, 2,
bm (x)
,m
在满足上述条件的情况下,再利用状态变换
,就能 Z ( x ) h 1 ( x ) , L f h 1 ( x ) ,, L r 1 f 1 h 1 ( x ) ,, h m ( x ) , L f h m ( x ) ,, L r f m 1 h m ( x ) T 使得系统输出的第 i 个分量 y i 仅受第 i 个参考变量 v i 的影响。
空天飞行器全局终端滑模控制
服从真理,就能征服一切事物
空天飞行器的 全局终端滑模控制
报告人:李英 指导老师:井元伟教授
目录
1.飞行器姿态模型及其输入输出解耦 2.全局终端滑模控制系统设计 3.仿真 4.结论
考虑输入受限的航天器安全接近姿轨耦合控制

考虑输入受限的航天器安全接近姿轨耦合控制武冠群;宋申民;孙经广【摘要】针对存在外部扰动和输入受限的航天器安全接近的问题,当扰动上界未知时,基于积分滑模控制理论设计了抗饱和的有限时间自适应姿轨耦合控制器.控制器的设计过程中采用了新型的避碰函数限制追踪航天器运动区域进而保证接近过程中航天器的安全性,同时通过辅助系统和自适应算法分别处理了输入受限和扰动上界未知.借助李雅普诺夫理论证明了在控制器的作用下系统状态在有限时间内收敛,且能够保证追踪航天器在实现航天器接近的过程中不与目标航天器发生碰撞.最后通过数字仿真进一步验证了所设计控制器的有效性.【期刊名称】《控制理论与应用》【年(卷),期】2018(035)010【总页数】10页(P1511-1520)【关键词】航天器安全接近;姿轨耦合控制;输入受限;避免碰撞;安全约束函数;滑模控制【作者】武冠群;宋申民;孙经广【作者单位】哈尔滨工业大学控制理论与制导技术研究中心,黑龙江哈尔滨150001;哈尔滨工业大学控制理论与制导技术研究中心,黑龙江哈尔滨150001;哈尔滨工业大学控制理论与制导技术研究中心,黑龙江哈尔滨150001【正文语种】中文【中图分类】V448.21 引言(Introduction)由于空间战略发展的需求,捕获或维护在轨卫星、处理空间碎片、实现自主交会对接等在轨任务逐渐受到重视[1–3].为成功完成各项在轨任务,必须要求追踪航天器快速接近目标附近的期望位置[4].在复杂的空间环境中,为了满足进一步任务操作的需求,终端接近控制策略必须有较高的控制精度和较强的鲁棒性.同时,在接近过程中追踪航天器与目标相距较近,追踪航天器应具有避免进入易发生碰撞的禁忌区域的能力.因此,航天器安全接近鲁棒控制技术成为完成在轨任务的研究重点之一.近年来,非线性控制在航天器近距离接近运动控制中有广泛应用.基于C–W方程,文献[5]利用增益调度控制方法解决了带有输入饱和的航天器交会问题.文献[6]为处理航天器交会,利用滑模控制理论和反步法设计了最优滑模控制器和反步滑模控制器.在近距离相对运动过程中,追踪航天器相对于目标的位置和姿态通常需要以较高精度同时达到期望的状态,但航天器间的相对位置与姿态存在严重的耦合[7–10].为了处理该问题,文献[7–8]基于六自由度相对运动耦合模型,利用反步法和径向基神经网络设计了控制器.针对航天器近距离相对运动,文献[9–10]利用反步法设计了姿轨耦合控制器,且文献[10]在设计过程中考虑了输入受限和全状态约束.在航天器终端接近过程中,追踪航天器与目标相距较近,容易发生碰撞.为了保证航天器的安全性,控制追踪航天器躲避禁忌区域是十分必要的.为实现非合作自主交会对接,文献[11]提出了一种基于椭圆蔓叶线的制导方法,但对初始位置的设置有一定的局限性.文献[12]基于分段势函数和模糊理论设计了安全接近方法.文献[13]中利用安全正不变集理论研究了相对运动过程中航天器对障碍物的规避问题.文献[14]利用人工势函数和最优滑模控制理论实现了考虑避碰约束的航天器交会任务.文献[15–17]利用模型预测控制(model predictive control,MPC)研究了航天器交会过程中的避碰问题,且文献[17]同时处理了交会过程中的障碍物规避和视线角约束问题.文献[18]将蔓叶面势函数与滑模控制方法相结合,设计了具有避碰功能的姿轨耦合控制器,但需要已知外界扰动上界信息,且没有考虑输入受限.在实际控制系统中,执行机构的输入是受限的,但在航天器安全接近过程中可能出现较大的控制输入,会导致输入超出执行机构限度,从而引起系统不稳定,同时在实际环境中外部扰动是不可避免的,这可能会对航天器控制的精度和鲁棒性产生一定的影响,但由于外部扰动的复杂性,精确的扰动上界很难获取.因此,为了提高控制性能,在控制器设计过程中考虑输入受限和扰动上界未知是必要的.然而,目前同时考虑输入受限、扰动上界未知的航天器安全接近的研究较少,如文献[15–17]利用MPC方法解决了接近过程中的避碰问题,但其只处理了不含扰动项的相对位置运动,且没有考虑姿态轨道耦合特性;文献[18]考虑了外部扰动,但需要已知扰动上界,且没有考虑输入受限的影响,除此之外,文献[18]采用的蔓叶面势函数对初始位置的限制有较大局限性,只能使航天器从单一区域接近目标.因此,为了进一步解决考虑输入受限、扰动上界未知的航天器姿轨耦合安全接近问题,本文通过引入一个新型的避碰函数处理运动过程中的禁忌区域,并结合积分滑模控制、辅助系统和自适应算法,设计了一种自适应抗饱和姿轨耦合控制策略,可以使得追踪航天器在有限时间内安全接近目标.与上述文献相比,本文的主要创新点如下:1)与文献[12]相比,本文提出的新型的避碰函数是连续且可导的,针对避碰函数求导的情况仍然适用.且与文献[11,18]相比,采用新的避碰函数放宽了对初始位置的限制,使追踪航天器从蔓叶面外部的安全区域出发仍可安全接近目标;2)与文献[7–8]相比,本文考虑了航天器接近过程中的安全约束,能够保证追踪航天器在接近目标航天器的过程中始终在安全区域内运动,避免航天器在接近过程中发生碰撞;3)与文献[15–17]相比,本文处理安全约束时考虑了姿态运动与轨道运动耦合的影响,且与文献[18]相比,本文同时考虑了外部扰动上界未知和输入受限约束,使得所设计的抗饱和有限时间自适应控制器具有更好的控制性能和实际工程意义.本文的主要内容如下:首先基于目标航天器体坐标系建立了航天器接近姿轨耦合模型;其次,对提出的新的避碰函数进行了分析,并利用避碰函数、辅助系统和积分滑模控制理论,针对外部扰动上界未知的情况设计了的航天器安全接近抗饱和有限时间自适应控制器,且借助Lyapunov理论给出了相应的证明;再次,通过数字仿真进一步验证了所设计控制器的性能;最后,给出本文的结论.2 问题描述(Problem description)2.1 姿态和轨道耦合模型(The coupling motion model of attitude and orbit) 为建立姿态轨道耦合模型,定义追踪航天器体坐标系Fcb(OcbXcbYcbZcb)如图1所示:追踪航天器质心为坐标原点Ocb;Xcb轴与对接轴重合,且指向对接口为正方向;Ycb轴位于包含对接轴的横向对称平面且与Xcb轴垂直,指向左侧为正方向;Zcb 轴与Xcb轴和Ycb轴满足右手定则.目标航天器体坐标系Ftb(Otb XtbYtbZtb)建立与Fcb类似.图1 追踪航天器体坐标系示意图Fig.1 Illustration of chaser spacecraft body coordinate system在惯性坐标系FI中,追踪航天器、目标航天器动力学方程分别表示为注1 在模型式(21)中,姿轨耦合体现在两方面:一方面,如式(8)和式(16)–(20)所示,航天器的位置和姿态同时受姿态角速度ω的影响,轨道运动和姿态运动存在耦合,在控制航天器姿态变化的同时会引起轨道位置的变化;另一方面,航天器轨道运动受到的部分环境力扰动与姿态运动相关,影响姿态的部分梯度干扰力矩与轨道位置相关,因此干扰d隐含了姿态和轨道的耦合.为提高控制精度和控制效率,需要考虑姿态和轨道的耦合.注2 定义为惯性坐标系FI到追踪航天器体坐标系Fcb的旋转矩阵,且根据相关计算可知,可以将惯性系下向量XI变换为坐标系下向量.如惯性系中在坐标系Fcb的表示fB为2.2 相关引理及假设(Related lemmas and assumptions)引理1[19]针对系统=f(x,u),其中x是系统状态,u为控制输入.假设存在连续可微函数V为正定函数,且存在正实数c>0和α∈(0,1),以及一个包含原点的开邻域U⊂U0,使得≤−cVα成立.则系统是有限时间稳定的.引理2[20]针对系统=f(x,u),其中x是系统状态,u为控制输入.假设存在连续可微函数V为正定函数,且存在正实数c>0,α∈(0,1)和0<σ<∞,以及一个包含原点的开邻域U⊂U0,使得≤−cVα+σ成立.则系统是实际有限时间稳定的.假设1 追踪航天器初始位置和期望位置均在安全区域.假设2 航天器接近姿轨耦合模型(21)中的外部扰动d有界,即满足∥d∥≤dm,dm≥0.3 避碰函数描述(Description of collision avoidance function)由于目标航天器安装有通讯天线、操作机械和太阳能帆板等物理附件,且追踪航天器在接近目标航天器的过程中相对距离很近,追踪航天器容易与目标(包括目标航天器附带的物理部件)发生碰撞,因此航天器近距离相对运动过程中限制运动区域来保证航天器的安全性是十分必要的,如图2所示.图2 安全接近示意图Fig.2 Illustration of safe approach当采用类似于圆锥的安全接近走廊曲面(椭圆蔓叶面)作为安全约束函数限制追踪航天器近距离接近目标过程中的安全运动区域时,需要对追踪航天器的起始位置有较强的限制[11,18].因此,需要设计一个新的安全约束函数限制航天器的运动区域,进而保证追踪航天器从任意安全的初始位置出发实现安全接近.本文给出一个新的避碰函数如式(25)所示.其中,用表示目标航天器体坐标系中的追踪航天器位置矢量.当h(Prtb)>0时,追踪航天器位于安全区域.其中:a1,a2,a3为需要设定的参数,且a3>a2>a1>0.c1,c2,c3,c4满足如下关系:针对新的避碰函数(25),h(Prtb)=0是一个由3个函数曲面构成的封闭曲面.第1部分是在对接轴方向构造的最终安全接近走廊函数,该函数采用了椭圆蔓叶面近似锥形的安全接近走廊,该蔓叶面可以保证追踪航天器接近目标对接轴的过程中与目标不发生碰撞.第2部分是连接第1部分和第3部分的曲面,当该部分函数的参数满足式(26)时,该部分的函数可以保证封闭曲面h(Prtb)=0是连续且可导的.第3部分是以目标航天器为质心、半径为a1的球面,该球面需要包括目标航天器及其物理附件.当追踪航天器在封闭避碰函数曲面外运动时,不会与目标航天器发生碰撞.根据文献[12],选取避碰函数(25)的参数为a1=48.9 m,a2=49 m,a3=50m,θ=π/90 rad.进一步计算参数c1=−1.452×109,c2=2.966×107,c3=−2.019×105,c4=2.369×1010.所设计的安全接近限制区域h(Prtb)=0的二维图形如图3所示,图中横轴表示目标航天器本体坐标系的Xtb轴,纵轴表示到Xtb轴的距离,封闭区域为的安全运动区域的边界,且关于目标航天器的对接轴是对称的.注3 构造的避碰函数(25)不仅限制了追踪航天器的安全运动区域,满足了安全接近的要求,而且与文献[12]的势函数相比,构造的避碰函数(25)在h(Prtb)=0处连续且可导.避碰函数(25)要求追踪航天器初始位置在封闭曲面外即可,与文献[11,18]相比,采用新的避碰函数在一定程度上可以放宽对初始位置的限制.图3 安全接近限制区域的二维图形Fig.3 The restricted area for safe approaching in two-dimensional plane4 控制器设计(Controller design)由定理1可知,系统状态xre,xve有限时间稳定,即追踪航天器可以完成终端接近. 根据上述分析,V2,V3是有界的,进一步可得变量1/h(Prtb)是有界的,且根据假设1得到其初始值h(Prtb,0)大于0,则可以得到追踪航天器实现航天器终端接近的过程中,避碰函数h(Prtb)恒大于0,说明追踪航天器在接近目标航天器的过程中始终运动在安全区域,与目标航天器不发生碰撞,实现了航天器最终逼近段的安全接近. 证毕.5 仿真(Simulations)下面通过仿真进一步验证控制器(37)的有效性.设航天器的质量均为100 kg.追踪航天器所受外部扰动力只考虑J2摄动.追踪航天器所受扰动力矩设为dτ=0.001[cos(nt)2cos(nt)3cos(nt)]TN·m,n为平均角速度.用轨道六要素表示目标航天器的初始位置为:,ω=0,f=0.设相对速度的初始值为0(0)=[0 0 0]Tm/s,期望相对位置为rd=[5 0 0]Tm.设转动惯量为J=[3.0610.5;131;0.413.95]kg·m2,初始姿态为σ(0)=[0.1−0.1 0.2]Trad,初始姿态角速度为ω(0)=[−0.01 0.008−0.01]Trad/s,期望姿态为σd=0.01[sin(10nt)−cos(10nt)sin(10nt)]Trad.为验证追踪航天器在控制器(37)的作用下能从不同初始位置(蔓叶面内部与蔓叶面外部的安全区域)出发安全接近目标航天器,设定如下两个初始位置:情况1 相对位置的初始值r0(0)=[48.5−1.4 0.2]Tm.情况2 相对位置的初始值r0(0)=[50.1 15.1 32.1]Tm.针对控制器(37),参数选取为:k1=0.5,k2=0.5,k3=0.9,γ=0.6,ks=3,kη=1.6,kh=40,P1=0.01,P2=0.09.结果如图4–12所示.图4 追踪航天器姿态误差Fig.4 The curves of attitude error of the chaser图5 追踪航天器的角速度误差Fig.5 The curves of angular velocity error of the chaser图6 作用在追踪航天器的控制力距Fig.6 The control torque for the chaser图7 相对位置误差Fig.7 The curves of relative position error图8 相对速度误差Fig.8 The curves of relative velocity error图9 作用在追踪航天器的控制力Fig.9 The control force for the chaser图10 外界扰动上界估计值曲线Fig.10 The curves of m图11 情况1的追踪航天器的运动轨迹Fig.11 The motion trajectories of the chaser for Case 1图12 情况2的追踪航天器的运动轨迹Fig.12 The motion trajectories of the chaser for Case 2图4–6分别给出了追踪航天器的姿态误差曲线、角速度误差曲线以及控制力矩曲线,从仿真结果可以看出,两种仿真情况的控制力矩是有界的且趋于稳定,当存在外界扰动时,姿态误差及角速度误差快速收敛到零,满足了安全接近任务中姿态要求.图7–9分别给出了航天器相对位置误差、相对速度曲线误差以及控制力曲线,从仿真结果可以看出,两种仿真情况下的控制力是有界的且趋于稳定,同时在外界扰动上界未知和输入受限的情况下,追踪航天器运动到达期望位置附近,且相对速度快速收敛到期望值,满足了安全接近任务中位置要求.图10为外部扰动上界m的自适应曲线,其在较短时间内可以趋于一个稳态值.为了更直接的描述追踪航天器实现安全接近的过程,图11–12给出了追踪航天器在目标航天器体坐标系下的二维运动轨迹,从图中可以看出,当考虑安全约束时,追踪航天器在控制器(37)的作用下从不同的安全初始位置出发均可以实现安全接近,当不考虑安全约束,追踪航天器在接近过程中会与目标发生碰撞.上述仿真结果表明,当考虑输入受限和扰动上界未知时,在基于新型避碰函数(25)设计的控制器(37)的作用下,追踪航天器不仅能从传统的蔓叶面内部出发完成安全接近任务,而且可以从蔓叶面外部的安全区域出发完成安全接近任务.6 结论(Conclusions)本文利用积分滑模控制理论及避碰安全约束函数对考虑输入受限和未知上界扰动的航天器姿轨耦合安全接近问题进行了研究.主要结论如下:1)引入新避碰函数,放宽了对初始位置的限制,可以将终端安全接近问题转化为避碰函数倒数有界的问题,简化了终端安全接近控制器设计.2)针对航天器终端接近姿轨耦合模型,基于积分滑模和避碰函数设计了自适应抗饱和控制器,利用辅助系统和自适应算法处理了输入受限和扰动上界未知,可以保证追踪航天器在有限时间内实现终端安全接近.3)利用Lyapunov理论证明了在所设计的控制器作用下系统状态在有限时间稳定,且能够保证在终端接近过程中可以避免追踪航天器与目标航天器的碰撞,同时利用数字仿真验证了所设计控制方案的有效性.参考文献(References):【相关文献】[1]FlORES-ABAD A,MA O,PHAM K,et al.A review of space roboticstechnologiesforon-orbitservicing[J].ProgressinAerospaceSciences,2014,68(1):1–26.[2]SHAN M,GUO J,GILL E.Review and comparison of active space debris capturing andremoval methods[J].Progress in Aerospace Sciences,2016,80(1):18–32.[3]JOHN-OLCAYTO E S,MCINNES C R,ANKERSEN F.Safetycritical autonomous spacecraft proximity operations via potential function guidance[C]//2007 AIAA InfoTech at Aerospace Conference.California:AIAA,2007,2:1893–1902.[4]LUO Y Z,ZHANG J,TANG G J.Survey of orbital dynamics and control of space rendezvous[J].Chinese Journal of Aeronautics,2014,27(1):1–11.[5]WANG Q,ZHOU B,DUAN G R.Robust gain scheduled control of spacecraft rendezvous system subject to input saturation[J].Aerospace Science and Technology,2015,42(1):442–450.[6]IMANI A,BEIGZADEH B.Robust control of spacecraft rendezvous on ellipticalorbits:Optimal sliding mode and backstepping sliding mode approaches[J].Proceedings of the Institution of MechanicalEngineers,PartG:JournalofAerospaceEngineering,2016,230(10):1975–1989.[7]XIA K,HUO W.Robust adaptive backstepping neural networks control for spacecraft rendezvous and docking with input saturation[J].ISA Transactions,2016,62(1):249–257. [8]XIA K,HUO W.Robust adaptive back-stepping neural networks control for spacecraft rendezvous and docking with uncertainties[J].Nonlinear Dynamics,2016,84(3):1683–1695.[9]SUN L,HUO W.Robust adaptive backstepping control for autonomous spacecraft proximity maneuvers[J].International Journal of Control,Automation andSystems,2016,14(3):753–762.[10]SUN L,HUO W,JIAO Z.Adaptive backstepping control of spacecraft rendezvous and proximity operations with input saturation and full-state constraint[J].IEEE Transactions on Industrial Electronics,2017,64(1):480–492.[11]ZHANG Dawei,SONG Shenmin,PEI Run,et al.Ellipse cissoidbased potential function guidance for autonomous rendezvous and docking with non-cooperative target[J].Journal of Astronautics,2001,31(10):2259–2268.(张大伟,宋申民,裴润,等.非合作目标自主交会对接的椭圆蔓叶线势函数制导[J].宇航学报,2010,31(10):2259–2268.)[12]ZHANG D,SONG S,PEI R,et al.Safe approaching to noncooperative spacecraft using potential function guidance based fuzzy logic system[C]//2010 the 8th Intelligent Control and Automation(WCICA).Jinan,China:IEEE,2010:3526–3531.[13]WEISSA,PETERSENC,BALDWINM,etal.Safepositivel yinvariant sets for spacecraft obstacle avoidance[J].Journal of Guidance,Control,and Dynamics,2014,38(4):720–732. [14]FENG L C,NI Q,BAI Y Z,et al.Optimal sliding mode control for spacecraft rendezvous with collision avoidance[C]//2016 IEEE Congress on 2EvolutionaryComputation(CEC).Vancouver,BC,Canada:IEEE,2016:2661–2668.[15]CAIRANO S D,PARK H,KOLMANOVSKY I.Model predictive control approach forguidance of spacecraft rendezvous and proximity maneuvering[J].International Journal of Robust and Nonlinear Control,2012,22(12):1398–1427.[16]JEWISON C,ERWIN R S,SAENZ-OTERO A.Model predictive control with ellipsoid obstacle constraints for spacecraft rendezvous[J].IFAC-Papers OnLine,2015,48(9):257–262.[17]WEISS A,BALDWIN M,ERWIN R S,et al.Model predictive control for spacecraft rendezvous and docking:strategies for handling constraints and case studies[J].IEEE Transactions on Control Systems Technology,2015,23(4):1638–1647.[18]GUO Yong,SONG Shenmin,LI Xuehui.Attitude and orbit coupled control for non-cooperative rendezvous and docking[J].Control Theory&Applications,2016,33(5):638–644. (郭永,宋申民,李学辉.非合作交会对接的姿态和轨道耦合控制[J].控制理论与应用,2016,33(5):638–644.)[19]PUKDEBOON C,SIRICHARUANUN P.Nonsingular terminal sliding mode based finite-time control for spacecraft attitude tracking[J].International Journal of Control,Automation and Systems,2014,12(3):530–540.[20]HU Qinglei,LI Bo,ZHANG Aihua,et al.Finite-time attitude maneuver control of spacecraft under controlsaturation and misalignment[J].ControlTheory&Applications,2013,30(4):417–424.(胡庆雷,李波,张爱华,等.考虑推力器安装偏差的航天器姿态机动有限时间控制[J].控制理论与应用,2013,30(4):417–424.)。
航天器平移及姿态机动自适应终端滑模控制

航天器平移及姿态机动自适应终端滑模控制岳宝增;李晓玉【摘要】研究了用于航天器平移及姿态机动的自适应终端滑模控制方法.通过在广义准坐标下建立拉格朗日方程得到了刚体航天器平移及姿态耦合运动的动力学方程.能对存在模型不确定性和环境扰动下的航天器实现平移和姿态机动.该自适应过程包括对不确定性和干扰的估计、有效抑制传统滑模控制的抖振现象.利用李雅普诺夫稳定性理论证明了控制器的可达性和稳定性.通过航天器的位置以及姿态跟踪的数值仿真,验证了所设计控制器的有效性和准确性.【期刊名称】《动力学与控制学报》【年(卷),期】2018(016)004【总页数】6页(P332-337)【关键词】滑模控制器;航天器平移机动;航天器姿态机动;自适应控制;不确定性及扰动【作者】岳宝增;李晓玉【作者单位】北京理工大学宇航学院,北京 100081;北京理工大学宇航学院,北京100081【正文语种】中文引言现代航天器大角度姿态机动及轨道机动往往是以六个自由度的平动及姿态运动建模.此时系统的非线性运动方程中六个自由度的平动和旋转运动是动态耦合、高度非线性的. 而且,未知的环境力矩会对航天器产生外部扰动,机动时的燃料晃动和消耗会使航天器的惯性矩阵和质量特性发生变化,导致参数不确定.因此,控制系统应该能够考虑外部干扰并适应质量分布的变化[1-3].自适应控制器能够修正自身特性以适应运动及扰动动态特性变化[4].由于现代航天器控制系统存在参数不确定及外部干扰,因而自适应控制器具有重要的实际意义.许多应用中(如轨道和大角度机动),航天器的惯性矩阵可能存在较大的模型误差,因此提出了自适应控制.机动过程中,系统的惯量矩阵将由于燃料消耗(或者燃料晃动及流体结构耦合动力学[1-3])或部件连接的改变而发生变化,因此控制器的设计必须有效克服这种变化对航天器的影响.自适应反馈控制可以解释并解决航天器跟踪目标轨道的问题[3] .由于控制律具有六阶动态补偿器形式,因而无需知道航天器惯量或者质心位置.文献[5]研究了具有惯性不确定性及外部干扰的非线性航天器系统的姿态稳定问题.在应用滑模控制器控制闭环系统的状态变量时,需要自适应律预估干扰.对具有执行偏差及质量未知的刚体航天器整体平移及旋转的有限时间控制问题采用了反演鲁棒自适应控制方法[6].本文对航天器的耦合平移及姿态动力学进行了动力学和运动学描述,并将无奇异问题的四元数用于姿态运动学.应用自适应终端滑模控制器驱动航天器在有限时间内(非渐进式)到达目标轨道.所提出的设计方案具有快速机动响应性,并且对于模型的不确定性及环境扰动具有很好的鲁棒性.利用李雅普诺夫稳定性理论证明了控制器的可达性及稳定性.最后通过数值仿真验证了控制器的效率和准确性.1 航天器耦合平移及姿态动力学方程首先根据所要建立的耦合动力学模型选择坐标系,如图1所示.直角坐标系EXIYIZI 为原点在E点的惯性参考系.直角坐标系OXsYsZs为固定在航天器刚体上的随体坐标系,其原点为主刚体质心,R是在坐标系EXIYIZI中所表示的从E到O的矢径.参考坐标系下的航天器姿态是由方向余弦矩阵或者欧拉角定义的.本文中,欧拉角被定义为关于刚体轴的旋转角,其中:θx,θy,θz分别是绕轴Xs,Ys,Zs的旋转角.坐标系变换矩阵按照OXs→OYs→OZs的顺序.因而得到坐标系EXIYIZI和OXsYsZs的坐标系变换矩阵为:(1)(2)其中:sk=sinθk,ck=cosθk.自由指标k表示固定于主刚体的坐标.(3)(4)V,ω分别是航天器相对于惯性系的速度和角速度(角速度表示为准坐标的时间导数以及坐标转化矩阵的积).图1 航天器系统的示意图Fig.1 Schematic representation of the spacecraft system根据一般准坐标系下的拉格朗日方程,得到航天器六自由度平移和姿态运动的动力学方程[7].(5)(6)L表示拉格朗日函数.f和u分别是控制力和力矩.df和du分别是外部干扰力和力矩.符号×表示作用于向量ω=[ωxωyωz]T的运算:方程(5)和(6)可以写成如下形式:(7)(8)m和J分别为主刚体的质量和惯性矩阵.耦合系统的状态向量(或广义坐标系)可表示为Z=[Rx,Ry,Rz,θx,θy,θz,vx,vy,vz,ωx,ωy,ωz]T,耦合动力学和运动学方程(3),(4),(5)和(6)可以利用四阶的龙格库塔法联合求解.方程(3)和方程(4)用欧拉角描述了航天器的姿态动力学方程.欧拉角具有最小尺度的优点,但是存在计算量大及奇异性问题.本文采用四元数对刚体航天器进行了全局姿态描述.欧拉角转换为四元数的关系式如下[8]:(9)Sj/2=sin(θj/2), Cj/2=cos(θj/2), j=x,y,z.q=[qv;q4]=[q1,q2,q3,q4]T是航天器姿态的四元数,它们之间的关系式:此外,θi→0时,q1→0,q2→0,q3→0,q4→1.因而,航天器系统的姿态可以用以下运动学方程来描述[9].(10a)(10b)I3是三阶的单位矩阵.因此方程(3),(10),(7)和(8)构成了一组航天器耦合平移及姿态动力学的运动学及动力学方程.2 航天器平移和姿态机动的控制策略设计本节所设计的控制器是为航天器在参数不确定性及外部干扰下的运动提供鲁棒自适应控制.控制任务可以简单概述为:对于初始状态R(t0)=R(0)=R0(位置)以及θ(t0)=θ(0)=θ0(姿态)的航天器,所设计的控制律能够驱使闭环耦合的航天器系统在t→T时,状态(3)、(10)、(7)和(8)为零.其中T是收敛时间.可以表示为:(11)在给出控制设计之前,首先给出一些与设计控制方法相关的引理.引理1[10] 如果α∈(0,1),那么下列不等式成立:(12)引理2[10] 对任意实数i=1,…,n,并且0<α<1,下列等式成立:≤|x1|α+…+|xn|α(13)引理3[11] 设V(x)是一个C1光滑正定函数(定义U⊂Rn),并且是一个半负定函数,其中U⊂Rn,α∈(0,1),λ∈R+,存在区间U0⊂Rn,对于任意从U0⊂Rn起始的V(x)在有限时间内能达到V(x)≡0.此外,如果Tmax是达到V(x)≡0需要的时间,那么:(14)其中V(x0)是V(x)的初始值.引理4[12] 快速终端滑模形式的有限时间稳定的李雅普诺夫函数展开形式给出如下:(15a)其中λ1>0,λ2>0,0<α<1,稳定时间为:(15b)对于航天器轨道控制,航天器轨道的终端滑模面(或切换面)设为:S1=CTV+κ1R+κ2sig(R)r(16)其中S1=[S1x,S1y,S1z]T,κ1>0,κ2>0,0<r<1.函数sig(·)P定义为:当在滑模面S1=0上时,得到:V=C[-κ1R-κ2sig(R)r](17)为证明滑模面的可达性,李雅普诺夫函数为:(18)求导得到:=-κ1mRTR-κ2m≤-2κ1V1-κ2m由于所以根据引理3得到航天器位置可在有限时间内从初始R(t0)到达R(t)=0,最长时间为:(19)定理1 由方程(3)、(7)得到的滑模面,控制器(20)能使闭环系统的轨迹在有限时间内达到该滑模面的邻域,并且最终收敛至原点.f= C[-κ3S1-κ4sig(S1)r]-(20)向量x∈Rn的范数定义控制器的稳定性证明过程参考文献[13].类似的,根据引理3,得到航天器轨道终端滑模面由S1(t0)到达S1(t)=0的最长时间为:(21)为了抑制控制器的抖振,用饱和函数代替方程(20)的符号函数,控制器转换为:(22)e=[e1,e2,e3]为约束抖振的符号函数:(23)在质量变化以及存在外部干扰的情况下,控制器(21)可使系统由初始状态(3)和(7)在有限时间内达到初始状态.但是该控制器存在两个缺点:(1)干扰df的上限在实际系统中可能未知.(2)控制器涉及矩阵范数μ的计算使得计算控制输入需要更多时间.因此,基于控制器(21)提出以下自适应控制方案:(24)ζ0>0,ζ1>0.该控制器效率及可行性的证明参考文献[13].该控制方案具有两个特点:(1)控制器不依赖于质量m,因而可以应用于存在多个未知m的航天器系统,并且可以利用自适应方法估计扰动上限.(2)算法计算简单,不包括任何矩阵范数的计算. 由于驱动发动机控制力的大小通常是有限的,为了避免过控制并节约能量,与坐标状态参数增益系数的直接相关量应该大于坐标状态参数间接相关量,即:κ1>κ2,κ3>κ4.此外,当驱动力变化过快时,会引起液体燃料晃动或者挠性附件的振动力,这将会显著影响航天器的姿态和轨道,最终导致航天器控制器失效.因此,所有控制器的增益系数必须选择一些较小的值.对于考虑惯性不确定性以及外界干扰的航天器姿态控制,根据参考文献[15]最终给出快速终端滑模控制器(AFTSM)如下:(25)S=[S2x,S2y,S2z]T∈R3,λ1>0,λ2>0,0<p<1,σ=diag[σ1,σ2,σ3],σi>0.3 数值模拟与讨论本节对刚体航天器的平移和姿态机动问题进行了仿真,证明了滑模控制器(24)和(25)的作用.在仿真中使用的是文献[5,14]中的航天器模型,其中航天器参数:航天器机动的初始条件和期望的最终状态如表1所示.表1 航天器机动的初始状态及目标状态Table 1 The initial conditions and the desired final states for spacecraft maneuveringinitial conditionsdesired final statesR(0)=[-10,10,20]Tm,Rd=[0,0,0]Tm,V(0)=[0,0,0]Tm/sec,Vd=[0,0,0]Tm/sec,q(0)=[0.3,-0.2,-0.3,0.893]T,qd=[0,0,0,1]T,ω(0)=[0.01,-0.02,0.01]Trad/sec,ωd=[0,0,0]Trad/sec.给出不确定参数为:ΔJ=diag[sin(0.1t),2sin(0.2t),3sin(0.3t)]kg·m2(26)Δm=5sin(0.5t)kg(27)外部干扰力及力矩为:(28)(29)其中,δ(ti,Δti)表示在时间ti开始作用的幅值为1,宽度为Δti秒的脉冲扰动.选择控制器的控制参数为:表示3×3的单位矩阵.数值模拟结果如图2~10所示.航天器的位置及平移速度随时间变化趋势如图2和3所示.航天器欧拉角变随时间变化趋势如图4所示.姿态速度和角的四元素随时间变化趋势如图5和6所示.图7和图8分别显示了航天器平移和机动的控制力和力矩输入.图9和10给出了滑模面随时间变化趋势.图2 航天器位置随时间变化趋势Fig.2 Time history of position for spacecraft 图3 航天器平移速度随时间变化趋势Fig.3 Time history of translation velocity for spacecraft图4 航天器欧拉角随时间变化趋势Fig.4 Time history of Euler angles for spacecraft图5 航天器角速度随时间变化趋势Fig.5 Time history of angular velocity for spacecraft图6 航天器四元数随时间变化趋势Fig.6 Time history of quaternion for spacecraft图7 航天器控制力矩输入随时间变化趋势Fig.7 Time history of control torque input for spacecraft图8 航天器控制力输入随时间变化趋势Fig.8 Time history of control force input for spacecraft图9 航天器平移控制的滑模面随时间变化趋势Fig.9 Time history of sliding surface for spacecraft translation control图10 航天器姿态控制的滑模面随时间变化趋势Fig.10 Time history of sliding surface for spacecraft attitude control如图2、图3所示,50秒后的位置和平移速度收敛到零.图4~6显示35秒后欧拉角,角速度及四元数收敛到零.外部干扰和惯性不确定性的影响已被有效地抑制并且轨迹是光滑的.根据图7和图8可以得到在180,190和200秒干扰力和力矩的影响.显然所设计的控制器有较好的抗干扰能力.尽管计入了脉冲和正弦干扰,它仍实现了良好的位置和姿态动力学响应.干扰模型(28)和(29)包括正弦脉冲和脉冲干扰.一般情况下,脉冲干扰对系统响应有很大的影响[14].因此,所提出的自适应终端滑模控制有效地抑制了这种干扰在平移和姿态机动中的影响.这也表明所提出的控制器能在t=0时使滑模面几乎同时达到S=0.仿真结果表明本文所设计的控制方案对于航天器的位置和姿态跟踪机动非常有效.4 结论本文介绍了自适应终端滑模控制器.它可以用来控制航天器有限时间收敛的平移和姿态机动,并能抑制不必要的抖振.利用控制律预估干扰和惯性的不确定,该控制方案无需知道干扰和惯性矩阵.这种自适应终端滑模控制方法不仅对于参数不确定具有鲁棒性而且具有较好的抗干扰能力.即使考虑脉冲和正弦扰动仍具有良好的位置和姿态动力学响应.通过列举控制具有耦合平移和姿态机动的航天器的例子,给出了控制器的效率和精度,并进行了验证与数值仿真.参考文献【相关文献】1Ahmed J, Coppola V T, Bernstein D S. Adaptive asymptotic tracking of spacecraft attitude motion with inertia matrix identification. Journal of Guidance, Control and Dynamics, 1998,21(5):684~6912Schotte J S, Miras T, Ohayon R. Effect of internal liquids on the vibrations of aerospace structures. In: 53rd AIAA/ASME/ASCE/AHS/ACS Structures, Structural Dynamics and Materials Conference, Hawaii, April 2012:2012~18873Yue B Z, Zhu L M. Hybrid control of liquid-filled spacecraft maneuvers by dynamic inversion and input shaping. AIAA Journal, 2014,52:618~6264Astrom K J, Wittenmark B. Adaptive control, 2nd ed. New Jersey: Addison-Wesley, 1995 5Zhu Z, Xia Y, Fu M. Adaptive sliding mode control for attitude stabilization with actuator saturation. International Journal of Robust and Nonlinear Control, 2011,21:686~7026Zhang F, Duan G. Robust adaptive integrated translation and rotation finite-time control of a rigid spacecraft with actuator misalignment and unknown mass property. International Journal of Systems Science, 2014,45(5):1007~10347Meirovitch L, Kwak M K. Dynamics and control of spacecraft with retargeting flexible antennas. Journal of Guidance, Control and Dynamics, 1990,13(25):684~6918Henderson D M. Euler angles, quaternions, and transformation matrices. NASA-TM-74839, 19779Sidi M J. Spacecraft dynamics and control. Cambridge: Cambridge University Press, 1997 10 Hardy G H, Littlewood J E, Polya G. Inequalities. Cambridge: Cambridge University Press, 195211 Bhat S P, Bernstein D S. Finite-time stability of continuous autonomous systems. SIAM Journal on Control and Optimization, 2000,38(8):751~76612 Yu S, Yu X, Shirinzadeh B,et al. Continuous finite-time control for robotic manipulators with terminal sliding mode. Automatica, 2005,41(11):1957~196413 吴文军. 带多充液贮箱及机动柔性附件航天器耦合动力学研究[博士学位论文]. 北京:北京理工大学, 2015 (Wu W J. Studies on Coupling Dynamics of Spacecraft with Multiple Liquid-filled Tanks and Maneuvering Flexible Appendages [Ph.D Thesis]. Beijing: Beijing Institute of Technology, 2015 (in Chinese))14 Pukdeboon C. Inverse optimal sliding mode control of spacecraft with coupledtranslation and attitude dynamics. International Journal of Systems Science,2015,46(13):2421~243815 Zhu Z, Xia Y, Fu M. Adaptive sliding mode control for attitude stabilization with actuator saturation. International Journal of Robust and Nonlinear Control, 2011,21:686~702。
滑模控制

(2)滑模面存在滑动模态区,即存在条件。 (3)滑动模态运动渐近稳定并具有良好的动态品质,即稳定条件。 控制函数 u 一般可表示为下列切换形式 u + ( x ) u= − u ( x) S ( x) > 0 S ( x) < 0 (4-1)
其中, u + ( x ) ≠ u − ( x ) 来体现变结构。 具体设计 u 时,有以下几种常用的方法:固定顺序控制器的设计、自有顺序 控制器的设计、最终滑动模态控制器的设计、线性控制与非线性控制器的设计。 根据滑模控制原理, 滑模可达性条件仅保证由状态空间任意位置运动点在有 限时间内到达切换面的位置的要求,而对趋近运动的具体轨迹未作任何限制,采 用趋近律的设计方法可以改善趋近运动的动态品质。几种典型的趋近律包括: 等 速趋近律、指数趋近律、幂次趋近律和一般趋近律。 在实际滑模变结构系统中, 由于时滞及惯性等因素的影响,系统状态轨迹到 达滑模面以后, 不是保持在滑模面上做滑动运动,而是在滑模面附近做来回穿越 运动,甚至产生极限环振荡,这种现象称为抖动。电力电子开关变换器,开关频 率不可能无限高,无法达到理想的滑动模态运动,采用何种方法限制开关频率, 消弱抖动是滑模变结构控制器研究的重要问题之一[86]。目前一般利用滞环的办 法限制开关频率, 达到接近理想滑动模态的控制效果。 但滞环的开关频率不固定, 变化的开关频率不利于输出滤波器的参数设计。
到达过程和滑动过程的特性决定滑模控制系统的动态响应速度85系统一旦进入滑动过程在一定条件下就对外界干扰及参数扰动具有不变性系统的综合问题被分解成两个低维的子系统的综合问题即设计滑模控制使得系统在有限的时间内到达指定的滑模面和选取适当的滑模面确保系统进入滑动过程后具有良好的动态特性
4.1
滑模控制的概念和设计
航天器姿态跟踪系统自适应滑模控制

航天器姿态跟踪系统自适应滑模控制李隆;侯建文;史小平;杨婧【摘要】针对刚体航天器存在外部有界干扰问题,结合自适应控制方法和滑模控制方法的优点,提出并设计了自适应滑模控制器.由于引入自适应律可以实现对外部干扰的在线估计,提高了控制律对外部干扰适应能力,体现了用自适应滑模方法设计的控制器对外部干扰的鲁棒性.将经典滑模控制器中的符号函数用双曲正切函数替换,消除了系统产生的抖振.最后将设计的控制器应用于航天器姿态跟踪控制中,并用Lyapunov稳定性理论分析了闭环系统的渐进稳定性,仿真结果表明该方法对系统外部干扰的影响具有良好的鲁棒性,设计的该控制策略可以实现高精度航天器姿态跟踪控制.【期刊名称】《电机与控制学报》【年(卷),期】2015(019)002【总页数】6页(P96-100,108)【关键词】航天器;姿态跟踪;抖振;自适应;滑模【作者】李隆;侯建文;史小平;杨婧【作者单位】哈尔滨工业大学航天学院,黑龙江哈尔滨150080;上海航天技术研究院,上海201109;哈尔滨工业大学航天学院,黑龙江哈尔滨150080;哈尔滨工业大学航天学院,黑龙江哈尔滨150080【正文语种】中文【中图分类】V448.22航天器姿态跟踪控制是指航天器从一个稳定姿态调整到另一个期望姿态并稳定下来的过程,无论在民用还是在军事应用中,航天器姿态跟踪控制都具有很重要的实用价值,是航天器运行模式中一类常见的姿态控制模式。
由于航天器所在的空间环境比较复杂,且航天器质量、载荷的改变会导致航天器转动惯量产生变化,因此航天器难免会受到外界空间环境的干扰力矩的影响,以及系统内部未知转动惯量参数变化的影响。
针对存在外部干扰及转动惯量不确定性的航天器姿态控制问题,众多国内外学者就此展开了大量的理论推导和仿真验证。
文献[1]考虑系统外界干扰和内部模型不确定性,设计了使跟踪误差一致最终有界的控制器,分别设计姿态控制系统的外环控制器和内环观测器。
姿态跟踪仿真结果表明设计的控制器能够有效实现飞行器的姿态跟踪控制。
航天器姿态指向跟踪的一种自适应滑模控制方法

·22·空间控制技术与应用AerospaceControlandApplication第36卷第6期2010年12月航天器姿态指向跟踪的一种自适应滑模控制方法王冬霞,石恒,贾英宏,周付根(北京航空航天大学,北京100191)摘要:航天器姿态指向跟踪(APT)技术是近年来引起深入研究的关键技术之一,设计一种自适应滑模控制律,通过设计自适应律考虑有界干扰力矩和转动惯量不确定因素的影响,同时使用滑模控制设计方法保证控制算法的鲁棒性,用双曲正切函数代替符号函数来克服滑模控制中存在的抖振问题,实现受控航天器的某个指向(相机或天线)保持对运动目标的跟踪.控制方案采用修正罗德里格斯参数(MRP)描述航天器姿态,用喷气推力器作为航天器的姿态执行机构.仿真结果显示了控制律的有效性.关键词:姿态指向跟踪;自适应滑模控制;修正罗德里格斯参数中图分类号:V448.2文献标识码:A文章编号:1674-1579(2010)06-0022-05AdaptiveSliding-ModeControlforSpacecraftAttitudePointingandTrackingSystemWANGDongxia,SHIHeng,JIAYinghong,ZHOUFugen(BeijingUniversityofAeronauticsandAstronautics,Be彬ng100191,China)Abstract:Spacecraftattitudepointingandtracking(APT)isoneofkeytechniquestobelucubratedre-cently.Thisarticleisaimedtodesignakindofadaptiveslidingmodecontrollaw.Consideringeffectsofsomeuncertainfactorssuchasboundeddisturbingtorqueandrotationalinertia,theadaptivelawschemeisdesigned.Atthesametime,aslidingmodecontrolmethodisusedtoguaranteetherobustnessoftrolalgorithmandituseshyperbolictangentfunction,insteadofsignfunction,toavoidthebuffetexistedinslidingmodecontrol,thuskeepingspecificpoinitingofcontrolledspacecrafttrackingsomemovingobject.Inthecontrolmethod。
航天器平移及姿态机动自适应终端滑模控制

第16卷第4期2018年8月1672⁃6553/2018/16⑷/332⁃6动力学与控制学报JOURNALOFDYNAMICSANDCONTROLVol.16No.4Aug.20182016⁃12⁃23收到第1稿,2017⁃09⁃13收到修改稿.∗国家自然科学基金(11472041,11532002,11772049)†通讯作者E⁃mail:bzyue@bit.edu.cn航天器平移及姿态机动自适应终端滑模控制∗岳宝增†㊀李晓玉(北京理工大学宇航学院,北京㊀100081)摘要㊀研究了用于航天器平移及姿态机动的自适应终端滑模控制方法.通过在广义准坐标下建立拉格朗日方程得到了刚体航天器平移及姿态耦合运动的动力学方程.能对存在模型不确定性和环境扰动下的航天器实现平移和姿态机动.该自适应过程包括对不确定性和干扰的估计㊁有效抑制传统滑模控制的抖振现象.利用李雅普诺夫稳定性理论证明了控制器的可达性和稳定性.通过航天器的位置以及姿态跟踪的数值仿真,验证了所设计控制器的有效性和准确性.关键词㊀滑模控制器,㊀航天器平移机动,㊀航天器姿态机动,㊀自适应控制,㊀不确定性及扰动DOI:㊀10.6052/1672⁃6553⁃2018⁃025引言现代航天器大角度姿态机动及轨道机动往往是以六个自由度的平动及姿态运动建模.此时系统的非线性运动方程中六个自由度的平动和旋转运动是动态耦合㊁高度非线性的.而且,未知的环境力矩会对航天器产生外部扰动,机动时的燃料晃动和消耗会使航天器的惯性矩阵和质量特性发生变化,导致参数不确定.因此,控制系统应该能够考虑外部干扰并适应质量分布的变化[1-3].自适应控制器能够修正自身特性以适应运动及扰动动态特性变化[4].由于现代航天器控制系统存在参数不确定及外部干扰,因而自适应控制器具有重要的实际意义.许多应用中(如轨道和大角度机动),航天器的惯性矩阵可能存在较大的模型误差,因此提出了自适应控制.机动过程中,系统的惯量矩阵将由于燃料消耗(或者燃料晃动及流体结构耦合动力学[1-3])或部件连接的改变而发生变化,因此控制器的设计必须有效克服这种变化对航天器的影响.自适应反馈控制可以解释并解决航天器跟踪目标轨道的问题[3].由于控制律具有六阶动态补偿器形式,因而无需知道航天器惯量或者质心位置.文献[5]研究了具有惯性不确定性及外部干扰的非线性航天器系统的姿态稳定问题.在应用滑模控制器控制闭环系统的状态变量时,需要自适应律预估干扰.对具有执行偏差及质量未知的刚体航天器整体平移及旋转的有限时间控制问题采用了反演鲁棒自适应控制方法[6].本文对航天器的耦合平移及姿态动力学进行了动力学和运动学描述,并将无奇异问题的四元数用于姿态运动学.应用自适应终端滑模控制器驱动航天器在有限时间内(非渐进式)到达目标轨道.所提出的设计方案具有快速机动响应性,并且对于模型的不确定性及环境扰动具有很好的鲁棒性.利用李雅普诺夫稳定性理论证明了控制器的可达性及稳定性.最后通过数值仿真验证了控制器的效率和准确性.1 航天器耦合平移及姿态动力学方程首先根据所要建立的耦合动力学模型选择坐标系,如图1所示.直角坐标系EXIYIZI为原点在E点的惯性参考系.直角坐标系OXsYsZs为固定在航天器刚体上的随体坐标系,其原点为主刚体质心,R是在坐标系EXIYIZI中所表示的从E到O的矢径.参考坐标系下的航天器姿态是由方向余弦矩阵或者欧拉角定义的.本文中,欧拉角被定义为关于刚体轴的旋转角,其中:θx,θy,θz分别是绕轴Xs,Ys,Zs的旋转角.坐标系变换矩阵按照OXsңOYsң第4期岳宝增等:航天器平移及姿态机动自适应终端滑模控制OZs的顺序.因而得到坐标系EXIYIZI和OXsYsZs的坐标系变换矩阵为:C=cyczcxsy+sxsyczsxsz-cxsycz-cyszcxcz-sxsyszsxcz+cxsyszsy-sxcycxcyéëêêêêùûúúúú(1)D=czcysz0-szcycz0sy01éëêêêêùûúúúú(2)其中:sk=sinθk,ck=cosθk.自由指标k表示固定于主刚体的坐标.V=C㊃̇R(3)ω=D㊃̇θ(4)V,ω分别是航天器相对于惯性系的速度和角速度(角速度表示为准坐标的时间导数以及坐标转化矩阵的积).图1㊀航天器系统的示意图Fig.1㊀Schematicrepresentationofthespacecraftsystem根据一般准坐标系下的拉格朗日方程,得到航天器六自由度平移和姿态运动的动力学方程[7].ddt∂L∂V{}+ωˑ∂L∂V{}-C∂L∂R{}=f+df(5)ddt∂L∂ω{}+Vˑ∂L∂V{}+ωˑ∂L∂ω{}-(DT)-1∂L∂θ{}=u+du(6)L表示拉格朗日函数.f和u分别是控制力和力矩.df和du分别是外部干扰力和力矩.符号ˑ表示作用于向量ω=[ωxωyωz]T的运算:ωˑ=0-ωzωyωz0-ωx-ωyωx0æèçççöø÷÷÷方程(5)和(6)可以写成如下形式:ṁV=-mωˑV+f+df(7)J̇ω=-ωˑJω+u+du(8)m和J分别为主刚体的质量和惯性矩阵.耦合系统的状态向量(或广义坐标系)可表示为Z=[Rx,Ry,Rz,θx,θy,θz,vx,vy,vz,ωx,ωy,ωz]T,耦合动力学和运动学方程(3),(4),(5)和(6)可以利用四阶的龙格库塔法联合求解.方程(3)和方程(4)用欧拉角描述了航天器的姿态动力学方程.欧拉角具有最小尺度的优点,但是存在计算量大及奇异性问题.本文采用四元数对刚体航天器进行了全局姿态描述.欧拉角转换为四元数的关系式如下[8]:q1=Sx/2Cy/2Cz/2+Cx/2Sy/2Sz/2q2=-Sx/2Cy/2Sz/2+Cx/2Sy/2Cz/2q3=Sx/2Sy/2Cz/2+Cx/2Cy/2Sz/2q4=-Sx/2Sy/2Sz/2+Cx/2Cy/2Cz/2ìîíïïïïïï(9)Sj/2=sin(θj/2),Cj/2=cos(θj/2),j=x,y,z.q=[qv;q4]=[q1,q2,q3,q4]T是航天器姿态的四元数,它们之间的关系式:q21+q22+q23+q24=1.此外,θiң0时,q1ң0,q2ң0,q3ң0,q4ң1.因而,航天器系统的姿态可以用以下运动学方程来描述[9].̇qv=12(q4I3+qˑv)ω(10a)̇q4=-12qTvω(10b)I3是三阶的单位矩阵.因此方程(3),(10),(7)和(8)构成了一组航天器耦合平移及姿态动力学的运动学及动力学方程.2㊀航天器平移和姿态机动的控制策略设计本节所设计的控制器是为航天器在参数不确定性及外部干扰下的运动提供鲁棒自适应控制.控制任务可以简单概述为:对于初始状态R(t0)=R(0)=R0(位置)以及θ(t0)=θ(0)=θ0(姿态)的航天器,所设计的控制律能够驱使闭环耦合的航天器系统在tңT时,状态(3)㊁(10)㊁(7)和(8)为零.其中T是收敛时间.可以表示为:limR0tңT=0,limVtңT=0,limqtңT=0,limωtңT=0(11)在给出控制设计之前,首先给出一些与设计控制方法相关的引理.引理1[10]㊀如果αɪ(0,1),那么下列不等式成立:333动㊀力㊀学㊀与㊀控㊀制㊀学㊀报2018年第16卷ð3i=1xi1+αȡæèçð3i=1xi2öø÷(1+α)/2(12)引理2[10]㊀对任意实数i=1, ,n,并且0<α<1,下列等式成立:x1+ +xn()αɤx1α+ +xnα(13)引理3[11]㊀设V(x)是一个C1光滑正定函数(定义U⊂Rn),并且̇V(x)+λVa(x)是一个半负定函数,其中U⊂Rn,αɪ(0,1),λɪR+,存在区间U0⊂Rn,对于任意从U0⊂Rn起始的V(x)在有限时间内能达到V(x)ʉ0.此外,如果Tmax是达到V(x)ʉ0需要的时间,那么:TmaxɤV1-α(x0)λ(1-α)(14)其中V(x0)是V(x)的初始值.引理4[12]㊀快速终端滑模形式的有限时间稳定的李雅普诺夫函数展开形式给出如下:̇V(x)+λ1V(x)+λ2Vα(x)ɤ0(15a)其中λ1>0,λ2>0,0<α<1,稳定时间为:Tmax=1λ1(1-α)lnλ1V1-α(x0)+λ2λ2(15b)对于航天器轨道控制,航天器轨道的终端滑模面(或切换面)设为:S1=CTV+κ1R+κ2sig(R)r(16)其中S1=[S1x,S1y,S1z]T,κ1>0,κ2>0,0<r<1.函数sig(㊃)P定义为:sig(x)p=x1psign(x1), ,snpsign(xn)[]T,当在滑模面S1=0上时,得到:V=C-κ1R-κ2sig(R)r[](17)为证明滑模面的可达性,李雅普诺夫函数为:V1=12mRTR(18)求导得到:̇V1=mS1ṪS1=mS1TCṪV+κ1̇R+κ2rdiag(Rr-1)̇R()=-κ1mRTR-κ2mRr+1ɤ-2κ1V1-κ2mð3i=1Ri2()r+12=-2κ1V1-κ2m1-r2V1r+12<0由于0<r+12<1,所以根据引理3得到航天器位置可在有限时间内从初始R(t0)到达R(t)=0,最长时间为:(T1)maxɤ1κ1(1-r)ln2κ1V(1-r)/2(R(t0))+κ2m1-r2κ2m1-r2(19)定理1㊀由方程(3)㊁(7)得到的滑模面,控制器(20)能使闭环系统的轨迹在有限时间内达到该滑模面的邻域,并且最终收敛至原点.f=C-κ3S1-κ4sig(S1)r[]-sign(S1)μmV+F[](20)μ=-ωˑ+κ1I3+κ2rdiag(Rr-1)(),κ3>0,κ4>0,向量xɪRn的范数定义为x=xTx.控制器的稳定性证明过程参考文献[13].类似的,根据引理3,得到航天器轨道终端滑模面由S1(t0)到达S1(t)=0的最长时间为:(T2)maxɤmκ3(1-r)ln2κ3V(1-r)/2(S1(t0))+2κ4m-(1+r)/22κ4m(1-r)/2(21)为了抑制控制器的抖振,用饱和函数代替方程(20)的符号函数,控制器转换为:f=C-κ3S-κ4sig(S)r[]-sat(S,e)μmV+F[](22)e=[e1,e2,e3]为约束抖振的符号函数:satSi,ei[]=signSi(),Si>eiSi/ei,Siɤei{(23)在质量变化以及存在外部干扰的情况下,控制器(21)可使系统由初始状态(3)和(7)在有限时间内达到初始状态.但是该控制器存在两个缺点:(1)干扰df的上限F在实际系统中可能未知.(2)控制器涉及矩阵范数μ的计算使得计算控制输入需要更多时间.因此,基于控制器(21)提出以下自适应控制方案:f=C-κ3S1-κ4sig(S1)r[]-sat(S1,e)^m(t)V+^f(t)[]^m㊃(t)=-ζ0^m(t)+S1^f㊃(t)=-ζ1^f(t)+S1Vìîíïïïïïï(24)ζ0>0,ζ1>0.该控制器效率及可行性的证明参考文献[13].该控制方案具有两个特点:(1)控制器不依赖于质量m,因而可以应用于存在多个未知m的航天器系统,并且可以利用自适应方法估计扰动上限.(2)算法计算简单,不包括任何矩阵范数的计算.由于驱动发动机控制力的大小通常是有限的,433第4期岳宝增等:航天器平移及姿态机动自适应终端滑模控制为了避免过控制并节约能量,与坐标状态参数增益系数的直接相关量应该大于坐标状态参数间接相关量,即:κ1>κ2,κ3>κ4.此外,当驱动力变化过快时,会引起液体燃料晃动或者挠性附件的振动力,这将会显著影响航天器的姿态和轨道,最终导致航天器控制器失效.因此,所有控制器的增益系数必须选择一些较小的值.对于考虑惯性不确定性以及外界干扰的航天器姿态控制,根据参考文献[15]最终给出快速终端滑模控制器(AFTSM)如下:S2=ω+λ1qv+λ2sig(qv)pu=-σsig(S)p-sign(S)^c(t)+^k3(t)ω[]^c㊃(t)=p0-ε0^c(t)+S[]^k㊃3(t)=p1-ε1^k3(t)+Sω[]ìîíïïïïïï(25)S=[S2x,S2y,S2z]TɪR3,λ1>0,λ2>0,0<p<1,σ=diagσ1,σ2,σ3[],σi>0.3 数值模拟与讨论本节对刚体航天器的平移和姿态机动问题进行了仿真,证明了滑模控制器(24)和(25)的作用.在仿真中使用的是文献[5,14]中的航天器模型,其中航天器参数:J=1000-50-10-301000-40-20-40800éëêêêêùûúúúúkg㊃m2,m=100kg.航天器机动的初始条件和期望的最终状态如表1所示.表1㊀航天器机动的初始状态及目标状态Table1㊀TheinitialconditionsandthedesiredfinalstatesforspacecraftmaneuveringinitialconditionsdesiredfinalstatesR(0)=[-10,10,20]Tm,Rd=[0,0,0]Tm,V(0)=[0,0,0]Tm/sec,Vd=[0,0,0]Tm/sec,q(0)=[0.3,-0.2,-0.3,0.893]T,qd=[0,0,0,1]T,ω(0)=[0.01,-0.02,0.01]Trad/sec,ωd=[0,0,0]Trad/sec.给出不确定参数为:㊀ΔJ=diag[sin(0.1t),2sin(0.2t),3sin(0.3t)]kg㊃m2(26)Δm=5sin(0.5t)kg(27)外部干扰力及力矩为:df(t)=10sin(π100t)(2π100t)(3π100t)éëêêêêêêêêùûúúúúúúúú+10δ(180,2)δ(190,2)δ(200,2)éëêêêùûúúúN(28)du(t)=0.5sin(π100t)(2π100t)(3π100t)éëêêêêêêêêùûúúúúúúúú+0.5δ(180,2)δ(190,2)δ(200,2)éëêêêùûúúúN㊃m(29)其中,δ(ti,Δti)表示在时间ti开始作用的幅值为1,宽度为Δti秒的脉冲扰动.选择控制器的控制参数为:k1=0.02,k2=0.001,k4=0.25I3,k3=0.2I3,r=0.7,ζ0>50,ζ1>70,^m(0)=0,^f(0)=0,p=0.6,σ=0.1mI3,ε0=ε1=0.2,^c(0)=^k(0)=0,I3表示3ˑ3的单位矩阵.数值模拟结果如图2 10所示.航天器的位置及平移速度随时间变化趋势如图2和3所示.航天器欧拉角变随时间变化趋势如图4所示.姿态速度和角的四元素随时间变化趋势如图5和6所示.图7和图8分别显示了航天器平移和机动的控制力和力矩输入.图9和10给出了滑模面随时间变化趋势.图2㊀航天器位置随时间变化趋势Fig.2㊀Timehistoryofpositionforspacecraft图3㊀航天器平移速度随时间变化趋势Fig.3㊀Timehistoryoftranslationvelocityforspacecraft图4㊀航天器欧拉角随时间变化趋势Fig.4㊀TimehistoryofEuleranglesforspacecraft533动㊀力㊀学㊀与㊀控㊀制㊀学㊀报2018年第16卷图5㊀航天器角速度随时间变化趋势Fig.5㊀Timehistoryofangularvelocityforspacecraft图6㊀航天器四元数随时间变化趋势Fig.6㊀Timehistoryofquaternionforspacecraft图7㊀航天器控制力矩输入随时间变化趋势Fig.7㊀Timehistoryofcontroltorqueinputforspacecraft图8㊀航天器控制力输入随时间变化趋势Fig.8㊀Timehistoryofcontrolforceinputforspacecraft图9㊀航天器平移控制的滑模面随时间变化趋势Fig.9㊀Timehistoryofslidingsurfaceforspacecrafttranslationcontrol图10㊀航天器姿态控制的滑模面随时间变化趋势Fig.10㊀Timehistoryofslidingsurfaceforspacecraftattitudecontrol如图2㊁图3所示,50秒后的位置和平移速度收敛到零.图4 6显示35秒后欧拉角,角速度及四元数收敛到零.外部干扰和惯性不确定性的影响已被有效地抑制并且轨迹是光滑的.根据图7和图8可以得到在180,190和200秒干扰力和力矩的影响.显然所设计的控制器有较好的抗干扰能力.尽管计入了脉冲和正弦干扰,它仍实现了良好的位置和姿态动力学响应.干扰模型(28)和(29)包括正弦脉冲和脉冲干扰.一般情况下,脉冲干扰对系统响应有很大的影响[14].因此,所提出的自适应终端滑模控制有效地抑制了这种干扰在平移和姿态机动中的影响.这也表明所提出的控制器能在t=0时使滑模面几乎同时达到S=0.仿真结果表明本文所设计的控制方案对于航天器的位置和姿态跟踪机动非常有效.4 结论本文介绍了自适应终端滑模控制器.它可以用来控制航天器有限时间收敛的平移和姿态机动,并能抑制不必要的抖振.利用控制律预估干扰和惯性的不确定,该控制方案无需知道干扰和惯性矩阵.这种自适应终端滑模控制方法不仅对于参数不确定具有鲁棒性而且具有较好的抗干扰能力.即使考虑脉冲和正弦扰动仍具有良好的位置和姿态动力学响应.通过列举控制具有耦合平移和姿态机动的航天器的例子,给出了控制器的效率和精度,并进行了验证与数值仿真.参㊀考㊀文㊀献1AhmedJ,CoppolaVT,BernsteinDS.Adaptiveasymp⁃totictrackingofspacecraftattitudemotionwithinertiama⁃trixidentification.JournalofGuidance,ControlandDy⁃namics,1998,21(5):684 6912SchotteJS,MirasT,OhayonR.Effectofinternalliquidsonthevibrationsofaerospacestructures.In:53rdAIAA/ASME/ASCE/AHS/ACSStructures,StructuralDynamicsandMaterialsConference,Hawaii,April2012:2012 18873YueBZ,ZhuLM.Hybridcontrolofliquid⁃filledspace⁃craftmaneuversbydynamicinversionandinputshaping.AIAAJournal,2014,52:618 6264AstromKJ,WittenmarkB.Adaptivecontrol,2nded.633第4期岳宝增等:航天器平移及姿态机动自适应终端滑模控制NewJersey:Addison⁃Wesley,19955ZhuZ,XiaY,FuM.Adaptiveslidingmodecontrolforattitudestabilizationwithactuatorsaturation.InternationalJournalofRobustandNonlinearControl,2011,21:686 7026ZhangF,DuanG.Robustadaptiveintegratedtranslationandrotationfinite⁃timecontrolofarigidspacecraftwithactuatormisalignmentandunknownmassproperty.Inter⁃nationalJournalofSystemsScience,2014,45(5):100710347MeirovitchL,KwakMK.Dynamicsandcontrolofspace⁃craftwithretargetingflexibleantennas.JournalofGuid⁃ance,ControlandDynamics,1990,13(25):684 6918HendersonDM.Eulerangles,quaternions,andtransfor⁃mationmatrices.NASA⁃TM⁃74839,19779SidiMJ.Spacecraftdynamicsandcontrol.Cambridge:CambridgeUniversityPress,199710㊀HardyGH,LittlewoodJE,PolyaG.Inequalities.Cam⁃bridge:CambridgeUniversityPress,195211㊀BhatSP,BernsteinDS.Finite⁃timestabilityofcontinu⁃ousautonomoussystems.SIAMJournalonControlandOptimization,2000,38(8):751 76612㊀YuS,YuX,ShirinzadehB,etal.Continuousfinite⁃timecontrolforroboticmanipulatorswithterminalslidingmode.Automatica,2005,41(11):1957 196413㊀吴文军.带多充液贮箱及机动柔性附件航天器耦合动力学研究[博士学位论文].北京:北京理工大学,2015(WuWJ.StudiesonCouplingDynamicsofSpacecraftwithMultipleLiquid⁃filledTanksandManeuveringFlexi⁃bleAppendages[Ph.DThesis].Beijing:BeijingInstituteofTechnology,2015(inChinese))14㊀PukdeboonC.Inverseoptimalslidingmodecontrolofspacecraftwithcoupledtranslationandattitudedynamics.InternationalJournalofSystemsScience,2015,46(13):2421 243815㊀ZhuZ,XiaY,FuM.Adaptiveslidingmodecontrolforattitudestabilizationwithactuatorsaturation.InternationalJournalofRobustandNonlinearControl,2011,21:686 702Received23December2016,revised13September2017.∗TheprojectsupportedbytheNationalNaturalScienceFoundationofChina(11472041,11532002,11772049).†CorrespondingauthorE⁃mail:bzyue@bit.edu.cnADAPTIVETERMINALSLIDINGMODECONTROLFORSPACECRAFTWITHTRANSLATIONANDATTITUDEMANEUVERS∗YueBaozeng†㊀LiXiaoyu(SchoolofAerospaceEngineering,BeijingInstituteofTechnology,Beijing㊀100081,China)Abstract㊀Adaptiveterminalslidingmodecontrolforspacecraftwithcoupledtranslationandattitudemaneuversisinvestigatedinthispaper.ThemathematicalmodelfortherigidspacecraftwithtranslationandattitudecoupleddynamicsareobtainedbymeansofLagrangeᶄsequationsintermsofgeneralquasi⁃coordinates.Anadaptivefastterminalslidingmodecontrolisproposedforspacecrafttoachievetranslationandattitudemaneuversinthepres⁃enceofmodeluncertaintiesandenvironmentalperturbations.Thisadaptiveprocedureconsistsoftheestimationoftheuncertaintyanddisturbanceandensurestheeffectivesuppressionoftheundesiredchattering.Thereach⁃abili⁃tyandthestabilityofthecontrollersareprovedbymeansoftheLyapunovᶄsstabilitytheory.Theefficiencyandtheaccuracyoftheproposedcontrollerareexaminedthroughnumericalsimulationsofthespacecraftpositionandattitudetrackingmaneuvers.Keywords㊀slidingmodecontroller,㊀spacecrafttranslationmaneuvers,㊀spacecraftattitudemaneuvers,㊀adaptivecontrol,uncertaintyanddisturbance733。
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
第15卷第1期2017年2月 1672-6553/2017/15(1 ̄087-6 动力学与控制学报
JOURNAL OF DYNAMICS AND CONTROL V0l_15 No.1
Feb.2017
引言 航天器近距离相对轨道的滑模控制水 张莹 都琳 岳晓乐 许勇 (西北工业大学理学院应用数学系,西安710072)
摘要基于滑模控制原理,研究了近距离追踪航天器与目标航天器交会对接时,相对运动轨道的控制问题. 首先,建立非线性航天器相对运动模型;其次,利用滑模控制原理和分数阶导数的相关性质,设计了整数阶 PD控制器和分数阶PD 控制器;最后,分别运用整数阶和分数阶控制器对未扰和受扰系统实施控制.数值 仿真结果表明,整数阶与分数阶控制器均能实现对未扰和受扰系统的控制,验证了方法的有效性.同时发 现,在时效性上,分数阶控制器明显优于整数阶控制器;在能效性上,达到相同控制目标时,分数阶控制器的 能量消耗大于整数阶控制器. 关键词航天器,相对运动,滑模控制,分数阶导数 DOI: l0.6052/1672-6553-2016_()4O
随着空间组装、在轨服务和深空探测等航天任 务的发展与应用越来越广泛,航天器经常需要跟踪 一个给定姿态的航天器来完成某些空间任务,因此 航天器姿态跟踪动力学与控制问题成为了当前航 天领域的研究热点与前沿 J. 航天器姿态控制系统是一个复杂的非线性系 统,而且受各种环境的干扰而无法精确描述,诸如 太阳辐压、重力梯度和地球磁场等,因此航天器姿 态控制系统需要具有良好的鲁棒性.滑模控制是一 种较新的控制策略,它与常规的控制方法的根本区 别在于其控制的不连续性.系统的“结构”可以在 瞬变过程中,根据系统当时的状态以跃变方式有目 的的变化,迫使系统沿着预定的“滑动模态”运动. 此外,这种滑动模态具有可设计性,且与系统参数 及扰动无关.因此,处于滑模运动的系统具有优良 的鲁棒性 j.已有一些研究工作及工程实践证明 了滑模控制器的许多优点,如快速的动态响应、良 好的瞬态性能、较强的抗外部扰动性能和对不确定 参数的高度敏感性等_6 .近年来,该方法受到了 广泛的关注和重视.然而,随着航空技术的发展与 提高,在时效性上,传统的滑模控制方法已无法满 足需求.因而,为了改进控制方法的时间效率,本文 针对航天器近距离相对轨道问题,基于滑模控制原 理和分数阶微积分的记忆及遗传特性,设计了分数 阶滑模控制.首先,选用非线性方程作为航天器近 距离相对轨道的动力学模型;随后,分别设计了整 数阶PD控制器和分数阶PD 控制器;最后,通过 数值仿真验证所建立模型和控制律的有效性,并对 两种控制方法进行了详细的分析与比较.
1坐标系定义 为了描述目标航天器和追踪航天器间的相对 运动,建立如图1所示的坐标,系.其中,地心赤道惯 性坐标系用0 Y z (Js )表示,原点0 在地球中心, 轴在赤道面内,指向春分点; 轴沿地球旋转轴 (即垂直于赤道平面),指向北极,Y 轴与 、z 轴满 足右手定则.追踪航天器坐标系用0 Y (S )表 示,原点0 位于航天器的质心,z ,Y , 分别与航 天器的惯性主轴一致,本体轴 ,Y , 相对于惯性 系的旋转分别表示滚转、俯仰和偏航.目标航天器 轨道坐标系用Oxyz(S。)表示,原点O为目标航天 器质心,z轴指向地心, 轴在轨道面内沿速度方向 与 轴垂直, 轴满足右手定则.
2016-07-27收到第1稿,2016-08-23收到修改稿. 国家自然科学基金资助项目(11302171,11672232),陕西省自然科学基础研究计划资助项目(2o16JQlO15) 十通讯作者E-mail:hsux3@nwpu.edu.cn 动力学与控制学报 2017年第l5卷 图1坐标系示意图 Fig.1 Coordinate systems
2相对轨道动力学模型 在目标航天器轨道坐标系下,选用非线性方程 描述两航天器的相对运动:
一2oy: z +Oy一 + + ,c ,t
+20 ̄c=02y一学x一 { ,c
2=一 z+fcz (1) 其中, 为地球引力常数,目标航天器和追踪航天 器分别用下标t和C表示,r 和 为地心到航天器 质心的位置矢量,rf和r 分别为rl和r 的模,且rc
= ̄/(ri+ ) +y +z .从目标航天器指向追踪航天 器的相对位置矢量P=【 ,y,z] ,相对速度矢量 =[戈,少,2] ,则在目标航天器轨道坐标系下P=
一 =[ , ,zr, 为追踪航天器的轨道控制推理 所产生的加速度;0为真近点角,0和 分别为目标 航天器的轨道角速度和角加速度.
3滑模控制仿真 基于滑模控制理论和分数阶导数的特性,本文 分别建立了整数阶PD控制器和分数阶PD“控制 器. 3.1 PD控制 相对轨道方程(1)经推导可转化为如下形式:
=AlP+A2p+g(p)+M (2) 其中 g(p)= A1= 二 3± 2一 3 ● ,c ,f ,t + ,c ,£ 一-/xz j_ 3 3 _ + 0 r. 一 一/k _0 r. 0 r 0 2 l Az=l一20 0 I L 0 0 “=[ 】 0 一/x, r. 0-1 l 0 l l0J 选取状态变量 =[P, ]T则式(2)可进一步整理 为: =Ax+Bu+C(p) (3) 其中, = 03 ̄3 1A3 x ] 日= G(P)=[g0(3px1)] 随后,选取理想状态变量 =[P , ] ,则式(3)可 推导为: 戈d一 =A(xd— )+(一Bu)+戈d—Axd—C(p) (4) 此时,选取误差变量Xe=[e,e] =[P 一JD,p 一 ] ,则上式可写为: [;]=A[;]+c—Bu + 一A, ̄d-Gcp,c5 令厂= d—Axd,B =一B,贝0有: =AX +B M+ 一C(p) (6) 设计切换函数如下: s:ce+e=[c'l j[e】:CXe (7) 其中,c>0且∈R,当系统状态在切换面s=0(滑动 模态区)时有垂=一ce,系统处于滑动模态区_若采 用趋近律到达条件,选取指数趋近律为: 第1期 张莹等:航天器近距离相对轨道的滑模控制 89 =一6sgns一凰 (8) 其中,s,k>0且∈R,sgn(・)是符号函数.进一步 对式(7)求导得: = +ce=【c,・][;】=Cx :一 sgns一 s(9)
将式(6)代入上式得: C【A +B +f-G(p)】=一6sgns一 (10) 推导得控制律为: =(凹 )一 [一6sgns—ks—CAXe—cf+CG(p)] (11) 3.2 PD 控制 设计滑模面为: S=D。e+ce=D 一e+ce (12) 其中,D t)是Caputo分数阶导数 ,它的定义可 描述如下: 。 = l_ for n一1< <n (13) 其中,r(z)=I e-tt dt是欧拉伽马函数. 对(12)式两端同时求导得: =D + (14) 将(6)式带入上式得: =D 一 [Ae+ M+,一C(p)]+c (15) 选取指数趋近律为(8),则: =D 一。[Ae+B M+ 一C(p)]+ =一6sgnS一 S (16) 推导得控制律为: =B 一1{一Ae一 +G(p)+ D 一 [一6sgnS—kS—c ]} (17) 4数值仿真与分析 本节运用上述两种控制器,分别针对未扰系统 和受扰系统进行控制仿真,计算控制效果;并从时 效性和能效性两方面对不同的控制方法进行分析 与比较. 4.1控制仿真 (1)未扰系统的控制仿真 目标航天器轨道的六要素选取如下:轨道的半 长轴a=7178.145km,偏心率e=0,升交点赤径Q=  ̄r/6,轨道倾角i=7r/4,近地点角距 = ̄r/6,航天器 过近地点的时刻t。=0.此外,目标航天器与追踪航 天器间的初始相对位置和速度赋值为P= [一60,35,一50] m和P=【一5,10,一8] m/s,其期 望值分别为Pd=[0,0,0rm和 =[0,0,0rm/s.分 别采用PD与PD 控制法,对航天器相对轨道进行 控制,数值仿真结果如图2~图5所示.其中,图2和 图4分别表示PD与PD 控制下目标航天器与追踪 航天器间的相对位置误差,图3和图5分别表示PD 与PD 控制下目标航天器与追踪航天器间的相对速 度误差.在初始位置和速度均存在偏差的情况下,两 种控制器均可将位置偏差和速度偏差控制到零,验 证了控制器的有效性.此外,在达到相同控制目标的 过程中,分数阶滑模控制的所需控制时长较整数阶 滑模控制大幅减少.因此,在时效性上,分数阶滑模 控制方法明显优于整数阶滑模控制方法.
图2 PD控制下的相对位置误差 Fig.2 Error of relative position under PD controller
图3 PD控制下的相对速度误差 Fig.3 Error of relative velocity under PD controller
(2)受扰系统的控制仿真 若考虑外部扰动对航天器相对轨道控制的影 响,其轨道动力学模型可表示如下: =Ax+日M+C(p)+d(t) (18) 其中,d(t)=[d (t)d2(t)d3(t) 为外部对系统的有 界扰动,这里d(t)=0.2[COS(2t)cos(2t)cos(2t)] ; 系统中其他参数与未扰系统保持一致.分别采用 动力学与控制学报 20t7年第15卷 PD控制器与PD 控制器对系统(18)进行控制仿 真,数值结果如图6一图9所示.其中,图6和图8 表示受扰系统在PD与PD“控制下目标航天器与 追踪航天器间的相对位置误差;图7和图9分别表 示受扰系统在PD与PD 控制下目标航天器与追 踪航天器间的相对速度误差.由图知,在系统受到 外界扰动的情况下,两种滑模控制器均可实现系统 的控制目标;且分数阶滑模控制器的时效性仍明显 优于整数阶滑模控制器. ”厂———————————T=
一。 i。 ———————— 童 I l 蚕棚f 1
差瑚} 1 棚}Jl I
图4 PD 控制下的相对位置误差 Fig.4 Error of relative position under PD controller
厂—————————广_————T== soo} l二:l :[ ]
£ } 1 富 I l} 1
{。 ————————— } l 量一} jl {
图5 PD。控制下的相对速度误差 Fig.5 Error of relative velocity under PD controller
图6 Fig.6 PD控制下的相对位置误差(受扰系统)
Error of relative position under PD controller (perturbed system)