CN104252574B - 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 - Google Patents
一种基于空间系绳抓捕系统的非合作目标质量辨识方法 Download PDFInfo
- Publication number
- CN104252574B CN104252574B CN201410341359.5A CN201410341359A CN104252574B CN 104252574 B CN104252574 B CN 104252574B CN 201410341359 A CN201410341359 A CN 201410341359A CN 104252574 B CN104252574 B CN 104252574B
- Authority
- CN
- China
- Prior art keywords
- tether
- beta
- prime
- alpha
- centerdot
- 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
- 238000012850 discrimination method Methods 0.000 title abstract 2
- 238000000034 method Methods 0.000 claims abstract description 40
- 238000011084 recovery Methods 0.000 claims abstract description 33
- 230000003044 adaptive effect Effects 0.000 claims abstract description 8
- 238000004422 calculation algorithm Methods 0.000 claims description 23
- 239000013598 vector Substances 0.000 claims description 21
- 238000005381 potential energy Methods 0.000 claims description 9
- 230000009286 beneficial effect Effects 0.000 claims description 4
- 238000009795 derivation Methods 0.000 claims description 4
- 238000004088 simulation Methods 0.000 claims description 4
- 239000002131 composite material Substances 0.000 claims description 3
- 239000002245 particle Substances 0.000 claims description 3
- 230000006978 adaptation Effects 0.000 abstract 1
- 238000011160 research Methods 0.000 description 4
- 238000011217 control strategy Methods 0.000 description 3
- 238000004064 recycling Methods 0.000 description 3
- 230000010355 oscillation Effects 0.000 description 2
- 238000012546 transfer Methods 0.000 description 2
- 238000010835 comparative analysis Methods 0.000 description 1
- 150000001875 compounds Chemical class 0.000 description 1
- 238000013016 damping Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 239000012636 effector Substances 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 230000014759 maintenance of location Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种基于空间系绳抓捕系统的非合作目标质量辨识方法,该方法在空间绳系抓捕系统抓捕空间非合作目标后,在后抓捕阶段和回收阶段对目标动力学参数进行辨识并在此基础上完成自适应回收控制。首先,提出了一种参数辨识方法在后抓捕期对空间非合作目标的质量进行初步辨识。然后,根据不同的回收控制算法对参数辨识的影响,提出一种最适合的控制算法。最后,在基于后抓捕阶段的初步的参数辨识结果的基础上,完成空间非合作目标回收过程中的自适应控制。
Description
技术领域
本发明属于航天器控制技术领域,涉及带有空间系绳的各类空间抓捕系统捕获空间非合作目标后的动力学分析和目标参数辨识技术,特别涉及一种基于空间系绳抓捕系统的非合作目标质量辨识方法。
背景技术
空间绳系系统是一种可用于空间在轨服务的新型空间机器人系统,在空间在轨维修、在轨捕获及在轨组装等领域有着潜在的应用价值;这种空间绳系抓捕系统的主要架构为“空间机动平台,空间系绳,操作机器人”;在成功捕获空间非合作目标/空间垃圾后,新的复合体为“空间机动平台,空间系绳,空间非合作目标”;为了进一步完成后续的拖曳变轨/回收等任务,需要知道被抓捕目标的动力学参数,所以在抓捕后的停留阶段,需要对目标的动力学参数进行辨识,其中包括质量,转动惯量和质心到任意抓捕点距离。
目前,在于空间绳系抓捕系统相关的研究中,系绳的释放和回收研究占了绝大多数。但是目前为止,国内外没有任何学者针对非合作抓捕后的动力学参数辨识问题进行相关研究。在空间绳系抓捕系统的任务中,利用空间绳系机器人或者空间飞网完成对空间非合作目标的抓捕后,紧接着就要进行下一步的回收/拖曳任务。作为新组合而成的空间刚-柔-刚复合体,为了下一步回收/拖曳任务中的精确控制,必须要辨识被抓捕目标的动力学参数。
在所有的动力学参数中,又尤其以空间非合作目标的质量最为关键。第一个原因是,通常情况下的空间绳系抓捕系统,系绳的长度远远大于目标卫星和本体卫星的尺寸,于是这两个刚体就退化成了质点。在此情况下,空间非合作目标的质量即成为必不可少的也是唯一需要辨识的参数。第二个原因是,无论是目标回收,还是拖曳变轨,都需要通过系绳来控制稳定回收/拖曳。而在空置率的设计中,被抓捕目标的质量是至关重要的。
发明内容
本发明的目的是针对空间绳系抓捕系统空间非合作目标的问题,提出一种利用抓捕后的停留阶段对空间非合作目标进行快速参数辨识,并在回收前期进行精确参数辨识的基于空间系绳抓捕系统的非合作目标质量辨识方法,该方法可以广泛应用于空间绳系抓捕系统抓捕空间非合作目标后,对目标的动力学参数进行辨识。
为了实现上述目的,本发明所采用的技术方案包括以下步骤:
1)利用拉格朗日法推导“空间机动平台-系绳-空间非合作目标”复合体的动力学方程;
2)抓捕后停留段的姿态动力学分析;
3)后抓捕阶段的空间非合作目标质量参数辨识;
4)空间非合作目标回收阶段的自适应控制。
所述的步骤1)中,“空间机动平台-系绳-空间非合作目标”复合体的动力学方程的推导方法具体如下:
空间绳系抓捕系统由释放出绳系终端抓捕器的本体卫星,在空间轨道运行的被抓捕目标卫星,以及连接两个卫星的系绳所构成;其中m1,m2,mt分别为本体卫星、目标卫星和系绳的质量;地心指向空间绳系抓捕系统质心C的矢量Rc是由真近点角γ和径向坐标Rc定义的;R1,R2,Rt分别是由地心指向本体卫星质心,目标卫星质心和系绳上任意一质点的位置矢量;轨道坐标系C-x0y0z0作为一个旋转坐标系,其原点即为空间绳系抓捕系统质心,x0轴沿质心矢量Rc并指向地心反方向,y0轴垂直于x0轴并与其共同构成轨道平面,z0轴满足右手定则;旋转坐标系C-xyz为空间绳系抓捕系统的本体坐标系,这个旋转坐标系的原点分别为空间绳系抓捕系统质心;其中,本体坐标系x-y-z是从轨道坐标系x0-y0-z0绕z0轴旋转面内角α,再绕瞬时坐标轴y′旋转面外角β得到的,且假设这两次旋转是瞬时连续完成的,α即为系绳的面内摆角,β是系绳的面外摆角;
地心到本体卫星、目标卫星和系绳上任意质点的矢量位置分别为:
R1=RC+r1 (28)
R2=RC+r2 (29)
Rt=RC+rt (30)
其中,r1,r2和rt分别是系绳的质心到本体卫星的系绳连接点、目标卫星的系绳连接点和系绳上任意一质点的位置矢量,r1=r1it,r2=-r2it,rt=(s-r2)it;其中r1和r2分别是空间绳系抓捕系统质心与两个卫星的系绳连接点的距离,s是绳上任意一点到目标卫星的系绳连接点的距离;
R1,R2,Rt和RC满足空间绳系抓捕系统质心定理:
需要指出的是,由于系绳是由本体卫星释放/回收的,所以有:
空间绳系抓捕系统由于移动而产生的动能为:
其中,
其中,ω是空间绳系抓捕系统的旋转角速度,i是x轴的单位矢量;由于已经假设空间绳系抓捕系统的质心满足开普勒圆轨道, 是轨道角速度,RC是空间绳系抓捕系统质心在惯性坐标系下的矢量的标量值;
从而得到空间绳系抓捕系统的动能为:
其中,为质量特性参数,M为空间绳系抓捕系统的总质量;
空间绳系抓捕系统的势能可表示为:
其中μ是地球的引力常量;为了公式的简化,将公式(1)~(3)带入公式(11),并逐项展开;以1/|R1|为例,其展开过程如下:
展开后省略所有|ri|/Rc的高阶项,其中ri分别为r1,r2和rt;根据公式(4)空间绳系抓捕系统质心定理,对展开后的空间绳系抓捕系统势能进行整理,得到空间绳系抓捕系统的势能为:
空间绳系抓捕系统的Lagrangian方程为:
为了使得到的动力学方程更利于仿真分析,在通过拉格朗日法得到了空间绳系抓捕系统的动力学方程后,对所有方程进行无量纲化,具体的无量纲化定义为:
其中,Lr是参考系绳长度,在后抓捕和回收过程中通常被定义为回收前的原始绳长;τ是无量纲时间,是轨道角速度;
得到的空间绳系抓捕系统无量纲条件下的系绳面内摆角、面外摆角和系绳长度的动力学公式为:
其中, 是轨道角速度,Qβ,Qα和QΛ都为广义力;在此推导中,QΛ即为系绳的拉力(QΛ=-T)。
所述的系绳面内摆角和面外摆角均为空间绳系抓捕系统本体坐标系相对于轨道坐标系的摆角。
所述的步骤2)中,抓捕后停留段的姿态动力学分析的具体方法是:
在抓捕后停留阶段,系绳的长度没有任何改变,即Λ=1,且Λ′=Λ″=0;将此条件带入公式(16)和(17),即可得到复合体组成后,系绳面内摆角和面外摆角的动力学公式:
并将同样的后抓捕阶段状态带入系绳长度公式,重写后得到抓捕后阶段系绳拉力的表达式:
除此之外,由Hamilton原理可知,如果一个空间绳系抓捕系统不受非守恒外力作用,并且能量公式不是时间t的显式,那么空间绳系抓捕系统的Hamilton表达式H是一个常值,公式(19)和(20)可积;在利用绳系抓捕器抓捕及回收/拖曳目标卫星的整个过程中,仅仅在这个空间绳系抓捕系统质心满足开普勒圆轨道的后抓捕停留阶段符合此条件,因为没有任何外加的耗散力作用在空间绳系抓捕系统上。
所述的步骤3)中,后抓捕阶段的空间非合作目标质量参数辨识的具体方法是:
为了能够稳定而高效的完成下一阶段任务,首先需要获得目标的动力学参数;其中包括:目标卫星的质量、转动惯量和目标质心到被抓捕点的距离;
辨识算法为具有遗忘因子的递推最小二乘算法:
其中
为了保证便是算法的稳定,选择P(0)=κ且κ>0,可遗忘因子λ选择靠近1的任意值;根据动力学公式(19)和(20),上述算法中的各个部分分别为:
所述的步骤4)中,空间非合作目标回收阶段的自适应控制的具体方法是:
基于系绳拉力的控制律I如下:
其中,这种控制律由于只用到了系绳的拉力,对系绳面内摆角和面外摆角的控制都较弱;在这种控制律下的,面内摆角和面外摆角均不能稳定在0°,而是在微小范围内摆动,其中,面内摆角在±1°范围内,面外摆角在±5°范围内;
基于系绳拉力和本体卫星面外推力器控制的控制律II为:
与现有技术相比,本发明具有以下有益效果:
本发明针对空间绳系抓捕系统抓捕空间非合作目标的问题,提出一种利用抓捕后的停留阶段对非合作目标进行快速参数辨识,并在回收前期进行精确参数辨识的方法。其特点是无论前期空间绳系抓捕系统的末端执行器是飞网、机械臂还是手爪,在完成抓捕后组合而成的新系统自然形成本发明中推导的空间绳系抓捕系统模型;在充分考虑了重力梯度对长系绳的Coriolis力影响的基础上,推导了抓捕后空间绳系抓捕系统的动力学模型,此动力学模型能够充分体现空间绳系抓捕系统后抓捕阶段的面内和面外摆角,以及非合作目标回收阶段由于科式力和系绳负阻尼振荡项-l′/l加剧面内摆角和面外摆角的影响作用;本发明在对后抓捕阶段的动力学分析的基础上,利用系绳面内摆角实现了普通情况和极端情况下的非合作目标质量辨识的初步结果,由于辨识快速,此辨识策略适用于各种后抓捕方案;目标回收阶段,针对两种现有的成熟控制策略,对其在辨识方面的表现进行评估,并从控制律的角度分析了两种结果差别的原因,从而选出控制与辨识相结合最优的解决方案;基于后抓捕阶段的初步辨识结果,解和适合的控制策略,可以在回收初期就得到精确的非合作目标质量辨识结果。
附图说明
图1为本发明的空间绳系抓捕系统抓捕空间非合作目标后的结构图。
图2为本发明的参数辨识流程图。
图3为本发明的基于参数辨识的自适应空间非合作目标回收控制流程图。
图4为本发明在控制律I和控制律II下的系绳面内摆角。
图5为本发明在控制律I和控制律II下的系绳面外摆角。
图6为本发明在控制律I和控制律II下的空间非合作目标回收。
图7为本发明在控制律I和控制律II下的空间非合作目标参数辨识结果。
其中,1为本体卫星;2为被抓捕的空间非合作目标;O-XYZ为惯性坐标系;C-xoyozo为轨道坐标系;C-xyz为空间绳系抓捕系统的本体坐标系。
具体实施方式
下面结合附图对本发明的做进一步详细的说明:
参见图1,本发明主要包括以下步骤:
第一步:明确空间绳系抓捕系统抓捕前的速度、位置、轨道参数以及待抓捕目标的速度、位置、轨道参数,抓捕瞬间系绳的长度,系绳面内和面外摆角的角度、角速度;
第二步:根据抓捕后的动力学方程(19),(20)和(21),分析抓捕后系绳的面内摆角运动和面外摆角运动;
第三步:如图2所示,在参数辨识的过程中,需要将仿真分为两部分,一部分模拟真实的抓捕后复合运动并提供相应的传感器信息,另一部分模拟在线辨识算法,对未知目标进行在线辨识;
第四步:利用具有遗忘因子的递推最小二乘辨识算法,运用抓捕后停留阶段的动力学公式(22)~(25),参照图2对目标进行初步的辨识:
ΔT(t)=ΦT(t)Θ(t) (55)
其中
第五步:在基于抓捕后阶段得到的初步的目标质量的基础上,以此作为回收阶段参数辨识的初始值,分别利用控制律I和控制律II,按照参数辨识的流程图3,对被抓捕的空间非合作目标2的质量进行精确辨识。
具体步骤如下:
(1)利用拉格朗日法推导“空间机动平台-系绳-空间非合作目标”复合体的动力学方程
空间绳系抓捕系统由释放出绳系终端抓捕器的本体卫星1,在空间轨道运行的被抓捕目标卫星,以及连接两个卫星的系绳所构成。其中m1,m2,mt分别为本体卫星、目标卫星和系绳的质量。地心指向空间绳系抓捕系统质心C的矢量Rc是由真近点角γ和径向坐标Rc定义的;R1,R2,Rt分别是由地心指向本体卫星质心,目标卫星质心和系绳上任意一质点的位置矢量。轨道坐标系C-x0y0z0作为一个旋转坐标系,其原点即为空间绳系抓捕系统质心,x0轴沿质心矢量Rc并指向地心反方向,y0轴垂直于x0轴并与其共同构成轨道平面,z0轴满足右手定则。旋转坐标系C-xyz为空间绳系抓捕系统的本体坐标系,这个旋转坐标系的原点分别为空间绳系抓捕系统质心。其中,本体坐标系x-y-z是从轨道坐标系x0-y0-z0绕z0轴旋转面内角α,再绕瞬时坐标轴y′旋转面外角β得到的。且假设这两次旋转是瞬时连续完成的。α即为系绳的面内摆角,β是系绳的面外摆角。
地心到本体卫星、目标卫星和系绳上任意质点的矢量位置分别为:
R1=RC+r1 (56)
R2=RC+r2 (57)
Rt=RC+rt (58)
其中,r1,r2和rt分别是系绳的质心到本体卫星的系绳连接点、目标卫星的系绳连接点和系绳上任意一质点的位置矢量,r1=r1it,r2=-r2it,rt=(s-r2)it。其中r1和r2分别是空间绳系抓捕系统质心与两个卫星的系绳连接点的距离,s是绳上任意一点到目标卫星的系绳连接点的距离。
R1,R2,Rt和RC满足空间绳系抓捕系统质心定理:
需要指出的是,由于系绳是由本体卫星释放/回收的,所以有:
空间绳系抓捕系统由于移动而产生的动能为:
其中,
ω是空间绳系抓捕系统的旋转角速度,i是x轴的单位矢量。其中,由于已经假设空间绳系抓捕系统的质心满足开普勒圆轨道, 是轨道角速度,RC是系统质心在惯性坐标系O-XYZ下的矢量的标量值。
从而得到系统的动能为:
其中,为质量特性参数,M为空间绳系抓捕系统的总质量。
空间绳系抓捕系统的势能可表示为:
其中μ是地球的引力常量。为了公式的简化,将公式(1)-(3)带入公式(11),并逐项展开。以1/|R1|为例,其展开过程如下:
展开后省略所有|ri|/Rc的高阶项(其中ri分别为r1,r2和rt),并根据空间绳系抓捕系统质心定理(4),对展开后的空间绳系抓捕系统势能进行整理,得到空间绳系抓捕系统的势能为:
空间绳系抓捕系统的Lagrangian方程为:
为了使得到的动力学方程更利于仿真分析,在通过拉格朗日法得到了空间绳系抓捕系统的动力学方程后,对所有方程进行无量纲化,具体的无量纲化定义为:
其中,Lr是参考系绳长度,在后抓捕和回收过程中通常被定义为回收前的原始绳长;τ是无量纲时间,是轨道角速度。
得到的空间绳系抓捕系统无量纲条件下的系绳面内摆角(空间绳系抓捕系统本体坐标系相对于轨道坐标系)、面外摆角(空间绳系抓捕系统本体坐标系相对于轨道坐标系)和系绳长度的动力学公式为:
其中, 是轨道角速度,Qβ,Qα和QΛ都为广义力。在此推导中,QΛ即为系绳的拉力(QΛ=-T)。
(2)抓捕后停留段的姿态动力学分析
在抓捕后停留阶段,系绳的长度没有任何改变,即Λ=1,且Λ′=Λ″=0。将此条件带入公式(16)和(17),即可得到复合体组成后,系绳面内摆角和面外摆角的动力学公式:
并将同样的后抓捕阶段状态带入系绳长度公式,重写后得到抓捕后阶段系绳拉力的表达式:
除此之外,由Hamilton原理可知,如果一个空间绳系抓捕系统不受非守恒外力作用,并且能量公式不是时间t的显式,那么空间绳系抓捕系统的Hamilton表达式H是一个常值,公式(19)和(20)可积。在利用绳系抓捕器抓捕及回收/拖曳目标卫星的整个过程中,仅仅在这个空间绳系抓捕系统质心满足开普勒圆轨道的后抓捕停留阶段符合此条件,因为没有任何外加的耗散力作用在空间绳系抓捕系统上。
(3)后抓捕阶段的空间非合作目标质量参数辨识
为了能够稳定而高效的完成下一阶段任务,我们首先需要获得目标的动力学参数。其中包括:目标卫星的质量、转动惯量和目标质心到被抓捕点的距离。在这些参数中,又尤其以目标卫星的质量最为重要,这在所有的回收/拖曳变轨的控制中都是必不可少的。
本发明选择的辨识算法为具有遗忘因子的递推最小二乘算法:
其中
为了保证便是算法的稳定,其中P(0)的选择十分重要,在此根据实践经验选择P(0)=κ且κ>0,可遗忘因子λ则是选择非常靠近1的任意值即可。根据本发明的动力学公式,上述算法中的各个部分分别为:
(4)空间非合作目标回收阶段的自适应控制
在空间非合作目标的回收过程中,有很多不同的控制算法可以达到被抓捕目标稳定回收的目的。但是这些控制算法都是基于被抓捕目标为空间非合作目标,即质量等动力学参数已知的情况下的。在被抓捕目标位空间非合作目标的情况下,只有通过参数辨识不断精确目标质量,更新控制律,才能完成稳定而快速的回收。
基于系绳拉力的控制律I(TC1)如下:
其中,和的定义已经在动力学公式(16)-(18)中提到,具体表示为,和这种控制律由于只用到了系绳的拉力,对系绳面内摆角和面外摆角的控制都较弱。如图4和图5所示,在这种控制律下的,面内摆角和面外摆角均不能稳定在0°;而是在一定的微小范围(面内摆角在±1°范围内,面外摆角在±5°范围内)内摆动。但是,这种控制律却更利于参数辨识。因为在回收过程中的这种有界振荡恰好可以被参数辨识所有效利用。
基于系绳拉力和本体卫星面外推力器控制的控制律II(TC2)为:
其中的和的定义和上述控制律I中的定义完全一致。由于这个控制律同时用到了系绳的拉力和面外推力器,这对于系绳的面内摆角和面外摆角的控制起到了非常显著的作用。如图4和图5所示,在控制律II下,系绳的面内摆角和面外摆角可以快速而稳定的收敛到0°,如图6所示,且在控制律II的作用下,整个回收过程更短。但是这个控制律并不利于参数辨识。因为当系绳面内摆角和面外摆角迅速的收敛到0后,辨识算法中的为零,辨识无法有效利用;除此之外,轨道平面内垂直于系绳方向的推力器控制律并不容易施加。非合作目标的质量辨识结果如图7所示,由辨识结果和实际控制律施加难易程度来说,控制律I是更适合的结合参数辨识的非合作目标回收控制律。
本发明的原理
本发明在完成对空间非合作目标的抓捕后,新的复合体空间绳系抓捕系统即刻进入后抓捕模式,利用此阶段对目标卫星的质量进行辨识是最佳时机。但是,实际情况中,根据不同的任务需要,后抓捕阶段的时间长短各不相同,这就需要辨识算法本身具有非常快速的辨识能力;同时,在这一阶段中空间绳系抓捕系统处于不稳定阶段,其各种状态参数可能会存在跳变,在此情况下的传感器可能会存在较大的误差,这也就要求了辨识算法需要有很强的容错能力。在抓捕阶段对空间非合作目标进行了初步的参数辨识后,就需要在后续的回收过程中对目标进行精确辨识。目前,国内外对于由系绳连接的目标回收问题已经进行了很多相关的研究。但是还没有文章针对空间非合作目标的自适应回收问题进行控制研究。本发明就是在不同回收控制算法的比较分析的基础上,结合了精确参数辨识,选择了最适合的空间非合作目标自适应回收控制算法。
本发明提出了一种空间绳系机器人空间绳系抓捕系统抓捕空间非合作目标后,在后抓捕阶段和回收阶段对目标动力学参数进行辨识并在此基础上完成自适应回收控制的方法。首先,提出了一种参数辨识方法在后抓捕期对空间非合作目标的质量进行初步辨识。然后,根据不同的回收控制算法对参数辨识的影响,提出一种最适合的控制算法。最后,在基于后抓捕阶段的初步的参数辨识结果的基础上,完成空间非合作目标回收过程中的自适应控制。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。
Claims (5)
1.一种基于空间系绳抓捕系统的非合作目标质量辨识方法,其特征在于,包括以下步骤:
1)利用拉格朗日法推导“空间机动平台-系绳-空间非合作目标”复合体的动力学方程;
“空间机动平台-系绳-空间非合作目标”复合体的动力学方程的推导方法具体如下:
空间系绳抓捕系统由释放出绳系终端抓捕器的本体卫星,在空间轨道运行的被抓捕目标卫星,以及连接两个卫星的系绳所构成;其中m1,m2,mt分别为本体卫星、目标卫星和系绳的质量;地心指向空间系绳抓捕系统质心C的矢量Rc是由真近点角γ和径向坐标Rc定义的;R1,R2,Rt分别是由地心指向本体卫星质心,目标卫星质心和系绳上任意一质点的位置矢量;轨道坐标系C-x0y0z0作为一个旋转坐标系,其原点即为空间系绳抓捕系统质心,x0轴沿质心矢量Rc并指向地心反方向,y0轴垂直于x0轴并与其共同构成轨道平面,z0轴满足右手定则;旋转坐标系C-xyz为系统的本体坐标系,这个旋转坐标系的原点分别为空间系绳抓捕系统质心;其中,本体坐标系x-y-z是从轨道坐标系x0-y0-z0绕z0轴旋转面内角α,再绕瞬时坐标轴y′旋转面外角β得到的,且假设这两次旋转是瞬时连续完成的,α即为系绳的面内摆角,β是系绳的面外摆角;
地心到本体卫星、目标卫星和系绳上任意质点的矢量位置分别为:
R1=RC+r1 (1)
R2=RC+r2 (2)
Rt=RC+rt (3)
其中,r1,r2和rt分别是系绳的质心到本体卫星的系绳连接点、目标卫星的系绳连接点和系绳上任意一质点的位置矢量,r1=r1i,r2=-r2i,rt=(s-r2)i;其中r1和r2分别是空间系绳抓捕系统质心与两个卫星的系绳连接点的距离,s是绳上任意一点到目标卫星的系绳连接点的距离;
R1,R2,Rt和RC满足系统质心定理:
需要指出的是,由于系绳是由本体卫星释放/回收的,所以有:
空间系绳抓捕系统由于移动而产生的动能为:
其中,
其中,ω是空间系绳抓捕系统的旋转角速度;由于已经假设空间系绳抓捕系统的质心满足开普勒圆轨道, 是轨道角速度,RC是空间系绳抓捕系统质心在惯性坐标系下的矢量的标量值;
从而得到空间系绳抓捕系统的动能为:
其中,为质量特性参数,M为系统的总质量;
空间系绳抓捕系统的势能可表示为:
其中μ是地球的引力常量;为了公式的简化,将公式(1)~(3)带入公式(11),并逐项展开;以1/|R1|为例,其展开过程如下:
展开后省略所有|ri|/Rc的高阶项,其中ri分别为r1,r2和rt;根据公式(4)系统质心定理,对展开后的空间系绳抓捕系统势能进行整理,得到系统的势能为:
其中l是系绳长度;
空间系绳抓捕系统的Lagrangian方程为:
为了使得到的动力学方程更利于仿真分析,在通过拉格朗日法得到了空间系绳抓捕系统的动力学方程后,对所有方程进行无量纲化,具体的无量纲化定义为:
得到的空间系绳抓捕系统无量纲条件下的系绳面内摆角、面外摆角和系绳长度的动力学公式为:
其中, 是轨道角速度;Qβ,Qα和QΛ都为广义力;在此推导中,QΛ即为系绳的拉力,具体表示为QΛ=-T;
2)抓捕后停留段的姿态动力学分析;
3)后抓捕阶段的空间非合作目标质量参数辨识;
4)空间非合作目标回收阶段的自适应控制。
2.根据权利要求1所述的基于空间系绳抓捕系统的非合作目标质量辨识方法,其特征在于:所述的系绳面内摆角和面外摆角均为空间系绳抓捕系统本体坐标系相对于轨道坐标系的摆角。
3.根据权利要求1或2所述的基于空间系绳抓捕系统的非合作目标质量辨识方法,其特征在于:所述的步骤2)中,抓捕后停留段的姿态动力学分析的具体方法是:
在抓捕后停留阶段,系绳的长度没有任何改变,即Λ=1,且Λ′=Λ″=0;将此条件带入公式(16)和(17),即可得到复合体组成后,系绳面内摆角和面外摆角的动力学公式:
并将同样的后抓捕阶段状态带入系绳长度公式,重写后得到抓捕后阶段系绳拉力的表达式:
除此之外,由Hamilton原理可知,如果一个空间绳系抓捕系统不受非守恒外力作用,并且能量公式不是时间t的显式,那么空间绳系抓捕系统的Hamilton表达式H是一个常值,公式(19)和(20)可积;在利用绳系抓捕器抓捕及回收/拖曳目标卫星的整个过程中,仅仅在这个空间绳系抓捕系统质心满足开普勒圆轨道的后抓捕停留阶段符合此条件,因为没有任何外加的耗散力作用在空间绳系抓捕系统上。
4.根据权利要求3所述的基于空间系绳抓捕系统的非合作目标质量辨识方法,其特征在于:所述的步骤3)中,后抓捕阶段的空间非合作目标质量参数辨识的具体方法是:
为了能够稳定而高效的完成下一阶段任务,首先需要获得目标的动力学参数;其中包括:目标卫星的质量、转动惯量和目标质心到被抓捕点的距离;
辨识算法为具有遗忘因子的递推最小二乘算法:
其中
具体表达式如下:为了保证辨识算法的稳定,选择P(0)=κ且κ>0,可遗忘因子λ选择靠近1的任意值;根据动力学公式(19)和(20),上述算法中的各个部分分别为:
5.根据权利要求4所述的基于空间系绳抓捕系统的非合作目标质量辨识方法,其特征在于:所述的步骤4)中,空间非合作目标回收阶段的自适应控制的具体方法是:
基于系绳拉力的控制律I如下:
其中,这种控制律由于只用到了系绳的拉力,对系绳面内摆角和面外摆角的控制都较弱;在这种控制律下的,面内摆角和面外摆角均不能稳定在0°,而是在微小范围内摆动,其中,面内摆角在±1°范围内,面外摆角在±5°范围内;
基于系绳拉力和本体卫星面外推力器控制的控制律II为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410341359.5A CN104252574B (zh) | 2014-07-17 | 2014-07-17 | 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410341359.5A CN104252574B (zh) | 2014-07-17 | 2014-07-17 | 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104252574A CN104252574A (zh) | 2014-12-31 |
CN104252574B true CN104252574B (zh) | 2017-07-11 |
Family
ID=52187462
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410341359.5A Active CN104252574B (zh) | 2014-07-17 | 2014-07-17 | 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104252574B (zh) |
Families Citing this family (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105353790B (zh) * | 2015-11-17 | 2017-11-28 | 西北工业大学 | 一种空间绳系机器人目标抓捕后复合体稳定控制方法 |
CN106569502A (zh) * | 2016-05-20 | 2017-04-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 | 浙江大学 | 一种空间悬浮绳系组合体面内摆动控制方法 |
CN106855690B (zh) * | 2016-11-24 | 2020-04-03 | 西北工业大学 | 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 |
CN106892137B (zh) * | 2017-02-21 | 2019-05-28 | 哈尔滨工业大学深圳研究生院 | 一种空间非合作翻滚目标的大容差捕获方法及系统 |
CN107065910B (zh) * | 2017-04-24 | 2020-01-14 | 西北工业大学 | 空间绳系抓捕系统保持阶段系绳面内面外角稳定控制方法 |
CN107145071B (zh) * | 2017-05-19 | 2019-12-27 | 西北工业大学 | 一种空间系绳系统的拉格朗日动力模型及控制器 |
CN107908105B (zh) * | 2017-07-04 | 2020-10-23 | 上海宇航系统工程研究所 | 一种基于推力器开关控制的绳系组合体拖曳移除方法 |
CN108927803A (zh) * | 2018-07-25 | 2018-12-04 | 西北工业大学 | 一种在连续碰撞条件下空间机器人目标抓捕稳定方法 |
CN109063307B (zh) * | 2018-07-26 | 2019-10-18 | 西北工业大学 | 一种可机动飞网抓捕目标的碰撞位移和碰撞力计算方法 |
CN109878763B (zh) * | 2019-03-05 | 2021-11-26 | 哈尔滨工业大学 | 一种基于非接触电磁力的空间翻滚目标质量及惯量参数辨识方法 |
CN110081906B (zh) * | 2019-03-28 | 2022-11-22 | 西北工业大学 | 基于吸附过程的非合作目标惯性特征参数的两步辨识方法 |
CN110751886B (zh) * | 2019-09-18 | 2021-12-07 | 上海航天控制技术研究所 | 一种绳系拖曳控制地面试验验证方法及系统 |
CN112478200B (zh) * | 2020-11-27 | 2022-06-14 | 哈尔滨工业大学 | 一种对组合体航天器全部质量参数辨识的姿轨耦合控制方法 |
CN113734476B (zh) * | 2021-09-07 | 2023-03-14 | 北京控制工程研究所 | 一种边界触发常值推力下的摆角控制方法和系统 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8052092B2 (en) * | 2009-01-30 | 2011-11-08 | The Boeing Company | Method and apparatus for satellite orbital change using space debris |
CN102759358A (zh) * | 2012-03-14 | 2012-10-31 | 南京航空航天大学 | 基于失效卫星表面参考点的相对位姿动力学建模方法 |
CN103123668A (zh) * | 2013-01-16 | 2013-05-29 | 西北工业大学 | 一种基于混合单元法的空间绳系机器人系统的仿真方法 |
CN103927451A (zh) * | 2014-04-21 | 2014-07-16 | 西北工业大学 | 一种空间机器人系统参数在轨辨识方法 |
-
2014
- 2014-07-17 CN CN201410341359.5A patent/CN104252574B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8052092B2 (en) * | 2009-01-30 | 2011-11-08 | The Boeing Company | Method and apparatus for satellite orbital change using space debris |
CN102759358A (zh) * | 2012-03-14 | 2012-10-31 | 南京航空航天大学 | 基于失效卫星表面参考点的相对位姿动力学建模方法 |
CN103123668A (zh) * | 2013-01-16 | 2013-05-29 | 西北工业大学 | 一种基于混合单元法的空间绳系机器人系统的仿真方法 |
CN103927451A (zh) * | 2014-04-21 | 2014-07-16 | 西北工业大学 | 一种空间机器人系统参数在轨辨识方法 |
Non-Patent Citations (2)
Title |
---|
《Mass and Mass Center Identification of Target》;Chuang Liu et al;《Proceeding of the 11th World Congress on Intelligent Control and Automation》;20140704;第5802-5807页; * |
《空间机器人抓取过程中的目标参数辨识》;王洪柳;《中国优秀硕士学位论文全文数据库信息科技辑》;20120515;第1-4章; * |
Also Published As
Publication number | Publication date |
---|---|
CN104252574A (zh) | 2014-12-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104252574B (zh) | 一种基于空间系绳抓捕系统的非合作目标质量辨识方法 | |
CN106625671B (zh) | 一种空间机器人抓捕翻滚目标的最优轨迹规划方法 | |
Huang et al. | Impact dynamic modeling and adaptive target capturing control for tethered space robots with uncertainties | |
Hablani et al. | Guidance and relative navigation for autonomous rendezvous in a circular orbit | |
CN107364589B (zh) | 基于多系绳连接点对空间失稳目标的绕飞消旋控制方法 | |
CN104049637B (zh) | 一种空间绳系机器人三轴主动姿态控制方法 | |
Aghili | Optimal control for robotic capturing and passivation of a tumbling satellite with unknown dynamics | |
CN112597587A (zh) | 一种失效卫星绳系回收的摆动抑制方法 | |
CN107145071A (zh) | 一种空间系绳系统的拉格朗日动力模型及控制器 | |
Xu et al. | Modeling and planning of a space robot for capturing tumbling target by approaching the dynamic closest point | |
CN104407620B (zh) | 一种主被动结合的绳网拖拽安全离轨控制方法 | |
CN109878763A (zh) | 一种基于非接触电磁力的空间翻滚目标质量及惯量参数辨识方法 | |
Kawamoto et al. | Ground experiment of mechanical impulse method for uncontrollable satellite capturing | |
Li et al. | Nonlinear model predictive control for cooperative transportation and manipulation of cable suspended payloads with multiple quadrotors | |
CN106855690B (zh) | 空间绳系机器人近距离抓捕后回收目标的自适应控制方法 | |
Aslanov et al. | Survey of tether system technology for space debris removal missions | |
Mavrakis et al. | On-orbit robotic grasping of a spent rocket stage: Grasp stability analysis and experimental results | |
Wang et al. | A new spacecraft attitude stabilization mechanism using deep reinforcement learning method | |
Liu et al. | Mass and mass center identification of target satellite after rendezvous and docking | |
Sun et al. | Towed-body trajectory tracking in aerial recovery of micro air vehicle in the presence of wind | |
Hirano et al. | Vibration suppression control of a space robot with flexible appendage based on simple dynamic model | |
Diao et al. | An output feedback attitude tracking controller design for quadrotor unmanned aerial vehicles using quaternion | |
Jana et al. | Interception of an aerial manoeuvring target using monocular vision | |
CN109987258B (zh) | 一种空间机器人捕获非合作目标后的消旋方法 | |
Jin et al. | A motion planning method based vision servo for free-flying space robot capturing a tumbling satellite |
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 |