随着对液体晃动影响的重视,对液体晃动建模方法的研究成果也颇多。其中,等效力学模型简单、高效,相对于其他试验、理论、数值仿真等研究方法,更有利于控制器的设计。现有等效力学模型中,研究较为成熟且被控制系统设计广泛采用的主要有单摆模型,其将晃动的液体部分等效为质量、摆长固定的单摆,用摆角的变化描述液体的晃动行为,一旦液体晃动的幅度占充液腔体半径的比例达到25%以上,呈现出大幅且非线性的特点,该等效模型则不再适用。此时,可用的等效力学模型主要有运动脉动球模型[3]、多级摆模型、质心面模型[4]等。其中,运动脉动球模型被用在Sloshsat FLEVO(Sloshsat Facility for Liquid Experimentation and Verification On-Orbit)卫星的控制方法研究中,不同工况下的试验数据表明了该模型可准确地等效液体大幅晃动。
进行充液航天器的姿态控制器设计时,主要考虑转动惯量的不确定性及外部环境的干扰等因素,所以控制系统应具有良好的自适应性与鲁棒性[5]。其研究方法主要有:①滑模控制方法。其是在研究非线性系统时,经常被使用的控制方法,具有鲁棒性强、设计与实现简单的优点。文献[6]针对欠驱动系统,就航天器和液体晃动的状态量设计了分层滑模面,具有镇定姿态和抑制液体燃料在贮箱内晃动的控制效果。文献[7]在考虑液体大幅晃动和挠性附件振动的情况下,设计了线性滑模面,对姿态系统进行滑模控制,并结合自适应算法来提高控制精度,最终实现了对目标姿态的精确追踪。文献[8]将自适应思想与终端滑模控制2种方法结合在一起,在有限时间内实现了各状态量的收敛,相比于一般渐近稳定的控制方法,该方法在收敛速度上更快、精度也更高。文献[9]引入输入整成型技术,在保证控制效果的同时,有效地抑制了变量的抖震。②模糊控制方法。文献[10]基于局部线性模型的加权和建立了非线性T-S模糊模型,在此基础上分别设计了并行分配补偿(Parallel Distributed Compensation,PDC)控制方法和线性二次调节器(Linear Quadratic Regulator,LQR)控制方法,仿真表明,PDC控制方法在控制性能和鲁棒性上效果更佳。③非线性反馈控制方法。文献[11-12]分别考虑液体小幅、大幅晃动的情况,基于弹簧-质量块模型和运动脉动球模型,使用基于Lyapunov函数的方法,进行反馈控制器的设计。文献[13]考虑外部干扰的存在及部分未知的参数,设计了自适应算法与非线性反馈控制方法相结合的混合控制器,获得了较好的姿态镇定效果,液体的晃动行为也逐渐平稳。
与此同时,航天器的计算机资源有限,如果通信频繁,不但会堵塞通信信道,也会对航天器的正常运行、使用寿命造成恶劣的影响[14]。传统的控制方法每隔固定的时间就会对信号进行更新,但部分信号的更新是没有必要的,这样会造成通信的资源浪费。而事件触发机制只有在满足事先设定的事件时,才会对信号进行更新,其可以在保证控制效果的同时,显著地降低通信频率[15],减轻通信负载。文献[16]针对系统传感器与控制器间状态量的更新,提出了基于扰动理论的事件触发机制,最终刚体航天器的姿态实现了指数型稳定。文献[17]考虑航天器系统存在外部干扰力矩的情况,结合反步法与逆最优控制方法,并在控制器端引入决定控制信号更新的事件触发机制,稳定性证明与仿真结果都表明该方法保证了航天器系统所有状态量在一定的界内。文献[18]考虑同时存在外部干扰且发生执行器故障的情况,根据设计的事件触发机制,提出了一种自适应分布式协同姿态控制律,以确保航天器系统能够协同追踪上期望的姿态轨迹,在设计事件触发机制的过程中,应确保事件触发间隔恒大于零,否则会看到在有限时间内无限次事件被触发的Zeno现象[19]。
本文围绕通信资源受限、液体大幅晃动下的充液航天器姿态控制系统展开研究。本文的创新点在于:①基于描述充液航天器固-液耦合特性的运动脉动球模型,考虑液体大幅晃动产生的非线性干扰,采用自适应更新与滑模控制相结合的策略,估计干扰项的界并进行补偿,提高系统的鲁棒性。②考虑到充液航天器的通信资源有限,基于事件触发的思想,设计了与滑模面有关的触发阈值,根据系统状态量与滑模面之间的距离决定控制信号的更新,相比传统的时间触发机制,可有效减轻控制器与执行器之间的通信负载,实现对通信资源的高效利用。③针对事件触发与自适应滑模的复合控制方法,设计Lyapunov函数对充液航天器姿态控制系统进行稳定性分析,证明了系统的状态量将最终一致有界,而且控制输入的更新频率得到显著降低,不存在Zeno现象,平旋机动下的仿真也验证了该控制策略的可行性。
1 模型描述与控制目标 1.1 模型描述 本文用运动脉动球模型描述充液航天器中液体的大幅晃动,将任意形状的贮箱等效为球形贮腔,大幅晃动的液体等效为半径不断变化的脉动球[20],如图 1所示。
图 1 充液航天器的模型示意图 Fig. 1 Schematic diagram of liquid-filled spacecraft model |
图选项 |
在图 1中,本体坐标系Cxyz以贮箱的几何中心C为原点,相对于惯性坐标系的角速度为Ω,平动速度为VC。航天器刚体部分的质量为M;相对于质心转动惯性矩阵为I。FE、TE分别为待设计的控制力、力矩;FL、TL分别为液体在贮箱内晃动而产生的干扰力、力矩;rE和rL分别为FE和FL作用点的位置向量。任意形状的贮箱被等效为球心在贮箱几何中心的球形贮腔,半径为R;其质心的位置向量为rT。液体部分被等效为半径R-r、质量m、始终与贮腔保持接触的均匀脉动球,两者的接触点为Pa。其中,r为脉动球的质心的位置向量rS的模长,e为rS的单位向量。脉动球相对于贮箱的平动速度为VS、角速度为ωS。
下面给出充液航天器姿态控制系统在本体坐标系Cxyz中的动力学方程。其中,航天器刚体部分为
(1) |
(2) |
等效为脉动球的液体部分为
(3) |
(4) |
在运动脉动球模型中,FL由法向力Ne和摩擦力Fb组成,即
(5) |
(6) |
(7) |
式中:ω=e×VS/r为e的转动速度;σ为液体的表面张力;μ为液体燃料的运动黏性系数;L=R-r为脉动球的半径。
液体晃动的作用力矩TL的表达式为
(8) |
(9) |
式中:Lmin为脉动球的最小半径,即液体的惯性张量最小时对应的等效半径;ωr=e·(e·ωS)为ωS沿e的分量;0≤tsr≤1为脉动球绕轴转动和滚动转动的权值;ρ为脉动球的密度。
本文中的“×”符号表示若a=[a1??a2??a3]T,则a×为a的反对称矩阵:
(10) |
本文只对充液航天器的姿态控制进行研究,故忽略VC、
(11) |
式中:
(12) |
进一步简化,得
(13) |
(14) |
式中:J为整个航天器(包括液体部分)的转动惯量矩阵,由刚体部分固有转动惯量J0和液体晃动导致的时变转动惯量ΔJ共同组成,即J=J0+ΔJ, J0=I;u=TE;d为由于液体晃动而作用在充液航天器姿态上的全部干扰力矩。
充液航天器的姿态运动学方程可以表示为
(15) |
式中:q=[q0??qvT]T=[q0??q1??q2??q3]T为充液航天器动坐标系相对惯性坐标系的姿态四元数;I3=diag(1, 1, 1)。
1.2 控制目标 考虑航天器实际的机动情况及下文中对控制器的研究,提出假设:
假设1??不确定的转动惯量部分ΔJ及其一阶导数有界,即存在未知常数γ0≥0和γ1≥0,使||ΔJ||≤γ0,
假设2??液体晃动产生的干扰力矩d有界,即存在未知常数γ2≥0,使||d||≤γ2成立。
基于上述假设,针对式(13)和式(15)所描述的航天器姿态控制系统,考虑液体大幅非线性晃动,以及有限的通信资源,设计姿态控制器u,实现姿态四元数q→[1??0??0??0]T,角速度Ω→[0??0??0]T。
2 控制器设计 图 2为本文设计的事件触发姿态控制系统[15, 21-22]。传感器、控制器及执行器通过网络进行信息融合。为了实现网络通信资源的高效利用,在控制器端加入设计的事件触发,对于传感器测量得到的状态量信息,在姿控模块进行在线计算,满足触发条件的控制输入才会被传输到执行器,这样可减少控制信号传输对通信网络的资源占用。
图 2 事件触发机制的姿态控制系统框图[15, 21-22] Fig. 2 Attitude control system block diagram of event-triggering mechanism[15, 21-22] |
图选项 |
首先结合控制目标,对于单位四元数描述的姿态控制系统,设计滑模面为
(16) |
式中:K=diag(K1, K2, K3), Ki>0, i=1, 2, 3。
控制信号为
(17) |
式中:v(t)为待设计的控制信号;tk指第k次触发事件的时刻。
相比固定阈值的事件触发机制(触发阈值为恒定的数值,不发生改变),相对阈值的事件触发机制(随状态量发生变化)可以进一步地减小事件触发的频率,提高通信资源的利用率。而在滑模控制器的设计过程中,控制输入需要让状态量先收敛到滑模面上,继而能够收敛到平衡点。因此,选择与滑模面相关的触发阈值,既有利于控制性能的保证,又能实现通信资源的节约[23]。当系统的状态量离滑模面的距离较大时,相应地,触发阈值也大,触发间隔长,通信负载低;当与滑模面的距离较小时,相应地,触发阈值也小,控制输入精准更新,控制精度高。故事件触发机制为
(18) |
式中:u(t)=v(tk),tk≤t < tk+1;k1>0;0 < α < 1;χ>0。
对滑模面(16)求导,并代入式(13)和式(15)。
(19) |
引入向量D,得
(20) |
根据假设1和假设2,以及单位四元数的性质||qv×+q0I3||=1,可以得到
(21) |
(22) |
(23) |
综合上述不等式,可以得到
(24) |
根据滑模面的定义(16)和单位四元数的性质,得
(25) |
所以
(26) |
式中:W=[||Ω2||??||Ω||??1]T;?的形式为
(27) |
通过以上分析,基于滑模控制与自适应控制理论,设计如下控制器:
(28) |
(29) |
式中:
定理1??针对充液航天器姿态控制系统(13)和(15),考虑由液体晃动导致的转动惯量不确定性和干扰力矩,以及有限的通信资源,在假设1、假设2的条件下,基于事件触发机制(18),设计式(28)所示的控制律和式(29)所示的更新律,则滑模面(16)可以实现全局一致最终有界稳定,从而实现各状态量的追踪误差最终收敛在一定的界内,并且避免Zeno现象的发生。
证明??选取如下Lyapunov函数:
(30) |
式中:
对式(30)进行求导,可以得到
(31) |
将式(19)代入式(31),可以得到
(32) |
将控制律(28)代入到式(32),可以得到
(33) |
根据式(26)中的||D||≤WT?,代入到式(33),可得
(34) |
将更新律(29)代入到式(34),可以得到
(35) |
将触发机制(18)代入到式(35),可以得到
(36) |
定义η,0 < η < k1(1-α),则
(37) |
式中:
(38) |
所以,
(39) |
取
(40) |
式中:
根据式(40),事件触发下的自适应滑模控制器能够使得整个系统的状态量最终一致收敛到边界内,其界为
(41) |
基于边界(41),定义新的Lyapunov函数:
(42) |
对Lyapunov函数求导,得
(43) |
由此,
由式(43)可知,当
为证明避免Zeno现象,此处还需证明?k∈Z+,存在T>0,使得tk+1-tk>T。当t∈[tk, tk+1)时,
(44) |
定义
(45) |
式中:
对控制输入v进行求导,得
(46) |
所以
(47) |
由式(40)可知,
故式(47)可以表示为
(48) |
将
(49) |
又因为
(50) |
故ξT>k1χ, T>k1χ/ξ,即事件触发间隔严格恒大于0,所以能够排除Zeno现象的出现,不会在有限时间内触发无限次事件。????证毕
3 仿真校验 本文以Sloshsat卫星为仿真对象,在初始时刻绕其最大惯性主轴旋转。在0~33 s内施加力矩,使得其绕中间惯性主轴旋转[20]。这种平旋机动下,卫星旋转角速度较高且姿态变化较快,很容易激起液体的大幅晃动。在33 s后开始施加控制力矩,分别对自适应滑模控制策略和本文提出的事件触发与自适应滑模的复合控制策略展开仿真对比。
1) 航天器的参数参考Sloshsat卫星,取值如下:M=95.6 kg,μ=10-6 m2/s,σ=0.075 N/m,rT=[0.020 8??-0.001 6??-0.220 1]T m,I=
2) 脉动球的参数取值如下:m=33.5 kg,VS=[0??0??0]T m/s,ωS=[0??0??0]T rad/s,RS=[0.1??0??0]T m,R=0.351 m,Lmin=0.22 m。
3) 控制器参数取值如下:K=diag(0.5, 0.3, 0.5),k1=0.1,b=0.001,c=0.000 1,
2种控制方法下的充液航天器角速度、姿态四元数、控制力矩及事件触发间隔的变化曲线分别如图 3~图 6所示。
图 3 航天器的角速度变化曲线 Fig. 3 Curves of spacecraft angular velocities |
图选项 |
图 4 航天器的姿态四元数变化曲线 Fig. 4 Curves of spacecraft attitude quaternions |
图选项 |
图 5 航天器的控制力矩变化曲线 Fig. 5 Curves of spacecraft control torques |
图选项 |
图 6 事件触发的时间间隔 Fig. 6 Event-triggering interval |
图选项 |
从图 3的角速度变化曲线可以发现,2种控制策略下的角速度变化趋势一致,收敛相同、精度相似,约2×10-4 rad/s。由于事件触发机制的存在,角速度变化的平滑性降低。
从图 4中的姿态四元数变化曲线可以发现,2种控制策略下,姿态四元数均在100 s左右收敛,精度约为5×10-4。
从图 5和图 6中可以看出,事件触发与自适应滑模的复合控制策略,只在满足事件触发条件的时刻更新控制信号,其他时刻控制量保持不变。在时长300 s、步长0.01 s的仿真中,控制输入从第33 s开始更新,共计触发事件878次,平均每0.32 s触发一次事件,所需通信资源只有自适应滑模控制策略的4%不到,就可实现对航天器姿态系统的有效控制。
4 结论 1) 充液航天器系统具有强耦合、非线性的特点,在液体大幅晃动时更为显著。滑模变结构控制与自适应更新律相结合的策略,在液体大幅晃动时,依然能实现充液航天器姿态控制系统的各状态量的一致有界性。
2) 在控制器与执行器之间引入事件触发机制,控制信号的更新阈值与滑模面有关,兼顾对控制精度和通信资源利用率的考量。可有效减少控制输入的更新次数,释放更多的通信资源。
3) 基于Lyapunov函数的理论分析与平旋机动下的仿真,表明本文提出的控制器既能实现系统各状态量收敛至较小的界内,也能有效地减小通信频率,避免对通信资源的浪费。
参考文献
[1] | 朱宁昌. 中国液体火箭发动机发展之我见[J]. 宇航学报, 1990(3): 5-9. ZHU N C. Viewpoint on the development of China's liquid propellant rocket engines[J]. Journal of Astronautics, 1990(3): 5-9. (in Chinese) |
[2] | VREEBURG J P B. Spacecraft maneuvers and slosh control[J]. IEEE Control Systems, 2005, 25(3): 12-16. DOI:10.1109/MCS.2005.1432593 |
[3] | VREEBURG J P B. Dynamics and control of a spacecraft with a moving, pulsating ball in a spherical cavity[J]. Acta Astronautics, 1997, 40(2-8): 257-274. DOI:10.1016/S0094-5765(97)00095-7 |
[4] | BERRY R L, TEGART J R.Experimental study of transient liquid motion in orbiting spacecraft: NASA-CR-144003[R].Wshington, D.C.: NASA, 1975. |
[5] | 董瑞琦, 吴爱国, 张颖, 等. 转动惯量存在不确定性的挠性航天器动态自适应滑模姿态控制[J]. 飞控与探测, 2019, 2(5): 1-8. DONG R Q, WU A G, ZHANG Y, et al. Dynamic adpative sliding attitude control for flexibel spacecraft with inertia uncertainty[J]. Flight Control & Detection, 2019, 2(5): 1-8. (in Chinese) |
[6] | 杜辉, 张洪华. 一类带液体晃动航天器的姿态控制[J]. 空间控制技术与应用, 2010, 36(2): 25-30. DU H, ZHANG H H. Attitude control of a spacecraft with liquid sloshing[J]. Aerospace Control and Application, 2010, 36(2): 25-30. (in Chinese) |
[7] | DENG M L, YUE B Z. Attitude tracking control of flexible spacecraft with large amplitude slosh[J]. Chinese Journal of Theoretical and Applied Mechanics, 2017, 33(6): 1095-1102. DOI:10.1007/s10409-017-0700-9 |
[8] | ZHU Z, XIA Y Q, FU M Y. Attitude stabilization of rigid spacecraft with finite-time convergence[J]. International Journal of Robust and Nonlinear Control, 2011, 21(6): 686-702. DOI:10.1002/rnc.1624 |
[9] | SONG X J, LU S F. Attitude maneuver control of liquid-filled spacecraft with unknown inertia and disturbances[J]. Journal of Vibration and Control, 2019, 25(8): 1460-1469. DOI:10.1177/1077546318820414 |
[10] | MAZMANYAN L, AYOUBI M A. Fuzzy attitude control of spacecraft with fuel sloshing via linear matrix inequalities[J]. IEEE Transactions on Aerospace and Electronic Systems, 2018, 54(5): 2526-2536. DOI:10.1109/TAES.2018.2820419 |
[11] | REYHANOGLU M.Modeling and control of space vehicles with fuel slosh dynamics[M]//HALL D J.Advances in spacecraft technologies.[S.l.]: InTech, 2011: 549-562. |
[12] | DENG M L, YUE B Z. Attitude dynamics and control of liquid filled spacecraft with large amplitude fuel slosh[J]. Journal of Mechanics, 2017, 33(1): 125-136. DOI:10.1017/jmech.2016.60 |
[13] | 顾黄兴, 齐瑞云. 带液体晃动航天器的非线性自适应反馈控制[J]. 航天控制, 2013, 31(4): 72-77. GU H X, QI R Y. Nonlinear adaptive feedback controller for spacecraft with fuel slosh[J]. Aerospace Control, 2013, 31(4): 72-77. (in Chinese) |
[14] | 王婕, 马晓, 宗群. 四旋翼无人飞行器的轨迹跟踪与滑模事件驱动控制[J]. 控制理论与应用, 2019, 36(7): 1083-1089. WANG J, MA X, ZONG Q. Trajectory tracking and sliding mode event-triggered control for a quadrotor unmanned aerial vehicle[J]. Control Theory & Applications, 2019, 36(7): 1083-1089. (in Chinese) |
[15] | 于灏, 欧阳利, 郝飞. 事件触发控制在倒立摆系统中的仿真与实验[J]. 北京航空航天大学学报, 2016, 42(10): 2107-2117. YU H, OUYANG L, HAO F. Simulation and experiment of event -triggered control for inverted pendulum system[J]. Journal of Beijing University of Aeronautics and Astronautics, 2016, 42(10): 2107-2117. (in Chinese) |
[16] | SUN S, YANG M, WANG L.Event-triggered nonlinear attitude control for a rigid spacecraft[C]//The 36th Chinese Control Conference, 2017: 7582-7586. |
[17] | WANG F, HOU M Z, CAO X B. Event-triggered backstepping control for attitude stabilization of spacecraft[J]. Journal of the Franklin Institute, 2019, 356(16): 9474-9501. DOI:10.1016/j.jfranklin.2019.09.010 |
[18] | YI H, LIU M, LI M. Event-triggered fault tolerant control for spacecraft formation attitude synchronization with limited data communication[J]. European Journal of Control, 2018, 48: 97-103. DOI:10.1016/j.ejcon.2018.11.003 |
[19] | 杨飞生, 汪璟, 潘泉. 基于事件触发机制的网络控制研究综述[J]. 控制与决策, 2018, 33(6): 969-977. YANG F S, WANG J, PAN Q. A survey of network control based on event triggering mechanism[J]. Control and Decision, 2018, 33(6): 969-977. (in Chinese) |
[20] | 邓明乐, 岳宝增, 黄华. 液体大幅晃动等效力学模型研究[J]. 宇航学报, 2016, 37(6): 631-638. DENG M L, YUE B Z, HUANG H. Study on the equivalent mechanical model for large amplitude slosh[J]. Journal of Astronautics, 2016, 37(6): 631-638. (in Chinese) |
[21] | WU B, QIANG S, CAO X. Event-triggered attitude control of spacecraft[J]. Advances in Space Research, 2018, 61(3): 927-934. DOI:10.1016/j.asr.2017.11.013 |
[22] | ZHANG J, FENG G. Event-driven observer-based output feedback control for linear systems[J]. Automatica, 2014, 50(7): 1852-1859. DOI:10.1016/j.automatica.2014.04.026 |
[23] | 张嘉芮, 陈弈澄, 董新蕾, 等. 基于事件触发的航天器姿态自适应容错控制[J]. 飞控与探测, 2020, 3(2): 17-25. ZHANG J R, CHEN Y C, DONG X L, et al. Event-triggered adaptive fault-tolerant control of spacecraft attitude[J]. Flight Control & Detection, 2020, 3(2): 17-25. (in Chinese) |