CN105700536B - 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 - Google Patents
基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 Download PDFInfo
- Publication number
- CN105700536B CN105700536B CN201610041733.9A CN201610041733A CN105700536B CN 105700536 B CN105700536 B CN 105700536B CN 201610041733 A CN201610041733 A CN 201610041733A CN 105700536 B CN105700536 B CN 105700536B
- Authority
- CN
- China
- Prior art keywords
- tether
- formula
- control
- rope
- active star
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 52
- 230000003044 adaptive effect Effects 0.000 claims abstract description 77
- 238000013461 design Methods 0.000 claims abstract description 37
- 230000033001 locomotion Effects 0.000 claims abstract description 33
- 238000004458 analytical method Methods 0.000 claims abstract description 11
- 238000004088 simulation Methods 0.000 claims abstract description 10
- 230000006870 function Effects 0.000 claims description 72
- 230000008859 change Effects 0.000 claims description 26
- 238000006116 polymerization reaction Methods 0.000 claims description 24
- 238000005096 rolling process Methods 0.000 claims description 21
- 239000013598 vector Substances 0.000 claims description 16
- 238000006467 substitution reaction Methods 0.000 claims description 15
- 230000000694 effects Effects 0.000 claims description 13
- 238000006073 displacement reaction Methods 0.000 claims description 12
- 238000004364 calculation method Methods 0.000 claims description 10
- 230000005484 gravity Effects 0.000 claims description 9
- 238000005516 engineering process Methods 0.000 claims description 8
- 230000008569 process Effects 0.000 claims description 8
- 238000012545 processing Methods 0.000 claims description 7
- 230000001133 acceleration Effects 0.000 claims description 6
- 238000004422 calculation algorithm Methods 0.000 claims description 6
- 230000008878 coupling Effects 0.000 claims description 6
- 238000010168 coupling process Methods 0.000 claims description 6
- 238000005859 coupling reaction Methods 0.000 claims description 6
- 230000035945 sensitivity Effects 0.000 claims description 6
- 238000006243 chemical reaction Methods 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 5
- 239000002245 particle Substances 0.000 claims description 4
- 230000000295 complement effect Effects 0.000 claims description 3
- 238000010219 correlation analysis Methods 0.000 claims description 3
- 238000009795 derivation Methods 0.000 claims description 3
- 238000009434 installation Methods 0.000 claims description 3
- 238000012887 quadratic function Methods 0.000 claims description 3
- 230000009897 systematic effect Effects 0.000 claims description 3
- 230000006872 improvement Effects 0.000 claims description 2
- 210000001258 synovial membrane Anatomy 0.000 claims 2
- 230000010354 integration Effects 0.000 claims 1
- 238000010586 diagram Methods 0.000 description 9
- 238000011160 research Methods 0.000 description 4
- 230000006641 stabilisation Effects 0.000 description 3
- 238000011105 stabilization Methods 0.000 description 3
- 230000009471 action Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000033228 biological regulation Effects 0.000 description 2
- 238000005094 computer simulation Methods 0.000 description 2
- 238000012938 design process Methods 0.000 description 2
- 230000002708 enhancing effect Effects 0.000 description 2
- 230000001629 suppression Effects 0.000 description 2
- 238000004804 winding Methods 0.000 description 2
- 235000008331 Pinus X rigitaeda Nutrition 0.000 description 1
- 235000011613 Pinus brutia Nutrition 0.000 description 1
- 241000018646 Pinus brutia Species 0.000 description 1
- 230000003139 buffering effect Effects 0.000 description 1
- 230000008030 elimination Effects 0.000 description 1
- 238000003379 elimination reaction Methods 0.000 description 1
- 230000008570 general process Effects 0.000 description 1
- 230000001788 irregular Effects 0.000 description 1
- 230000007246 mechanism Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 238000003032 molecular docking Methods 0.000 description 1
- 230000035772 mutation Effects 0.000 description 1
- 230000009466 transformation Effects 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
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)
- Feedback Control In General (AREA)
Abstract
一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,其具体步骤如下:一、建立***动力学模型;二、自适应滑模控制器设计;三、高阶滑模观测器设计;四、MATLAB数值仿真分析。通过仿真结果分析证明了本发明的控制方法有效的抑制了系绳的空间摆动,并消除了绳系点偏置带来的主动星姿态耦合运动,控制律具有较好的鲁棒性,在此类空间任务中具有广泛的应用前景。
Description
技术领域
本发明涉及一种空间目标绳系拖曳离轨过程中,主动星与目标星处于自由伴飞状态时的主动星姿态和系绳摆振联合控制方法,属于航天工程中绳系卫星技术领域。
背景技术
空间目标的绳系拖曳离轨技术是航天工程界提出的一种新型辅助离轨策略,面向的应用对象包括空间碎片、废弃卫星等空间垃圾处理以及非合作目标的轨道转移等。绳系拖曳离轨的一般过程是由携带飞网等捕获设备的主动星通过轨道机动靠近目标星,释放展开飞网进行捕获,随后通过卷扬机构控制收紧系绳形成拖曳***,进而依靠主动星的轨道机动实现目标的变轨操作。
主动星、绳系、拖曳目标形成的联合体是一类特殊的空间绳系***(TetheredSatellite System,TSS),TSS技术作为一项可能改变整个航天***面貌的关键技术,在各种航天任务中具有广泛的用途。相比传统的变轨方式,绳系拖曳变轨具有如下的优点:1)无需在目标上附加推进设备,避免对接等危险操作;2)利用绳系的长度,可以实现远距离捕获,避免碰撞危险;3)利用绳系的柔性及绳长可变性进行缓冲,可以容忍目标更大的速度和位置误差;4)绳系拖曳可以减小捕获后目标对主动星姿态的扰动。
目前对于空间目标绳系拖曳技术的研究多集中于目标捕获阶段,对于拖曳变轨阶段的动力学与控制相关研究还处于起步阶段。在空间目标绳系拖曳过程中,由于主动星的机动,可能引起***状态包括系绳张力,星间相对速度等参数的突变,从而造成系绳的松弛、缠绕及星体间碰撞等风险,这对系绳的摆振和绳端星姿态控制都提出了一定的要求。
本发明正是针对这一难点问题,提出一种应用于空间绳系***拖曳离轨过程的主动星姿态和系绳摆振联合控制方法,旨在为此类空间任务的设计和***仿真提供可靠方法和依据。
发明内容
本发明的目的是针对同步轨道目标航天器,提出一种利用绳系拖曳至坟墓轨道的离轨过程主动星姿态和系绳摆振联合控制方法,保证***在霍曼变轨第一次脉冲和第二次脉冲之间的自由飞行过程中,不会出现可能的两种失效或不安全状态,即系绳的缠绕和主动星与目标星的碰撞,同时保持主动星姿态稳定。
本发明的技术方案:
本发明设计了一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,具体步骤如下:
步骤一、建立***动力学模型
首先,建立轨道坐标系So:z轴沿地心连线方向由地球指向TSS质心,x轴位于TSS质心轨道平面内与z轴垂直并指向轨道运动方向,y轴遵循右手准则。为描述绳端卫星姿态运动,另外定义TSS本体坐标系Sb,z轴沿着系绳指向主星,x轴垂直系绳且在轨道平面内,三轴单位矢量依次为ebx,eby和ebz,两个坐标系的转换关系为
So系到Sb系的坐标转换矩阵为
为方便书写,将正弦函数sin和余弦函数cos分别简写为S和C。本发明中对三角函数关系较复杂的公式都做此处理。
定义主动星本体坐标系Sb1:记Sb1相对轨道坐标系So的滚动、俯仰和偏航角分别为θ1、ψ1(3-1-2旋转顺序),当姿态角为零时,主动星本体坐标系与轨道坐标系重合。
为进行控制律设计,必须先得到控制对象的动力学模型,本发明中飞网拖曳***的动力学建模参照了常用的TSS***建模方法。
为突出关键问题,得到便于控制分析的模型,对其进行如下假设:
a、忽略目标星的姿态运动,将其视为质点;
b、主要考虑系绳和主星的面内姿态运动,即主星的滚转角、偏航角,系绳的面外摆角为小角度;
c、不考虑系绳的弹性和质量;
d、主动星具有推力控制和力矩控制,推力过质心;
e、忽略除重力外的其余空间干扰力作用。
利用上述假设,整个飞网拖曳***可以由包含系绳长度l,系绳面内摆角系绳面外摆角θ和主动星姿态θ1和ψ1来描述,将动力学方程线性化,消去高阶项可以得到***的动力学方程。
①关于系绳的绳长l:
②关于系绳面内摆角
③关于系绳面外摆角θ:
④主动星的姿态动力学和运动学方程为:
其中Rc为TSS质心位矢;m1,m2分别为主星、子星的质量,m为***总质量;l为绳长矢量;d1为主星系绳安装点相对于质心的位置矢量,即文献中常见的绳系点偏置矢量,ωo为轨道角速度;ω1为主星的绝对角速度,μ为引力常数,l0为系绳原长;和θ是绳的面内和面外摆角;I1表示主星和子星在本体系中的惯性张量;Fte为系绳张力,方向沿系绳方向由主星指向子星,即与TSS本体系轴ebz方向相反;T1为主星上的控制力矩;下标x、y、z表示在Sb1坐标系相应轴的投影。
其中TG1是主动星的重力梯度力矩,可以写为如下形式:
Qθ为主动星推力对应于各变量的广义力,包括除球形地球引力外的其他广义摄动力的作用。根据广义力计算公式可以得到,对应于主动星推力F的广义力为
其中为虚位移。
引入主动星控制力Pm,在系绳本体坐标系中表示为[0 Fout Fin]T,(轨道坐标系到系绳本体坐标系的坐标转换矩阵见式(2)。即Fin沿着系绳方向,Fout垂直系绳方向,如此施加控制力可以使各通道解耦。
利用广义力计算公式(9)可得
Fd,l、和Fd,θ是绳系点偏置耦合力,形式比较复杂,此文中未详细给出,已有的偏置控制律正是通过这些耦合力对TSS状态进行控制。为简化偏置耦合力,假定绳系点在主动星的正下方,即仅偏置向量的分量d1z不等于0,此时TSS的平衡状态为主动星姿态角为0,且系绳沿当地铅垂方向。实际拖曳任务中,若绳系点有偏差,而张力可测,则可通过力矩补偿方式使TSS的平衡状态不变。另外,将任务目标限定于将同步轨道目标航天器拖曳至坟墓轨道,即将轨道高度提升300公里以上,则变轨过程中轨道偏心率很小,可以认为是圆轨道。在偏置耦合力当中引入上述假设,并忽略包括二阶导数在内的高阶小量,可得偏置耦合力的计算公式为:
将上述各量代入动力学方程式(3)至(6),并将其在平衡状态
附近展开线性化,最终得到:
其中Fin和Fout分别为主动星的面内和面外推力,为处理方便,采用如下的时间和长度无量纲单位:
其中lt为单位绳长,可取为变轨前的TSS绳长。
则***动力学方程进一步简化为:
其中为考虑主动星控制力后的等效张力。
动力学方程各通道之间仍存在耦合,例如主动星的姿态控制与传统卫星控制相比,其姿态运动受到系绳张力的影响,影响大小不仅和张力大小有关,也和系绳摆角及主动星姿态角相关。考虑到动力学建模过程中所做简化而带来的不确定性,所设计的控制器必须具备一定的鲁棒性。本发明采用自适应滑模控制器+滑模观测器的控制方法对各通道进行控制器设计,下文详细给出控制器设计过程。
步骤二、自适应滑模控制器设计
对于实际***而言,***的聚合扰动是和***的状态相关的,事先无法估计其上界。若采用保守的办法确定一个较大的上界,又容易造成控制器的颤振以及控制器能量的不必要增大。因此为解决聚合扰动上界难以准确估计的问题,在这里设计自适应滑模控制器。
对于标准***
Δu为聚合扰动项,包括内扰动,即***参数的不确定性和外扰动,即外输入的不确定性。***控制任务为,将广义位移和广义速度控制到零,即
显然***是可控的。采用以下方法设计滑模控制器。
首先设计线性滑模切换函数
其中λ>0。
考虑采用如下形式的自适应滑模控制器
式中为自适应切换增益,可以采用如下自适应估计律计算
其中κ>0为切换增益的自适应增益变化敏感系数,其值越小,自适应增益变化得越快。(32)式的原理可以简单叙述为:以状态偏离滑动面的大小作为自适应切换增益的变化速度依据,只要***状态不在滑动面上,切换增益便持续增加;***运动轨迹偏离滑动面越大,自适应切换增益增大越快,这样,***的干扰抑制能力得到增强,趋势***状态更快的运动到滑动面。
上述自适应滑模控制器虽然是稳定的,但仍然存在一些问题:1)由于控制律中存在符号函数sign(*),控制量在滑动面附近是不连续的,从而造成***的颤振;2)由于控制器的颤振及各种误差影响,***的运动无法完全的收敛到滑动面上,这样在自适应律(32)的作用下,增益会不断地增大;相应的,控制量也会随之增大,直到超出执行机构输出能力。若控制时间较长,还可能发生控制算法的发散;3)切换增益完全由自适应算法确定,若***的干扰变化较快,则可能造成切换增益不能及时抑制扰动,进而影响***动态性能。
为解决控制器的颤振及自适应增益持续增大的问题,将自适应滑模控制律(31)及自适应律(32)改进为以下形式
式中通常取为一较小的常数;ε0>0为切换增益中的常值部分,用以进一步增强***对干扰的鲁棒性。sat(*)为饱和函数,定义为
式中r为边界层厚度。其值越小,饱和函数的特性越接近符号函数,相应的控制误差也越小,但产生颤振的可能越大。其越大,颤振可能性越小,但控制误差会增大。也可采用反正切函数tanh(*)来代替符号函数,相较而言,反正切函数可以使得控制器在滑动面附近更加的平滑。反正切自适应滑模控制律为
其中η为反正切敏感系数,其值越大,反正切函数性能越接近符号函数,但是过大的η也会导致颤振。
该***是一致有界稳定的。***的误差界于控制参数和r的选取有关。和r的取值越小,***的控制误差越小;但过小的r会导致***颤振,过小的会导致自适应增益持续增大。在避免这两种情况的前提下,两参数的取值越小越好。
结合上述内容,各通道控制器设计如下:
a、绳长Λ
基于动力学方程式(22),绳长通道方程可写为:
(M0+ΔM)Λ″=fc+fd+fnon (37)
其中M0=1;fc为广义控制量:
fd为空间干扰力影响项;fnon为高阶非线性项。绳长通道为追踪控制,式(37)可进一步写为聚合扰动形式的追踪误差方程:
ΔΛ″=u+Δu-Λ″c (39)
其中ΔΛ=Λ-Λc,Λc为系绳面内摆角控制所期望的绳长变化律,将在系绳面内摆角通道设计,此外
首先设计线性滑模切换函数:
SΛ=ΔΛ′+λΛΔΛ (40)
其中SΛ和λΛ的下标表明此为绳长通道的参数值,简明起见,下文叙述中如无歧义将忽略表明通道的下标。
根据改进自适应滑模控制器式(36)和(34)可得绳长通道的控制律和自适应分别为:
将式(38)代入式(41)可得等效的张力控制律为:
若
若
即控制器在所需张力为负时放松系绳,转由主动星控制力实现系绳的绳长变化。
b、系绳面内摆角
基于动力学方程式(23),面内摆角通道方程可写为:
其中M0=1
整理为聚合扰动形式:
首先设计线性滑模切换函数:
然后得到系绳面内摆角通道的控制律和自适应律为:
将式(45)代入式(48)可得等效的绳长速率控制律为:
式(50)即绳长通道所需跟踪的绳长变化速率,期望的绳长可由式(50)积分得到,而期望的绳长加速率可由式(50)微分得到。
c、系绳面外摆角θ
基于动力学方程式(24),面内摆角通道方程可写为:
(M0+ΔM)θ″=fc+fd+fnon (51)
其中M0=1
整理为聚合扰动形式:
θ″=u+Δu (53)
首先设计线性滑模切换函数:
S=θ′+λθ (54)
然后得到系绳面外摆角通道的控制律和自适应律:
将式(52)代入式(55)可得等效的主动星面外控制律为:
d、主动星滚转角
基于动力学方程式(25),主动星滚转角方程可写为:
其中注意到,由于轨道角速度很小,姿态动力学中的轨道角速度相关项可全部并入高阶项fnon,而重力梯度项可并入外干扰项fd,因此有:
主星滚转角通道为跟踪控制,将式(58)整理为聚合扰动形式的跟踪误差方程:
其中 为系绳面外摆角控制所期望的主动星滚转角,即式(57)。期望的主动星滚转角速度和角加速度可由式(57)分别微分一次和两次得到。
首先设计线性滑模切换函数:
则主动星滚转角通道的控制律和自适应律为:
将式(59)代入式(62)可得等效的主动星滚转控制力矩为:
e、主动星俯仰角θ1
基于动力学方程式(26),主动星俯仰角通道方程可写为:
(M0+ΔM)θ″1=fc+fd+fnon (65)
其中方程右侧同滚转角通道处理得到:
整理为聚合扰动形式:
θ″1=u+Δu (67)
首先设计线性滑模切换函数:
S=θ′1+λθ1 (68)
然后得到面内摆角通道的控制律和自适应律:
将式(66)代入式(69)可得等效的主动星俯仰控制力矩为:
f、主动星偏航角ψ1
基于动力学方程式(27),主动星偏航角通道方程可写为:
(M0+ΔM)ψ″1=fc+fd+fnon (72)
其中方程右侧同滚转角通道处理得到:
整理为聚合扰动形式:
ψ″1=u+Δu (74)
首先设计线性滑模切换函数:
S=ψ′1+λψ1 (75)
然后得到面内摆角通道的控制律和自适应律:
将式(73)代入式(76)可得等效的主动星滚转角控制律为:
步骤三、高阶滑模观测器设计
尽管控制器精度可以通过调节控制器参数的方法实现,但是参数调节过度则容易引起控制器颤振问题。也就是说,控制精度与控制器的颤振之间存在矛盾。
为尽量避免颤振,并在此前提下提高控制器精度,则需要对***的扰动加以补偿,而这需要采用合理的技术对***扰动进行估计。为此,考虑设计高阶滑模观测器,用以估计***的不确定聚合扰动Δu,然后在控制器中加以补偿。通过这种方法,可以进一步提高控制***精度。
高阶滑模观测器在估计聚合扰动的同时,还可以估计***的速度,并用于反馈。这样,***的控制方案中仅需对位移进行测量即可,而无需速度测量,这可以大大简化***配置,或作为速度测量无法实现时的有效备份方案。
对于标准***
假定***位移x和控制量u可测,观测器的设计目的为:以x和u为输入,估计***的聚合扰动Δu及速度若记聚合扰动Δu及速度的观测量分别为和则观测器的设计目标是在有限的时间内使
观测器算法
首先将***(79),重新写为
其中
在此基础上,高阶滑模观测器可写为如下形式
其中γ1>0,γ2>0和γ3>0为观测器参数。对于式(82)给出的高阶滑模观测器,假设***位移x和控制量u有界并且lebesgue可测,则通过选择合适的观测器参数,可以使得状态观测值以及扰动估计值在有限的时间内收敛到其真实值。
如前文所述,观测器的作用在于通过***位置和控制信号的输入,为控制器提供***速度和未知扰动的估计值。同时,观测器可以证明是稳定的。
步骤四、MATLAB数值仿真分析
本发明数值仿真软件的编写平台为Matlab的Simulink平台,Matlab系列产品在航天工程领域已经得到了非常广泛的应用,被证明是在动力学和控制相关问题研制开发过程中十分可靠的数值仿真软件。
结合上述发明内容,研究实现数值仿真的算法,设计软件编写逻辑,编写计算软件。通过合理的算例设计,结合仿真结果对本发明所设计的主动星姿态系绳摆振联合控制律的控制效果进行分析。
其中,在步骤一中所述的“常用的TSS建模方法”,是指整个绳系卫星***可以由***变量包括主动星的姿态,系绳的绳长,面内摆角和面外摆角来描述。
关于系绳长度l:
关于系绳面内摆角
关于系绳面外摆角θ:
姿态动力学方程由动量矩定理得到:
上述的常用TSS建模方法是本技术领域常用的技术手段,过程这里就不在赘述了。
其中,在步骤一中所述的假设条件b“系绳的面外摆角为小角度”,是考虑到从系绳的动力学方程中可以看出系绳的摆动不仅和星体姿态运动耦合(Fd,l,和Fd,θ),也和联合体的轨道运动耦合(ωo),且是一组高度非线性的方程组,控制器设计非常困难,所以需要从动力学的角度进行简化。考虑到飞网拖拽过程中轨道要素慢变,将系绳摆动和轨道运动解耦是合理的。从控制器设计的角度,要尽量选择不依赖于模型的控制器,即控制器必须具有较强的自适应能力或鲁棒性。
其中,在步骤一中所述的假设条件c“不考虑系绳的弹性和质量”,是因为考虑两者建立动力学方程变得异常复杂,不利于控制律设计,同时绳系拖曳***中系绳较短,系绳刚度较大,系绳质量和弹性变形的影响很小。忽略系绳的弹性和质量是合理的。
其中,在步骤二中所述的“上述自适应滑模控制器虽然是稳定的”,控制律的稳定性可以用如下的方法证明:
构造一个正定无界的Lyapunov函数
式中
即为自适应增益误差。
对式(87)求时间导数可得
由此可见V随时间减小,最终趋向于0,而由式(87),S也将趋向于0,即滑动面的到达运动是稳定,由于滑动面本身定义无改变,如定常增益滑模控制器中证明所述,滑动面的运动也是稳定的,即控制器的稳定性得到证明。
需要注意的是,由于上述分析不能证明即自适应增益未必会收敛于干扰上界,但这并不影响***的稳定性。
其中,步骤二中所述的“该***是一致有界稳定的”,控制律的稳定性可以用如下的方法证明:
构造一个正定无界的Lyapunov函数
其时间导数为
当时控制律和(31)相同,其稳定性已经得到证明,当
考察其中的项,此项是有关的一个二次函数。记则者一项可以写为
由于此函数显然有最大值,对f(y)求导可得
其最大值在导数为0,即此时最大值可以计算得到
将式(95)代入式(92)可得
其中
可知***是一致有界稳定的。
反正切函数取代符号函数的控制律稳定性证明不再具体给出。
其中,步骤三中所述的“同时,观测器可以证明是稳定的”,其稳定性证明如下:
稳定性证明可以基于一般的n阶***,无需限于二阶***。对于如下动力学***:
其中x∈Rn为***状态变量,u∈R为控制输入,b1为控制输入参数,可任意调节,f(t,x)为***内有关时间t和状态x的函数,一般未知。***(97)可可以写为
其中b0为***的控制输入增益的标称值,Δu=b1-b0为输入的不确定值,f(t,x,Δu)为内扰动和外扰动之和,即聚合扰动项。A,B,C的表达式分别如下:
对***(97),使用如下的观测器形式对该***进行观测:
式中为状态变量xi的观测值,为对不确定函数变量f(t,x,Δu)的估计值,λi(i=1,2,...,n)为观测器参数,L为Lipshitz常数,且满足显然,当n=2时,式(99)给出的观测器即为本研究采用的观测器式(82)。
为证明在有限的时间内状态观测值与扰动估计收敛到真实值,首先定义:
根据上述定义,由式(98)和(99)可得
利用上式,可将观测器(99)改写为以下形式
对于上述结构,由相关分析可知,上式中的变量ζi具有扩张不变性,即:
由此可知,此***是均匀的,且均匀度为-1。因而在有限的时间内,有ζi→0,此时可得:
因此有限时间内,状态观测值会收敛到其真实值xi。而将代入观测器方程也可得到至此观测器的稳定性得到证明。
本发明的有益效果是在空间目标系绳拖曳离轨过程中,有效的抑制了系绳的空间摆动,并消除了绳系点偏置带来的主动星姿态耦合运动,控制律具有较好的鲁棒性。
附图说明
图1本发明所述方法流程框图。
图2带高阶滑模观测器的自适应滑模控制器框图。
图中u0代表初始控制量,u为***控制量,为聚合扰动Δu的观测量,为速度的观测量,F为控制力,x为***位移。
图3系绳长度变化示意图。
图4系绳张力变化示意图。
图5飞网联合体轨道高度改变量示意图。
图6系绳面内摆角变化示意图。
图7系绳面外摆角变化示意图。
具体实施方式
本发明是一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,下面将结合附图详细说明本发明的优选实施方式。
首先建立***动力学模型,采用自适应滑模控制器+滑模观测器的控制方法对各通道进行控制器设计,最后对所发明的控制方法进行仿真验证。本发明所述方法流程框图如图1所示。
步骤一、建立***动力学模型
首先,建立轨道坐标系So:z轴沿地心连线方向由地球指向TSS质心,x轴位于TSS质心轨道平面内与z轴垂直并指向轨道运动方向,y轴遵循右手准则。为描述绳端卫星姿态运动,另外定义TSS本体坐标系Sb,z轴沿着系绳指向主星,x轴垂直系绳且在轨道平面内,三轴单位矢量依次为ebx,eby和ebz,两个坐标系的转换关系为
So系到Sb系的坐标转换矩阵为
为方便书写,将正弦函数sin和余弦函数cos分别简写为S和C。本发明中对三角函数关系较复杂的公式都做此处理。
定义主动星本体坐标系Sb1:记Sb1相对轨道坐标系So的滚动、俯仰和偏航角分别为θ1、ψ1(3-1-2旋转顺序),当姿态角为零时,主动星本体坐标系与轨道坐标系重合。
为进行控制律设计,必须先得到控制对象的动力学模型,本发明中飞网拖曳***的动力学建模参照了常用的TSS***建模方法。
为突出关键问题,得到便于控制分析的模型,对其进行如下假设:
a、忽略目标星的姿态运动,将其视为质点;
b、主要考虑系绳和主星的面内姿态运动,即主星的滚转角、偏航角,系绳的面外摆角为小角度;
c、不考虑系绳的弹性和质量;
d、主动星具有推力控制和力矩控制,推力过质心;
e、忽略除重力外的其余空间干扰力作用。
利用上述假设,整个飞网拖曳***可以由包含系绳长度l,系绳面内摆角系绳面外摆角θ和主动星姿态θ1和ψ1来描述,将动力学方程线性化,消去高阶项可以得到***的动力学方程。
①关于系绳的绳长l:
②关于系绳面内摆角
③关于系绳面外摆角θ:
④主动星的姿态动力学和运动学方程为:
其中Rc为TSS质心位矢;m1,m2分别为主星、子星的质量,m为***总质量;l为绳长矢量;d1为主星系绳安装点相对于质心的位置矢量,即文献中常见的绳系点偏置矢量,ωo为轨道角速度;ω1为主星的绝对角速度,μ为引力常数,l0为系绳原长;和θ是绳的面内和面外摆角;I1表示主星和子星在本体系中的惯性张量;Fte为系绳张力,方向沿系绳方向由主星指向子星,即与TSS本体系轴ebz方向相反;T1为主星上的控制力矩;下标x、y、z表示在Sb1坐标系相应轴的投影。
其中TG1是主动星的重力梯度力矩,可以写为如下形式:
Qθ为主动星推力对应于各变量的广义力,包括除球形地球引力外的其他广义摄动力的作用。根据广义力计算公式可以得到,对应于主动星推力F的广义力为
其中为虚位移。
引入主动星控制力Pm,在系绳本体坐标系中表示为[0 Fout Fin]T,(轨道坐标系到系绳本体坐标系的坐标转换矩阵见式(2)。即Fin沿着系绳方向,Fout垂直系绳方向,如此施加控制力可以使各通道解耦。
利用广义力计算公式(9)可得
Fd,l、和Fd,θ是绳系点偏置耦合力,形式比较复杂,此文中未详细给出,已有的偏置控制律正是通过这些耦合力对TSS状态进行控制。为简化偏置耦合力,假定绳系点在主动星的正下方,即仅偏置向量的分量d1z不等于0,此时TSS的平衡状态为主动星姿态角为0,且系绳沿当地铅垂方向。实际拖曳任务中,若绳系点有偏差,而张力可测,则可通过力矩补偿方式使TSS的平衡状态不变。另外,将任务目标限定于将同步轨道目标航天器拖曳至坟墓轨道,即将轨道高度提升300公里以上,则变轨过程中轨道偏心率很小,可以认为是圆轨道。在偏置耦合力当中引入上述假设,并忽略包括二阶导数在内的高阶小量,可得偏置耦合力的计算公式为:
将上述各量代入动力学方程式(3)至(6),并将其在平衡状态
附近展开线性化,最终得到:
其中Fin和Fout分别为主动星的面内和面外推力,为处理方便,采用如下的时间和长度无量纲单位:
其中lt为单位绳长,可取为变轨前的TSS绳长。
则***动力学方程进一步简化为:
其中为考虑主动星控制力后的等效张力。
动力学方程各通道之间仍存在耦合,例如主动星的姿态控制与传统卫星控制相比,其姿态运动受到系绳张力的影响,影响大小不仅和张力大小有关,也和系绳摆角及主动星姿态角相关。考虑到动力学建模过程中所做简化而带来的不确定性,所设计的控制器必须具备一定的鲁棒性。本发明采用自适应滑模控制器+滑模观测器的控制方法对各通道进行控制器设计,下文详细给出控制器设计过程。
步骤二、控制器设计
对于实际***而言,***的聚合扰动是和***的状态相关的,事先无法估计其上界。若采用保守的办法确定一个较大的上界,又容易造成控制器的颤振以及控制器能量的不必要增大。因此为解决聚合扰动上界难以准确估计的问题,在这里设计自适应滑模控制器。
对于标准***
Δu为聚合扰动项,包括内扰动,即***参数的不确定性和外扰动,即外输入的不确定性。***控制任务为,将广义位移和广义速度控制到零,即
显然***是可控的。采用以下方法设计滑模控制器。
首先设计线性滑模切换函数
其中λ>0。
考虑采用如下形式的自适应滑模控制器
式中为自适应切换增益,可以采用如下自适应估计律计算
其中κ>0为切换增益的自适应增益变化敏感系数,其值越小,自适应增益变化得越快。(32)式的原理可以简单叙述为:以状态偏离滑动面的大小作为自适应切换增益的变化速度依据,只要***状态不在滑动面上,切换增益便持续增加;***运动轨迹偏离滑动面越大,自适应切换增益增大越快,这样,***的干扰抑制能力得到增强,趋势***状态更快的运动到滑动面。
上述自适应滑模控制器虽然是稳定的,但仍然存在一些问题:1)由于控制律中存在符号函数sign(*),控制量在滑动面附近是不连续的,从而造成***的颤振;2)由于控制器的颤振及各种误差影响,***的运动无法完全的收敛到滑动面上,这样在自适应律(32)的作用下,增益会不断地增大;相应的,控制量也会随之增大,直到超出执行机构输出能力。若控制时间较长,还可能发生控制算法的发散;3)切换增益完全由自适应算法确定,若***的干扰变化较快,则可能造成切换增益不能及时抑制扰动,进而影响***动态性能。
为解决控制器的颤振及自适应增益持续增大的问题,将自适应滑模控制律(31)及自适应律(32)改进为以下形式
式中通常取为一较小的常数;ε0>0为切换增益中的常值部分,用以进一步增强***对干扰的鲁棒性。sat(*)为饱和函数,定义为
式中r为边界层厚度。其值越小,饱和函数的特性越接近符号函数,相应的控制误差也越小,但产生颤振的可能越大。其越大,颤振可能性越小,但控制误差会增大。也可采用反正切函数tanh(*)来代替符号函数,相较而言,反正切函数可以使得控制器在滑动面附近更加的平滑。反正切自适应滑模控制律为
其中η为反正切敏感系数,其值越大,反正切函数性能越接近符号函数,但是过大的η也会导致颤振。
该***是一致有界稳定的。***的误差界于控制参数和r的选取有关。和r的取值越小,***的控制误差越小;但过小的r会导致***颤振,过小的会导致自适应增益持续增大。在避免这两种情况的前提下,两参数的取值越小越好。
结合上述内容,各通道控制器设计如下:
a、绳长Λ
基于动力学方程式(22),绳长通道方程可写为:
(M0+ΔM)Λ″=fc+fd+fnon
其中M0=1;fc为广义控制量:
fd为空间干扰力影响项;fnon为高阶非线性项。绳长通道为追踪控制,式(37)可进一步写为聚合扰动形式的追踪误差方程:
ΔΛ″=u+Δu-Λ″c
其中ΔΛ=Λ-Λc,Λc为系绳面内摆角控制所期望的绳长变化律,将在系绳面内摆角通道设计,此外
首先设计线性滑模切换函数:
SΛ=ΔΛ′+λΛΔΛ
其中SΛ和λΛ的下标表明此为绳长通道的参数值,简明起见,下文叙述中如无歧义将忽略表明通道的下标。
根据改进自适应滑模控制器式(36)和(34)可得绳长通道的控制律和自适应分别为:
将式(38)代入式(41)可得等效的张力控制律为:
若
若
即控制器在所需张力为负时放松系绳,转由主动星控制力实现系绳的绳长变化。
b、系绳面内摆角
基于动力学方程式(23),面内摆角通道方程可写为:
其中M0=1
整理为聚合扰动形式:
首先设计线性滑模切换函数:
然后得到系绳面内摆角通道的控制律和自适应律为:
将式(45)代入式(48)可得等效的绳长速率控制律为:
式(50)即绳长通道所需跟踪的绳长变化速率,期望的绳长可由式(50)积分得到,而期望的绳长加速率可由式(50)微分得到。
c、系绳面外摆角θ
基于动力学方程式(24),面内摆角通道方程可写为:
(M0+ΔM)θ″=fc+fd+fnon
其中M0=1
整理为聚合扰动形式:
θ″=u+Δu
首先设计线性滑模切换函数:
S=θ′+λθ
然后得到系绳面外摆角通道的控制律和自适应律:
将式(52)代入式(55)可得等效的主动星面外控制律为:
d、主动星滚转角
基于动力学方程式(25),主动星滚转角方程可写为:
其中注意到,由于轨道角速度很小,姿态动力学中的轨道角速度相关项可全部并入高阶项fnon,而重力梯度项可并入外干扰项fd,因此有:
主星滚转角通道为跟踪控制,将式(58)整理为聚合扰动形式的跟踪误差方程:
其中 为系绳面外摆角控制所期望的主动星滚转角,即式(57)。期望的主动星滚转角速度和角加速度可由式(57)分别微分一次和两次得到。
首先设计线性滑模切换函数:
则主动星滚转角通道的控制律和自适应律为:
将式(59)代入式(62)可得等效的主动星滚转控制力矩为:
e、主动星俯仰角θ1
基于动力学方程式(26),主动星俯仰角通道方程可写为:
(M0+ΔM)θ″1=fc+fd+fnon
其中方程右侧同滚转角通道处理得到:
整理为聚合扰动形式:
θ″1=u+Δu
首先设计线性滑模切换函数:
S=θ′1+λθ1
然后得到面内摆角通道的控制律和自适应律:
将式(66)代入式(69)可得等效的主动星俯仰控制力矩为:
f、主动星偏航角ψ1
基于动力学方程式(27),主动星偏航角通道方程可写为:
(M0+ΔM)ψ″1=fc+fd+fnon
其中方程右侧同滚转角通道处理得到:
整理为聚合扰动形式:
ψ″1=u+Δu
首先设计线性滑模切换函数:
S=ψ′1+λψ1
然后得到面内摆角通道的控制律和自适应律:
将式(73)代入式(76)可得等效的主动星滚转角控制律为:
步骤三、高阶滑模观测器设计
尽管控制器精度可以通过调节控制器参数的方法实现,但是参数调节过度则容易引起控制器颤振问题。也就是说,控制精度与控制器的颤振之间存在矛盾。
为尽量避免颤振,并在此前提下提高控制器精度,则需要对***的扰动加以补偿,而这需要采用合理的技术对***扰动进行估计。为此,考虑设计高阶滑模观测器,用以估计***的不确定聚合扰动Δu,然后在控制器中加以补偿。通过这种方法,可以进一步提高控制***精度。
高阶滑模观测器在估计聚合扰动的同时,还可以估计***的速度,并用于反馈。这样,***的控制方案中仅需对位移进行测量即可,而无需速度测量,这可以大大简化***配置,或作为速度测量无法实现时的有效备份方案。
问题陈述
对于标准***
假定***位移x和控制量u可测,观测器的设计目的为:以x和u为输入,估计***的聚合扰动Δu及速度若记聚合扰动Δu及速度的观测量分别为和则观测器的设计目标是在有限的时间内使
观测器算法
首先将***(79),重新写为
其中
在此基础上,高阶滑模观测器可写为如下形式
其中γ1>0,γ2>0和γ3>0为观测器参数。对于式(82)给出的高阶滑模观测器,假设***位移x和控制量u有界并且lebesgue可测,则通过选择合适的观测器参数,可以使得状态观测值以及扰动估计值在有限的时间内收敛到其真实值。
同时,观测器可以证明是稳定的。
如前文所述,观测器的作用在于通过***位置和控制信号的输入,为控制器提供***速度和未知扰动的估计值,加入观测器后控制***的原理图请参见图2。
步骤四、MATLAB数值仿真分析
本发明数值仿真软件的编写平台为Matlab的Simulink平台,Matlab系列产品在航天工程领域已经得到了非常广泛的应用,被证明是在动力学和控制相关问题研制开发过程中十分可靠的数值仿真软件。
假定飞网联合体处于霍曼变轨第一次脉冲和第二次脉冲之间的自由飞行段,即处于椭圆轨道,其轨道半径、轨道半径提升高度、飞网联合体的质量、惯量和绳长等参数如表1所示,空间干扰力考虑地球不规则引力,太阳光压,以及日月三体引力,考虑轨道摄动力。仿真采用常用的TSS动力学模型,仅忽略系绳的弹性变形(系绳长度短,纵向变形也非常小)。
表1飞网抓捕联合体参数
考虑理想的单摆模型,及主动星和目标星视为质点,忽略系绳弹性和质量,忽略空间干扰力,则系绳小角度理想摆动方程可以写为
若飞网联合体变轨过程中,系绳的摆角较小,则可以以式(105)和(106)作为参考运动进行系绳空间摆动的控制,如此做的优势在于可以减小控制消耗,并减少由于星本体控制力造成的变轨误差。
表2飞网抓捕联合体仿真初值
以表2所列为仿真初值,绳长通道各控制参数取值为:
其中为椭圆轨道的平均轨道角速度,即在本问题中,飞网联合体的运动近乎在圆轨道上,可以由同步轨道角速度取代。
系绳面内、外摆角通道控制参数取为:
姿态角通道控制参数与绳长通道相同,相应的观测器参数为:
γ1,Λ=2.1,γ2,Λ=4.2,γ3,Λ=8.4 (109)
观测器初值中,由于广义位移假定可测,则观测器位移初值取为***初值,而速度初值设为0。仿真步长0.5s,总时长半个轨道周期,仿真结果如图3至图7所示。
如图3所示,跟踪控制的绳长变化范围约为97.5~100m;如图4所示,张力峰值为10的负3次方数量级,可见跟踪控制的控制消耗非常小。结果充分证明,采用跟踪控制时,由于所需主动星控制力较小,变轨精度也较高,如图5所示。此外,图6与图7代表了跟踪控制的系绳摆角运动情况,可以发现,跟踪控制可以消除动力学非线性和轨道干扰力带来的系绳摆动发散趋势,在无需摆角镇定为零的任务要求下,具有广泛的应用前景。
其中,在步骤一中所述的“常用的TSS建模方法”,是指整个绳系卫星***可以由***变量包括主动星的姿态,系绳的绳长,面内摆角和面外摆角来描述。
关于系绳长度l:
关于系绳面内摆角
关于系绳面外摆角θ:
姿态动力学方程由动量矩定理得到:
上述的常用TSS建模方法是本技术领域常用的技术手段,这里就不在赘述了。
其中,在步骤一中所述的假设条件b“系绳的面外摆角为小角度”,是考虑到从系绳的动力学方程中可以看出系绳的摆动不仅和星体姿态运动耦合(Fd,l,和Fd,θ),也和联合体的轨道运动耦合(ωo),且是一组高度非线性的方程组,控制器设计非常困难,所以需要从动力学的角度进行简化。考虑到飞网拖拽过程中轨道要素慢变,将系绳摆动和轨道运动解耦是合理的。从控制器设计的角度,要尽量选择不依赖于模型的控制器,即控制器必须具有较强的自适应能力或鲁棒性。
其中,在步骤一中所述的假设条件c“不考虑系绳的弹性和质量”,是因为考虑两者建立动力学方程变得异常复杂,不利于控制律设计,同时绳系拖曳***中系绳较短,系绳刚度较大,系绳质量和弹性变形的影响很小。忽略系绳的弹性和质量是合理的。
其中,在步骤二中所述的“上述自适应滑模控制器虽然是稳定的”,控制律的稳定性可以用如下的方法证明:
构造一个正定无界的Lyapunov函数
式中
即为自适应增益误差。
对式(87)求时间导数可得
由此可见V随时间减小,最终趋向于0,而由式(87),S也将趋向于0,即滑动面的到达运动是稳定,由于滑动面本身定义无改变,如定常增益滑模控制器中证明所述,滑动面的运动也是稳定的,即控制器的稳定性得到证明。
需要注意的是,由于上述分析不能证明即自适应增益未必会收敛于干扰上界,但这并不影响***的稳定性。
其中,步骤二中所述的“该***是一致有界稳定的”,控制律的稳定性可以用如下的方法证明:
构造一个正定无界的Lyapunov函数
其时间导数为
当时控制律和(31)相同,其稳定性已经得到证明,当
考察其中的项,此项是有关的一个二次函数。记则者一项可以写为
由于此函数显然有最大值,对f(y)求导可得
其最大值在导数为0,即此时最大值可以计算得到
将式(95)代入式(92)可得
其中
可知***是一致有界稳定的。
反正切函数取代符号函数的控制律稳定性证明不再具体给出。
其中,步骤三中所述的“同时,观测器可以证明是稳定的”,其稳定性证明如下:
稳定性证明可以基于一般的n阶***,无需限于二阶***。对于如下动力学***:
其中x∈Rn为***状态变量,u∈R为控制输入,b1为控制输入参数,可任意调节,f(t,x)为***内有关时间t和状态x的函数,一般未知。***(97)可可以写为
其中b0为***的控制输入增益的标称值,Δu=b1-b0为输入的不确定值,f(t,x,Δu)为内扰动和外扰动之和,即聚合扰动项。A,B,C的表达式分别如下:
对***(97),使用如下的观测器形式对该***进行观测:
式中为状态变量xi的观测值,为对不确定函数变量f(t,x,Δu)的估计值,λi(i=1,2,...,n)为观测器参数,L为Lipshitz常数,且满足显然,当n=2时,式(99)给出的观测器即为本研究采用的观测器式(82)。
为证明在有限的时间内状态观测值与扰动估计收敛到真实值,首先定义:
根据上述定义,由式(98)和(99)可得
利用上式,可将观测器(99)改写为以下形式
对于上述结构,由相关分析可知,上式中的变量ζi具有扩张不变性,即:
由此可知,此***是均匀的,且均匀度为-1。因而在有限的时间内,有ζi→0,此时可得:
因此有限时间内,状态观测值会收敛到其真实值xi。而将代入观测器方程也可得到至此观测器的稳定性得到证明。
综上所述,本发明设计并得到了主动星姿态和系绳摆振的联合控制律,该控制律有效的抑制了空间目标拖曳过程中系绳的空间摆动,并消除了绳系点偏置带来的主动星姿态耦合运动,控制律具有较好的鲁棒性。
以上所述仅是本发明的具体实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明方法的前提下,还可以做出若干改进,或者对其中部分技术特征进行等同替换,这些改进和替换也应视为本发明的保护范围。
Claims (6)
1.一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,其特征在于:其具体步骤如下:
步骤一、建立***动力学模型
首先,建立轨道坐标系So:z轴沿地心连线方向由地球指向TSS质心,x轴位于TSS质心轨道平面内与z轴垂直并指向轨道运动方向,y轴遵循右手准则;为描述绳端卫星姿态运动,另外定义TSS本体坐标系Sb,z轴沿着系绳指向主星,x轴垂直系绳且在轨道平面内,三轴单位矢量依次为ebx,eby和ebz,两个坐标系的转换关系为
So系到Sb系的坐标转换矩阵为
为方便书写,将正弦函数sin和余弦函数cos分别简写为S和C,对三角函数关系较复杂的公式都做此处理;
定义主动星本体坐标系Sb1:记Sb1相对轨道坐标系So的滚动、俯仰和偏航角分别为θ1、ψ1,即3-1-2旋转顺序,当姿态角为零时,主动星本体坐标系与轨道坐标系重合;
为便于控制分析的模型,现进行如下假设:
a、忽略目标星的姿态运动,将其视为质点;
b、考虑系绳和主星的面内姿态运动,即主星的滚转角、偏航角,系绳的面外摆角为小角度;
c、不考虑系绳的弹性和质量;
d、主动星具有推力控制和力矩控制,推力过质心;
e、忽略除重力外的其余空间干扰力作用;
利用上述假设,整个飞网拖曳***由包含系绳长度l,系绳面内摆角系绳面外摆角θ和主动星姿态θ1和ψ1来描述,将动力学方程线性化,消去高阶项得到***的动力学方程;
①关于系绳的绳长l:
②关于系绳面内摆角
③关于系绳面外摆角θ:
④主动星的姿态动力学和运动学方程为:
其中,Rc为TSS质心位矢;m1,m2分别为主星、子星的质量,m为***总质量;l为绳长矢量;d1为主星系绳安装点相对于质心的位置矢量,即文献中常见的绳系点偏置矢量,ωo为轨道角速度;ω1为主星的绝对角速度,μ为引力常数,l0为系绳原长;和θ是绳的面内和面外摆角;I1表示主星和子星在本体系中的惯性张量;Fte为系绳张力,方向沿系绳方向由主星指向子星,即与TSS本体系轴ebz方向相反;T1为主星上的控制力矩;下标x、y、z表示在Sb1坐标系相应轴的投影;
其中TG1是主动星的重力梯度力矩,写为如下形式:
Qθ为主动星推力对应于各变量的广义力,包括除球形地球引力外的其他广义摄动力的作用;根据广义力计算公式得到,对应于主动星推力F的广义力为
其中为虚位移;
引入主动星控制力Pm,在系绳本体坐标系中表示为[0 Fout Fin]T;即Fin沿着系绳方向,Fout垂直系绳方向,如此施加控制力能使各通道解耦;
利用广义力计算公式(9)得
Fd,l、和Fd,θ是绳系点偏置耦合力,为简化偏置耦合力,假定绳系点在主动星的正下方,即仅偏置向量的分量d1z不等于0,此时TSS的平衡状态为主动星姿态角为0,且系绳沿当地铅垂方向;实际拖曳任务中,若绳系点有偏差,而张力可测,则通过力矩补偿方式使TSS的平衡状态不变;另外,将任务目标限定于将同步轨道目标航天器拖曳至坟墓轨道,即将轨道高度提升300公里以上,认为是圆轨道;在偏置耦合力当中引入上述假设,并忽略包括二阶导数在内的高阶小量,得偏置耦合力的计算公式为:
将上述各量代入动力学方程式(3)至(6),并将其在平衡状态
附近展开线性化,最终得到:
其中Fin和Fout分别为主动星的面内和面外推力,为处理方便,采用如下的时间和长度无量纲单位:
其中lt为单位绳长,取为变轨前的TSS绳长;
则***动力学方程进一步简化为:
其中为考虑主动星控制力后的等效张力;
动力学方程各通道之间仍存在耦合,考虑到动力学建模过程中所做简化而带来的不确定性,所设计的控制器必须具备一定的鲁棒性;
步骤二、自适应滑模控制器设计
对于标准***
Δu为聚合扰动项,包括内扰动,即***参数的不确定性和外扰动,即外输入的不确定性;***控制任务为,将广义位移和广义速度控制到零,即
显然***是可控的,采用以下方法设计滑膜控制器;
首先设计线性滑模切换函数
其中λ>0;
考虑采用如下形式的自适应滑模控制器
式中为自适应切换增益,采用如下自适应估计律计算
其中,κ>0为切换增益的自适应增益变化敏感系数,值越小,自适应增益变化得越快;(32)式简单叙述为:以状态偏离滑动面的大小作为自适应切换增益的变化速度依据,只要***状态不在滑动面上,切换增益便持续增加;***运动轨迹偏离滑动面越大,自适应切换增益增大越快,这样,***的干扰抑制能力得到增强,趋势***状态更快的运动到滑动面;
为解决控制器的颤振及自适应增益持续增大的问题,将自适应滑模控制律(31)及自适应律(32)改进为以下形式:
式中取一常数;ε0>0为切换增益中的常值部分,用以进一步增强***对干扰的鲁棒性;sat(*)为饱和函数,定义为
式中r为边界层厚度;其值越小,饱和函数的特性越接近符号函数,相应的控制误差也越小,但产生颤振的可能越大;其越大,颤振可能性越小,但控制误差会增大;也采用反正切函数tanh(*)来代替符号函数,相较而言,反正切函数使得控制器在滑动面附近更加的平滑,反正切自适应滑膜控制律为:
其中η为反正切敏感系数,其值越大,反正切函数性能越接近符号函数,但是过大的η也会导致颤振;
***的误差界于控制参数和r的选取有关;和r的取值越小,***的控制误差越小;但过小的r会导致***颤振,过小的会导致自适应增益持续增大;在避免这两种情况的前提下,两参数的取值越小越好;
结合上述内容,各通道控制器设计如下:
a、绳长Λ
基于动力学方程式(22),绳长通道方程写为:
(M0+ΔM)Λ″=fc+fd+fnon (37)
其中M0=1;fc为广义控制量:
fd为空间干扰力影响项,fnon为高阶非线性项;绳长通道为追踪控制,式(37)进一步写为聚合扰动形式的追踪误差方程:
ΔΛ″=u+Δu-Λ″c (39)
其中ΔΛ=Λ-Λc,Λc为系绳面内摆角控制所期望的绳长变化律,将在系绳面内摆角通道设计,此外
首先设计线性滑模切换函数:
SΛ=ΔΛ′+λΛΔΛ (40)
其中SΛ和λΛ的下标表明此为绳长通道的参数值,下文叙述中如无歧义将忽略表明通道的下标;
根据改进自适应滑模控制器式(36)和(34)得绳长通道的控制律和自适应分别为:
将式(38)代入式(41)得等效的张力控制律为:
即控制器在所需张力为负时放松系绳,转由主动星控制力实现系绳的绳长变化;
b、系绳面内摆角
基于动力学方程式(23),面内摆角通道方程写为:
其中M0=1
整理为聚合扰动形式:
首先设计线性滑模切换函数:
然后得到系绳面内摆角通道的控制律和自适应律为:
将式(45)代入式(48)得等效的绳长速率控制律为:
式(50)即绳长通道所需跟踪的绳长变化速率,期望的绳长由式(50)积分得到,而期望的绳长加速率由式(50)微分得到;
c、系绳面外摆角θ
基于动力学方程式(24),面内摆角通道方程写为:
(M0+ΔM)θ″=fc+fd+fnon (51)
其中M0=1
整理为聚合扰动形式:
θ″=u+Δu (53)
首先设计线性滑模切换函数:
S=θ′+λθ (54)
然后得到系绳面外摆角通道的控制律和自适应律:
将式(52)代入式(55)得等效的主动星面外控制律为:
d、主动星滚转角
基于动力学方程式(25),主动星滚转角方程写为:
其中由于轨道角速度很小,姿态动力学中的轨道角速度相关项全部并入高阶项fnon,而重力梯度项并入外干扰项fd,因此有:
主星滚转角通道为跟踪控制,将式(58)整理为聚合扰动形式的跟踪误差方程:
其中 为系绳面外摆角控制所期望的主动星滚转角,即式(57);期望的主动星滚转角速度和角加速度由式(57)分别微分一次和两次得到;
首先设计线性滑模切换函数:
则主动星滚转角通道的控制律和自适应律为:
将式(59)代入式(62)得等效的主动星滚转控制力矩为:
e、主动星俯仰角θ1
基于动力学方程式(26),主动星俯仰角通道方程写为:
(M0+ΔM)θ″1=fc+fd+fnon (65)
其中方程右侧同滚转角通道处理得到:
整理为聚合扰动形式:
θ″1=u+Δu (67)
首先设计线性滑模切换函数:
S=θ′1+λθ1 (68)
然后得到面内摆角通道的控制律和自适应律:
将式(66)代入式(69)得等效的主动星俯仰控制力矩为:
f、主动星偏航角ψ1
基于动力学方程式(27),主动星偏航角通道方程写为:
(M0+ΔM)ψ″1=fc+fd+fnon (72)
其中方程右侧同滚转角通道处理得到:
整理为聚合扰动形式:
ψ″1=u+Δu (74)
首先设计线性滑模切换函数:
S=ψ′1+λψ1 (75)
然后得到面内摆角通道的控制律和自适应律:
将式(73)代入式(76)得等效的主动星滚转角控制律为:
步骤三、高阶滑模观测器设计
为避免颤振,并在此前提下提高控制器精度,则需要对***的扰动加以补偿,而这需要采用合理的技术对***扰动进行估计,为此,考虑设计高阶滑模观测器,用以估计***的不确定聚合扰动Δu,然后在控制器中加以补偿;
高阶滑模观测器在估计聚合扰动的同时,还要估计***的速度,并用于反馈,这样***的控制方案中仅需对位移进行测量即可,而无需速度测量,简化***配置,或作为速度测量无法实现时的有效备份方案;对于标准***
假定***位移x和控制量u可测,观测器的设计目的为:以x和u为输入,估计***的聚合扰动Δu及速度若记聚合扰动Δu及速度的观测量分别为和则观测器的设计目标是在有限的时间内使观测器算法
首先将***(79),重新写为
其中
在此基础上,高阶滑模观测器写为如下形式
其中γ1>0,γ2>0和γ3>0为观测器参数;对于式(82)给出的高阶滑模观测器,假设***位移x和控制量u有界并且lebesgue可测,则通过选择合适的观测器参数,使得状态观测值以及扰动估计值在有限的时间内收敛到其真实值;
步骤四、MATLAB数值仿真分析
数值仿真软件的编写平台为Matlab的Simulink平台,结合仿真结果对所设计的主动星姿态系绳摆振联合控制律的控制效果进行分析。
2.根据权利要求1所述的一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,其特征在于:在步骤一中所述的假设条件b系绳的面外摆角为小角度,是考虑到从系绳的动力学方程中看出系绳的摆动不仅和星体姿态运动耦合(Fd,l,和Fd,θ),也和联合体的轨道运动耦合(ωo),且是一组高度非线性的方程组,控制器设计非常困难,所以需要从动力学的角度进行简化;考虑到飞网拖拽过程中轨道要素慢变,将系绳摆动和轨道运动解耦是合理的,从控制器设计的角度,要选择不依赖于模型的控制器,即控制器必须具有较强的自适应能力或鲁棒性。
3.根据权利要求1所述的一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,其特征在于:在步骤一中所述的假设条件c不考虑系绳的弹性和质量,是因为考虑两者建立动力学方程变得异常复杂,不利于控制律设计,同时绳系拖曳***中系绳较短,系绳刚度较大,系绳质量和弹性变形的影响小;忽略系绳的弹性和质量是合理的。
4.根据权利要求1所述的一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,其特征在于:在步骤二中所述的上述自适应滑模控制器虽然是稳定的,控制律的稳定性能用如下的方法证明:
构造一个正定无界的Lyapunov函数
式中
即为自适应增益误差;
对式(83)求时间导数得到
由此可见V随时间减小,最终趋向于0,而由式(83),S也将趋向于0,即滑动面的到达运动是稳定,由于滑动面本身定义无改变,滑动面的运动也是稳定的,即控制器的稳定性得到证明;
需要注意的是,由于上述分析不能证明即自适应增益未必会收敛于干扰上界,但这并不影响***的稳定性。
5.根据权利要求1所述的一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,其特征在于:步骤二中所述的该***是一致有界稳定的,控制律的稳定性用如下的方法证明:
构造一个正定无界的Lyapunov函数
其时间倒数为
当时控制律和(31)相同,其稳定性已经得到证明,当
考察其中的项,此项是有关的一个二次函数;记则这一项写为
由于此函数显然有最大值,对f(y)求导得到
其最大值在导数为0,即此时最大值计算得到
将式(91)代入式(88)得到
其中
***是一致有界稳定的;
反正切函数取代符号函数的控制律稳定性证明不再具体给出。
6.根据权利要求1所述的一种基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法,其特征在于:步骤三中所述的同时,观测器证明是稳定的,其稳定性证明如下:
稳定性证明基于的n阶***,无需限于二阶***;对于如下动力学***:
其中x∈Rn为***状态变量,u∈R为控制输入,b1为控制输入参数,可任意调节,f(t,x)为***内有关时间t和状态x的函数,式(93)写为
其中b0为***的控制输入增益的标称值,Δu=b1-b0为输入的不确定值,f(t,x,Δu)为内扰动和外扰动之和,即聚合扰动项,A,B,C的表达式分别如下:
对***(93),使用如下的观测器形式对该***进行观测:
式中为状态变量xi的观测值,为对不确定函数变量f(t,x,Δu)的估计值,λi为观测器参数,L为Lipshitz常数,且满足显然,当n=2时,式(95)给出的观测器采用的观测器式(82);i=1,2,...,n;
为证明在有限的时间内状态观测值与扰动估计收敛到真实值,首先定义:
根据上述定义,由式(94)和(95)得到
利用上式,将观测器式(95)改写为以下形式
对于上述结构,由相关分析得知,上式中的变量ζi具有扩张不变性,即:
由此可知,此***是均匀的,且均匀度为-1;因而在有限的时间内,有ζi→0,此时得到:
因此有限时间内,状态观测值会收敛到其真实值xi;而将代入观测器方程也能得到至此观测器的稳定性得到证明。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610041733.9A CN105700536B (zh) | 2016-01-21 | 2016-01-21 | 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610041733.9A CN105700536B (zh) | 2016-01-21 | 2016-01-21 | 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105700536A CN105700536A (zh) | 2016-06-22 |
CN105700536B true CN105700536B (zh) | 2018-06-29 |
Family
ID=56228396
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610041733.9A Active CN105700536B (zh) | 2016-01-21 | 2016-01-21 | 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105700536B (zh) |
Families Citing this family (28)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106020217B (zh) * | 2016-05-16 | 2018-10-19 | 西北工业大学 | 一种利用卷轴控制的拖曳变轨防缠绕防碰撞方法 |
CN107585331A (zh) * | 2016-07-07 | 2018-01-16 | 北京航空航天大学 | 空间绳系拖曳转移中的一种间歇式脉冲伪连续推力离轨方式 |
CN107589750A (zh) * | 2016-07-07 | 2018-01-16 | 北京航空航天大学 | 一种用于绳系拖曳离轨的***组合体姿态协同控制方法 |
CN106275509B (zh) * | 2016-08-19 | 2019-02-22 | 浙江大学 | 一种空间悬浮绳系组合体面内摆动控制方法 |
CN106774360B (zh) * | 2016-11-24 | 2019-06-04 | 西北工业大学 | 一种拖曳变轨中利用系绳与连杆的目标星姿态稳定方法 |
CN107065910B (zh) * | 2017-04-24 | 2020-01-14 | 西北工业大学 | 空间绳系抓捕***保持阶段系绳面内面外角稳定控制方法 |
CN106970635B (zh) * | 2017-05-17 | 2019-10-18 | 西北工业大学 | 一种拖曳变轨中利用拖曳飞行器机动的系绳摆动抑制方法 |
CN107132850B (zh) * | 2017-05-25 | 2019-08-02 | 上海航天控制技术研究所 | 基于角速度跟踪的变轨姿态保持控制方法 |
CN107085374B (zh) * | 2017-06-09 | 2019-11-29 | 北京航空航天大学 | 基于绳系空间拖船推力调节的拖拽目标姿态稳定控制方法 |
CN109426147B (zh) * | 2017-08-23 | 2022-02-08 | 中国空气动力研究与发展中心计算空气动力研究所 | 捕获卫星后组合航天器的自适应增益调整控制方法 |
CN107933966B (zh) * | 2017-11-21 | 2019-11-12 | 中国运载火箭技术研究院 | 一种升降轨双模式的电动力绳系轨道转移方法及*** |
CN108303874B (zh) * | 2017-12-28 | 2020-06-23 | 北京航空航天大学 | 一种针对绳系空间拖船***摆振的小推力切换控制方法 |
CN108319136B (zh) * | 2018-01-18 | 2019-12-27 | 西北工业大学 | 一种基于模型预测的系绳张力控制方法 |
CN109032156B (zh) * | 2018-07-03 | 2020-08-25 | 北京航空航天大学 | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 |
CN108919833B (zh) * | 2018-07-24 | 2021-02-02 | 西北工业大学 | 一种智能飞网网型保持控制方法 |
CN109063307B (zh) * | 2018-07-26 | 2019-10-18 | 西北工业大学 | 一种可机动飞网抓捕目标的碰撞位移和碰撞力计算方法 |
CN109460071B (zh) * | 2018-09-14 | 2021-10-29 | 中国人民解放军国防科技大学 | 航天器轨道动力异常补偿方法 |
CN109814585B (zh) * | 2019-02-01 | 2021-08-24 | 杭州电子科技大学 | 近似线性化控制的空间绳系组合体小角度摆动抑制方法 |
CN109850015B (zh) * | 2019-02-21 | 2021-08-03 | 江苏大学 | 一种控制参数可自动调节的电动车主动前轮转向控制方法 |
CN110347173B (zh) * | 2019-08-21 | 2021-07-13 | 哈尔滨工业大学 | 一种基于非连续自适应控制的航天器姿态跟踪控制方法 |
CN111216925B (zh) * | 2020-02-13 | 2022-11-11 | 西北工业大学 | 一种共面椭圆轨道间的绳系卫星转移轨道设计方法 |
CN111272178B (zh) * | 2020-03-13 | 2022-03-04 | 上海航天控制技术研究所 | 基于扩张观测器与辅助信息估计的机动目标相对导航方法 |
CN111413995B (zh) * | 2020-03-24 | 2021-03-05 | 北京科技大学 | 双刚体特征点间相对位置跟踪与姿态同步控制方法及*** |
CN113311863B (zh) * | 2021-05-25 | 2022-07-08 | 南京航空航天大学 | 空间直线型绳系观测***动力学行为稳定性的判别方法 |
CN113485404B (zh) * | 2021-08-01 | 2022-07-26 | 西北工业大学 | 一种空间绳系组合体***的自适应有限时间控制方法 |
CN113607378B (zh) * | 2021-08-02 | 2022-04-08 | 厦门大学 | 一种绳系支撑飞行器模型强迫自由角运动模拟与抑制方法 |
CN113734476B (zh) * | 2021-09-07 | 2023-03-14 | 北京控制工程研究所 | 一种边界触发常值推力下的摆角控制方法和*** |
CN114115315B (zh) * | 2021-11-29 | 2024-01-16 | 中国星网网络应用有限公司 | 绳系卫星释放回收控制方法及*** |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2007157106A (ja) * | 2005-12-01 | 2007-06-21 | Korea Electronics Telecommun | コンポーネント基盤の衛星モデリングによる衛星シミュレーションシステム |
CN101708780B (zh) * | 2009-11-26 | 2012-12-05 | 哈尔滨工业大学 | 用于目标姿态跟踪的刚性航天器的控制方法 |
CN104483973B (zh) * | 2014-11-20 | 2017-05-03 | 哈尔滨工业大学 | 基于滑模观测器的低轨挠性卫星姿态跟踪控制方法 |
-
2016
- 2016-01-21 CN CN201610041733.9A patent/CN105700536B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN105700536A (zh) | 2016-06-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105700536B (zh) | 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 | |
CN109189085B (zh) | 基于事件触发的航天器网络化***姿态控制方法 | |
Liang et al. | Observer-based H∞ fault-tolerant attitude control for satellite with actuator and sensor faults | |
CN106325291B (zh) | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** | |
CN105242676B (zh) | 一种有限时间收敛时变滑模姿态控制方法 | |
Zong et al. | Output feedback back-stepping control for a generic hypersonic vehicle via small-gain theorem | |
CN102163057B (zh) | 一种自治飞艇平面路径跟踪控制方法 | |
Cao et al. | Flexible satellite attitude maneuver via constrained torque distribution and active vibration suppression | |
CN106985139A (zh) | 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法 | |
CN109062043B (zh) | 考虑网络传输以及执行器饱和的航天器自抗扰控制方法 | |
CN104317300A (zh) | 一种基于模型预测控制的平流层飞艇平面路径跟踪控制方法 | |
CN105159305A (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN104656447A (zh) | 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法 | |
CN103092213A (zh) | 六旋翼飞行器的轨迹跟踪控制方法 | |
CN105182990B (zh) | 具有输出受限的三自由度模型直升机的鲁棒控制方法 | |
CN109597426A (zh) | 基于l1自适应控制的四旋翼直升机轨迹跟踪控制方法 | |
Zhu et al. | Tracking control for angular-rate-sensorless vertical take-off and landing aircraft in the presence of angular-position measurement delay | |
Lee et al. | Linear parameter-varying control of variable span-sweep morphing aircraft | |
Mystkowski | 721. An application of mu-synthesis for control of a small air vehicle and simulation results | |
Jia et al. | Decentralized adaptive sliding mode control of a space robot actuated by control moment gyroscopes | |
CN103863578B (zh) | 火星着陆器喷气推力器和控制力矩陀螺复合控制*** | |
Zhao et al. | Trajectory tracking control for parafoil systems based on the model-free adaptive control method | |
Bingbing et al. | A new modeling scheme for powered parafoil unmanned aerial vehicle platforms: Theory and experiments | |
CN103869823B (zh) | 火星着陆器喷气推力器和质量矩复合控制*** | |
Diao et al. | An output feedback attitude tracking controller design for quadrotor unmanned aerial vehicles using quaternion |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |