CN108974396B - 面向空间翻滚失效目标的多指包络式容错抓捕装置及方法 - Google Patents

面向空间翻滚失效目标的多指包络式容错抓捕装置及方法 Download PDF

Info

Publication number
CN108974396B
CN108974396B CN201810872895.6A CN201810872895A CN108974396B CN 108974396 B CN108974396 B CN 108974396B CN 201810872895 A CN201810872895 A CN 201810872895A CN 108974396 B CN108974396 B CN 108974396B
Authority
CN
China
Prior art keywords
finger
target
space
capture
configuration
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
Application number
CN201810872895.6A
Other languages
English (en)
Other versions
CN108974396A (zh
Inventor
袁建平
万文娅
孙冲
马卫华
方静
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN201810872895.6A priority Critical patent/CN108974396B/zh
Publication of CN108974396A publication Critical patent/CN108974396A/zh
Application granted granted Critical
Publication of CN108974396B publication Critical patent/CN108974396B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G4/00Tools specially adapted for use in space
    • BPERFORMING OPERATIONS; TRANSPORTING
    • B64AIRCRAFT; AVIATION; COSMONAUTICS
    • B64GCOSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
    • B64G4/00Tools specially adapted for use in space
    • B64G2004/005Robotic manipulator systems for use in space

Landscapes

  • Engineering & Computer Science (AREA)
  • Remote Sensing (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Manipulator (AREA)

Abstract

本发明公开了一种面向空间翻滚失效目标的多指包络式容错抓捕装置及方法,装置包括携带多指手抓捕机构的服务航天器,所述的多指手抓捕机构中的每个手指由中间刚性部分和外部柔性部分组成的点手指,柔性部分能够使得空间翻滚失效目标和多指手抓捕机构碰撞时不会对影响服务航天器正常工作。当服务航天器与空间翻滚失效目标实现轨道运动同步时,多指手抓捕机构进一步接近目标,在给定时间间隔内实现对目标的包络,即将目标约束在由多指手机构形成的抓捕空间区域内,然后收紧手指实现对目标的抓捕。针对空间翻滚失效目标,在抓捕中不需要精确的目标信息同时对目标具有自适应性;在抓捕后又能够对目标进行精确操作实现接管控制。

Description

面向空间翻滚失效目标的多指包络式容错抓捕装置及方法
技术领域
本发明涉及空间失效目标抓捕领域,具体为一种面向空间翻滚失效目标的多指包络式容错抓捕装置及方法。
背景技术
伴随着人类对空间资源的不断探索与利用,由故障失效卫星、各种爆炸以及碎片等各种原因造成的大量空间垃圾,使得空间资源逐步呈现出短缺的现状,同时对空间安全也造成了严重威胁。对失效航天器或轨道垃圾清理迫在眉睫,但由于空间垃圾的非合作性(无专门的抓捕对接机构、无合作测量装置、失去姿态调整能力等)使得抓捕极具挑战性。
现有抓捕方式可以分为接触式和非接触式两类。其中,接触式又可以细分为以机械臂抓捕为代表的刚性抓捕和以飞网、飞爪等为代表的柔性抓捕。刚性抓捕对目标的合作性要求很高,而飞网、飞爪对目标速度和目标大小的要求比刚性抓捕要宽松一些,但是柔性抓捕很难开展对目标的维修、检测以及再利用。非接触式抓捕则是利用空间电磁力牵引或引力牵引等方式对目标进行捕获,不需要与目标发生直接接触。
综上所述,接触式抓捕中,刚性抓捕较为成熟,但是它需要精确的目标信息、同时对抓捕过程中的控制精度要求高,爪具只能适用于特定结构,对于待抓捕目标不具有普适性;而柔性抓捕虽然具有很好的容错性,但是抓捕后很难对目标实现检测维护以及精确的接管操作(姿态/轨道调整);非接触式抓捕的理论仍然在摸索发展中。为此,提出了一种不需要精确目标信息、对目标具有自适应性、抓捕后能够进行精确操作实现接管控制的抓捕方法。
发明内容
本发明的目的在于针对上述现有技术中的问题,提供一种面向空间翻滚失效目标的多指包络式容错抓捕装置及方法。针对空间翻滚失效目标,在抓捕中不需要精确的目标信息同时对目标具有自适应性;在抓捕后又能够对目标进行精确操作实现接管控制。
为了实现上述目的,本发明所采用的技术方案是:
一种面向空间翻滚失效目标的多指包络式容错抓捕装置,包括:携带多指手抓捕机构的服务航天器,所述的多指手抓捕机构中的每个手指简化成由中间刚性部分和外部柔性部分组成的点手指,柔性部分能够使得空间翻滚失效目标1 和多指手抓捕机构碰撞时不会影响服务航天器正常工作。
一种面向空间翻滚失效目标的多指包络式容错抓捕方法,包括以下步骤:
当携带多指手抓捕机构的服务航天器与空间翻滚失效目标实现轨道运动同步时,多指手抓捕机构进一步接近空间翻滚失效目标,在给定时间间隔内实现对目标的包络,将目标约束在由多指手抓捕机构形成的抓捕空间区域内,然后收紧手指实现对目标的抓捕。
作为本发明的进一步改进,具体包括以下步骤:
步骤1:服务航天器向空间翻滚目标接近,实现轨道运动同步,并调整姿态,使多指手抓捕机构对准空间翻滚失效目标;然后,服务航天器通过测量设备获取空间翻滚失效目标的测量信息,包括几何外形信息、惯性参数以及旋转角速度;
步骤2:根据空间翻滚失效目标的测量信息,预测在抓捕过程中空间翻滚失效目标的运动可达域;
步骤3:对于多指手抓捕机构,计算出在包络构型实现之前每根手指运动的所有可能路径的运动集合;进一步,考虑实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束,同时每根手指的位置也受多指手指基座的限制以及每根手指驱动力矩的约束,进而从运动集合中筛选出符合上述约束的可行手指构型;
步骤4:进行动态包络检测,在给定时刻,检测所有手指可行构型区域内是否存在对目标成功包络的有效手指构型,如果存在,则成功实现包络成功,反之则是包络不成功;
步骤5:在得到有效包络构型后,收紧手指,实现对目标的抓捕。
作为本发明的进一步改进,所述的空间翻滚失效目标是指平面物体或能够简化成平面物体的目标。
作为本发明的进一步改进,步骤1中的多指手抓捕机构中的每个手指简化为由中间刚性部分和外部柔性部分组成的点手指,柔性部分能够使得空间翻滚失效目标和多指手抓捕机构碰撞时不会对影响服务航天器正常工作。
作为本发明的进一步改进,步骤2中目标的运动可达域是指整个包络过程中目标所有能够到达区域的集合,具体计算过程如下:
由步骤1中得到的目标惯性参数Ix、Iy和Iz以及Ixy、Ixz和Iyz,目标角速度ω和姿态四元数q,利用空间翻滚失效目标的一般性运动方程(1)和(2)预测出所有目标在每一时刻t的构型qobj(t),进而得到目标所有构型的集合{qobj(t)};
Figure BDA0001752583520000031
其中,ω=[ωxyz]T是目标的角速度;
Figure BDA0001752583520000032
是目标的角加速度;假设
Figure BDA0001752583520000033
是目标的姿态四元数,其中q0
Figure BDA0001752583520000034
分别是q的标量和矢量部分;q的导数和ω之间的关系如下:
Figure BDA0001752583520000041
这里,
Figure BDA0001752583520000042
是qt的导数;
对于2维平面物体的空间翻滚目标,忽略外力/外力矩影响时,其转动方程为:
Figure BDA0001752583520000043
其中,Jt是平面物体的转动惯量,ωt是平面物体的转动角速度,Mt是平面物体受到的外力矩;对于平面物体,目标的姿态角θt可以表示为:
Figure BDA0001752583520000044
这里,θt(t0)是物体在初始时刻t0的姿态角;
由方程(3)和(4),预测出2维空间翻滚失效目标在每一时刻t的构型qobj(t),进而得到目标所有构型的集合{qobj(t)}。
作为本发明的进一步改进,步骤3中每根手指运动所有可能路径的集合是指在整个包络过程中,同时考虑服务航天器的轨道运动和姿态运动以及每根手指所有可能的运动时,得到的每根手指在太空中所有轨迹的集合,具体步骤如下:
对于多指手抓捕机构,基于位置矢量方程(5),计算出在包络构型实现之前每根手指运动的所有可能路径的集合Pi(i=1,2,…,n),其中n是手指的个数;进一步,考虑手指在实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束方程(7),同时每根手指的位置也受多指手指基座的限制以及每根手指驱动力矩的约束方程(8)和(9),进而从Pi(i=1,2,…,n)中筛选出符合上述约束的可行手指构型Ri(i=1,2,…,n);最后,将每根手指的构型组合起来得到整个多指手机构的构型;
每个手指的最终运动是由服务航天器的姿轨运动和手指自身的张合运动组合而成的,设简化后的手指i位置矢量为pi,则有
Figure BDA0001752583520000051
其中,
Figure BDA0001752583520000052
是手指i与服务航天器连接点的位置矢量,pei是手指i对目标实施包络的位置相对于手指i与服务航天器连接点的坐标,由手指的张合角决定;rs是服务航天器质心位置矢量,其满足:
Figure BDA0001752583520000053
考虑手指在实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束,对于
Figure BDA0001752583520000054
t0和tf分别是包络过程开始和结束时刻,如下表达式都应成立:
Figure BDA0001752583520000055
其中,S指目标或单个手指在某一特定构型下所占据的空间区域;
每根手指的位置,由多指手指基座的限制以及每根手指自身驱动力矩的约束决定的,用散布函数来表示手指间的位置约束,采用如下两种散布函数来表示手指间的约束:
每对手指间的最大距离δ
δ(P(t))≡max{||Pi(t)-Pj(t)|| |i,j∈{1,2,…,n}} (8)
相邻手指间的最大距离
Figure BDA0001752583520000056
Figure BDA0001752583520000057
其中,P={P1,P2,…,Pn}是手指构型,t∈[tc,tc+Δtc]。
根据权利要求7所述的面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,步骤4中成功包络的手指构型是指多指手抓捕机构能够将空间翻滚目标约束在由多指手机构形成的抓捕空间区域内,目标只能在这一区域内运动;具体为:
在tc+Δtc时,检测所有手指可行构型区域(R={R1,R2,…,Rn})内是否存在对目标成功包络的手指构型CF,即能够保证目标不会从多指手机构形成的抓捕空间区域逃走的构型,如果
Figure BDA0001752583520000061
则在tc+Δtc时成功实现包络,反之则是不成功。
作为本发明的进一步改进,步骤5中收紧手指是指只需要控制手指的张合角,将包络构型进一步收拢直至多指手抓捕机构的每个手指都与目标接触。
与现有技术相比,本发明的有益效果是:
本发明的面向空间翻滚失效目标的多指包络式容错抓捕装置,包括:携带多指手抓捕机构的服务航天器,当服务航天器与空间翻滚失效目标实现轨道运动同步时,多指手抓捕机构进一步接近目标,在给定时间间隔内实现对目标的包络,即将目标约束在由多指手机构形成的抓捕空间区域内,然后收紧手指实现对目标的抓捕。该结构简单,通过多指手抓捕机构实现空间翻滚失效目标的快速抓捕过程。
本发明的一种面向空间翻滚失效目标的多指包络式容错抓捕方法,针对空间翻滚失效目标,在抓捕中不需要精确的目标信息同时对目标具有自适应性;在抓捕后又能够对目标进行精确操作实现接管控制。此外,包络式抓捕只需要位置控制,不需要精确的力控制,在抓捕过程中可以大大减轻服务航天器控制系统的负担;最后,先对空间翻滚目标包络再实施抓捕,可以防止在抓捕过程中空间翻滚失效目标逃离以及服务航天器的反弹。
附图说明
图1是空间翻滚目标的多指包络抓捕任务示意图;
图2是多指手抓捕机构简化示意图,其中(a)是简化前的多指手机构;(b)是简化后的多指手机构;
图3是本发明空间翻滚失效目标的示意图,其中(a)是2维目标、(b)是简化为2维目标的3维物体;
图4为2维空间翻滚目标信息获取示意图,其中(a)是目标真实数据,(b)是测量数据点图,(c)是处理后的目标测量数据;
图5是包络构型示意图,其中(a)是最小包络构型图,(b)是一般包络构型图, (c)是临界包络构型图,(d)是无效包络构型图;
图6是图4所示的2维空间翻滚目标在整个包络过程中的位置和姿态变化图;
图7是采用图2所示的简化多指手抓捕机构对图4中物体进行包络抓捕的结果图,其中(a)是包络构型图、(b)是抓捕构型图。
附图中:1—空间翻滚目标;2—服务航天器;3—服务航天器主体;4—多指手抓捕机构;5—服务航天器太阳帆;6—空间翻滚目标运行轨道;7—简化的多指手抓捕机构;8—简化的多指手抓捕机构的刚性部分;9—简化的多指手抓捕机构的柔性部分。
具体实施方式
下面结合附图以及具体实施例对本发明进行详细说明。
如图1和图2所示,本发明提供一种面向空间翻滚失效目标的多指包络式容错抓捕装置,在抓捕前先利用抓捕机构将空间翻滚失效目标包络住,然后再实施抓捕,这样可以防止在抓捕过程中空间翻滚失效目标逃离以及服务航天器的反弹。具体而言,当携带多指手抓捕机构4的服务航天器2与空间翻滚失效目标1实现轨道运动同步时,多指手抓捕机构4进一步接近目标,在给定时间内实现对目标的包络,即将目标约束在由多指手机构形成的抓捕空间区域内,然后收紧手指实现对目标1的抓捕。根据目标特性,如图2所示,将多指手抓捕机构4中的每个手指简化成一个由中间刚性部分8和外部柔性部分9组成的点手指7,手指表面的柔性部分9允许空间翻滚目标1和多指手抓捕机构4间发生一定程度的碰撞而不会对携带抓捕机构的服务航天器2产生太大影响,可以减轻服务航天器2的控制负担。
在抓捕前先利用抓捕机构将空间翻滚失效目标包络住,然后再实施抓捕,这样可以防止在抓捕过程中空间翻滚失效目标逃离以及服务航天器反弹。当携带多指手抓捕机构的服务航天器与空间翻滚失效目标实现轨道运动同步时,多指手抓捕机构进一步接近目标,在给定时间间隔内实现对目标的包络,即将目标约束在由多指手机构形成的抓捕空间区域内,然后收紧手指实现对目标的抓捕。具体包括以下步骤:
步骤1:服务航天器向空间翻滚目标接近,实现轨道运动同步,并调整姿态,使多指手抓捕机构对准空间翻滚失效目标。然后,服务航天器通过各种测量设备获取空间翻滚失效目标的信息,包括目标几何外形信息、惯性参数以及旋转角速度。
如图3所示,所述的空间翻滚失效目标特指平面物体或可以简化成平面物体的目标,这是根据地面卫星超高速撞击解体实验获得的碎片形状统计结果片状、块状和不规则形状的碎片占绝大多数。
多指手抓捕机构中的每个手指都是中间由刚性材料组成,而外部覆盖一层柔性材料,手指表面的柔性材料允许空间碎片和多指手抓捕机构间发生一定程度的碰撞而不会对携带抓捕机构的服务航天器产生太大影响,可以减轻服务航天器的控制负担。
优选地,多指手抓捕机构的每个手指都简化成一个中间刚性外部柔性的点手指,因为本专利所述的空间翻滚失效目标特指平面物体或可以简化成平面物体,此时所有的接触点都在同一平面上。
步骤2:根据空间翻滚失效目标的测量信息,预测在抓捕过程中它的运动可达域,即目标在每一时刻t的构型qobj(t)的集合{qobj(t)},这里构型qobj包含目标的位置和姿态信息。目标的运动可达域是指整个包络过程中目标所有能够到达区域的集合,是由空间翻滚目标的轨道运动和姿态运动共同决定的。
步骤3:对于多指手抓捕机构,计算出在包络构型实现之前每根手指运动的所有可能路径的集合Pi(i=1,2,…,n),其中n是手指的个数;进一步,考虑手指在实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束,同时每根手指的位置也受多指手指基座的限制以及每根手指驱动力矩的约束,进而从Pi(i=1,2,…,n)中筛选出符合上述约束的可行手指构型Ri(i=1,2,…,n);每根手指运动所有可能路径的集合是指在整个包络过程中,同时考虑服务航天器的轨道运动和姿态运动以及每根手指所有可能的运动时,得到的每根手指在太空中所有轨迹的集合。
步骤4:进行动态包络检测,即在给定时刻,检测所有手指可行构型区域 (R={R1,R2,…,Rn})内是否存在对目标成功包络的有效手指构型CF,如果
Figure BDA0001752583520000091
则成功实现包络,反之则是不成功。成功包络的手指构型是指多指手抓捕机构可以将空间翻滚目标约束在由多指手机构形成的抓捕空间区域内,目标只能在这一特定区域内运动。
步骤5:在得到有效包络构型后,收紧手指,实现对目标的抓捕。收紧手指是指只需要控制手指的张合角,将包络构型进一步收拢直至多指手抓捕机构的每个手指都与目标接触,这个过程中不需要复杂的控制。
以下结合附图,对本发明的具体步骤进行说明,包括:
步骤1:服务航天器2向空间翻滚失效目标1接近,实现轨道运动同步,并调整姿态,使多指手抓捕机构4对准空间翻滚失效目标1,如图1所示。利用服务航天器2上的各种测量设备来获取空间翻滚失效目标1的信息,本发明中用到的信息包括目标几何外形信息、目标惯性参数以及目标旋转角速度。通常利用视觉相机和传感器等设备对目标信息进行获取,受仪器设备测量精度和外界扰动的影响,所得到的目标信息不可能是完全精确的。
如图4所示,目标真实数据图(a)和目标测量数据图(c)还是存在一定差距的,但是利用本发明提供的一种空间翻滚目标的多指包络式容错抓捕方法是先对空间翻滚目标包络再实施抓捕,而包络时只需要把空间碎片约束在某一区域内,故不需要精确的目标信息以及固定抓捕点,所以允许空间翻滚失效目标的测量信息存在一定的误差。
步骤2,目标运动可达域预测。由于在多指包络式容错抓捕的整个周期内,都假设服务航天器2与空间翻滚失效目标1已经实现轨道运动同步,所以在分析目标运动时只考虑目标的姿态运动。根据步骤1中得到的目标惯性参数Ix、Iy和Iz以及Ixy、Ixz和Iyz,目标角速度ω和姿态四元数q,利用空间翻滚失效目标的一般性运动方程(1)和(2)可以预测出所有目标在每一时刻t的构型qobj(t),进而可以得到目标所有构型的集合{qobj(t)}。
Figure BDA0001752583520000101
考虑到在太空中作用在自由漂浮物体上的外力/力矩很小,所以在分析目标运动时忽略了外力/外力矩的影响。其中,ω=[ωxyz]T是目标的角速度;
Figure BDA0001752583520000111
是目标的角加速度。假设
Figure BDA0001752583520000112
是目标的姿态四元数,其中q0
Figure BDA0001752583520000113
分别是q的标量和矢量部分。q的导数和ω之间的关系如下:
Figure BDA0001752583520000114
这里,
Figure BDA0001752583520000115
是qt的导数。
特殊地,对于2维平面物体的空间翻滚目标,忽略外力/外力矩影响时,其转动方程为:
Figure BDA0001752583520000116
其中,Jt是平面物体的转动惯量,ωt是平面物体的转动角速度,Mt是平面物体受到的外力矩。相应地,对于平面物体,目标的姿态角θt可以表示为:
Figure BDA0001752583520000117
这里,θt(t0)是物体在初始时刻t0的姿态角。
根据方程(3)和(4),可以预测出2维空间翻滚失效目标在每一时刻t的构型 qobj(t),进而可以得到目标所有构型的集合{qobj(t)}。
步骤3,多指手机构包络构型计算。对于多指手抓捕机构,基于位置矢量方程(5),可以计算出在包络构型实现之前每根手指运动的所有可能路径的集合 Pi(i=1,2,…,n),其中n是手指的个数;进一步,考虑手指在实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束方程(7),同时每根手指的位置也受多指手指基座的限制以及每根手指驱动力矩的约束方程(8)和(9),进而从Pi(i=1,2,…,n)中筛选出符合上述约束的可行手指构型Ri(i=1,2,…,n)。最后,将每根手指的构型组合起来可以得到整个多指手机构的构型。
每个手指的最终运动是由服务航天器的姿轨运动和手指自身的张合运动组合而成的,设简化后的手指i位置矢量为pi,则有
Figure BDA0001752583520000121
其中,
Figure BDA0001752583520000122
是手指i与服务航天器连接点的位置矢量,pei是手指i对目标实施包络的位置相对于手指i与服务航天器连接点的坐标,由手指的张合角决定;rs是服务航天器质心位置矢量,其满足:
Figure BDA0001752583520000123
考虑手指在实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束,对于
Figure BDA0001752583520000124
t0和tf分别是包络过程开始和结束时刻,如下表达式都应成立:
Figure BDA0001752583520000125
其中,S指目标或单个手指在某一特定构型下所占据的空间区域。
至于每根手指的位置,则是由多指手指基座的限制以及每根手指自身驱动力矩的约束决定的,可以用散布函数来表示手指间的位置约束,本发明采用如下两种散布函数来表示手指间的约束:
每对手指间的最大距离δ
δ(P(t))≡max{||Pi(t)-Pj(t)|| |i,j∈{1,2,…,n}} (8)
相邻手指间的最大距离
Figure BDA0001752583520000126
Figure BDA0001752583520000127
其中,P={P1,P2,…,Pn}是手指构型,t∈[tc,tc+Δtc]。
步骤4,动态包络检测。
在tc+Δtc时,检测所有手指可行构型区域(R={R1,R2,…,Rn})内是否存在对目标成功包络的手指构型CF,即能够保证目标不会从多指手机构形成的抓捕空间区域逃走的构型,如图5(a)-(c)所示。如果
Figure BDA0001752583520000131
则在tc+Δtc时成功实现包络,反之则是不成功。
步骤5:在得到包络构型后,收紧手指,直至多指手机构的每个手指都与空间翻滚目标接触,这时就实现了对空间翻滚目标的抓捕。
本发明对空间翻滚目标的多指包络式容错抓捕的具体实施例如下。
以图4中平面物体为例,假设其运行在半径为rt=6800km、轨道倾角为0deg 的圆轨道平面上,t0=0s、t=10s,初始位置为[xt(t0),yt(t0)]T=[6800,0]Tkm,初始姿态角θt(t0)=0deg、初始旋转角速度ωt(t0)=4deg/s,目标惯性参数Jt=10kg·m2,采用图2所示的简化多指手抓捕机构对图4中物体进行包络,相应的空间翻滚目标在整个包络过程中的构型{qobj(t)}见图6,所得其中一个有效包络构型如图7中(a) 所示,进一步收紧手指,得到的抓捕构型如图7中(b)所示。
以上内容仅为说明本发明的技术思想,不能以此限定本发明的保护范围,凡是按照本发明提出的技术思想,在技术方案基础上所做的任何改动,均落入本发明权利要求书的保护范围之内。

Claims (7)

1.一种面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,包括以下步骤:
当携带多指手抓捕机构的服务航天器与空间翻滚失效目标实现轨道运动同步时,多指手抓捕机构进一步接近空间翻滚失效目标,在给定时间间隔内实现对目标的包络,将目标约束在由多指手抓捕机构形成的抓捕空间区域内,然后收紧手指实现对目标的抓捕;
具体包括以下步骤:
步骤1:服务航天器向空间翻滚目标接近,实现轨道运动同步,并调整姿态,使多指手抓捕机构对准空间翻滚失效目标;然后,服务航天器通过测量设备获取空间翻滚失效目标的测量信息,包括几何外形信息、惯性参数以及旋转角速度;
步骤2:根据空间翻滚失效目标的测量信息,预测在抓捕过程中空间翻滚失效目标的运动可达域;
步骤3:对于多指手抓捕机构,计算出在包络构型实现之前每根手指运动的所有可能路径的运动集合;进一步,考虑实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束,同时每根手指的位置也受多指手指基座的限制以及每根手指驱动力矩的约束,进而从运动集合中筛选出符合上述约束的可行手指构型;
步骤4:进行动态包络检测,在给定时刻,检测所有手指可行构型区域内是否存在对目标成功包络的有效手指构型,如果存在,则成功实现包络成功,反之则是包络不成功;
步骤5:在得到有效包络构型后,收紧手指,实现对目标的抓捕。
2.根据权利要求1所述的面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,所述的空间翻滚失效目标是指平面物体或能够简化成平面物体的目标。
3.根据权利要求1所述的面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,步骤1中的多指手抓捕机构中的每个手指简化为由中间刚性部分和外部柔性部分组成的点手指,柔性部分能够使得空间翻滚失效目标和多指手抓捕机构碰撞时不会对影响服务航天器正常工作。
4.根据权利要求1所述的面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,步骤2中目标的运动可达域是指整个包络过程中目标所有能够到达区域的集合,具体计算过程如下:
由步骤1中得到的目标惯性参数Ix、Iy和Iz以及Ixy、Ixz和Iyz,目标角速度ω和姿态四元数q,利用空间翻滚失效目标的一般性运动方程(1)和(2)预测出所有目标在每一时刻t的构型qobj(t),进而得到目标所有构型的集合{qobj(t)};
Figure FDA0002354238860000021
其中,ω=[ωxyz]T是目标的角速度;
Figure FDA0002354238860000022
是目标的角加速度;假设
Figure FDA0002354238860000023
是目标的姿态四元数,其中q0
Figure FDA0002354238860000024
分别是q的标量和矢量部分;q的导数和ω之间的关系如下:
Figure FDA0002354238860000025
这里,
Figure FDA0002354238860000026
是qt的导数;
对于2维平面物体的空间翻滚目标,忽略外力/外力矩影响时,其转动方程为:
Figure FDA0002354238860000031
其中,Jt是平面物体的转动惯量,ωt是平面物体的转动角速度,Mt是平面物体受到的外力矩;对于平面物体,目标的姿态角θt可以表示为:
Figure FDA0002354238860000032
这里,θt(t0)是物体在初始时刻t0的姿态角;
由方程(3)和(4),预测出2维空间翻滚失效目标在每一时刻t的构型qobj(t),进而得到目标所有构型的集合{qobj(t)}。
5.根据权利要求4所述的面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,步骤3中每根手指运动所有可能路径的集合是指在整个包络过程中,同时考虑服务航天器的轨道运动和姿态运动以及每根手指所有可能的运动时,得到的每根手指在太空中所有轨迹的集合,具体步骤如下:
对于多指手抓捕机构,基于位置矢量方程(5),计算出在包络构型实现之前每根手指运动的所有可能路径的集合Pi(i=1,2,…,n),其中n是手指的个数;进一步,考虑手指在实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束方程(7),同时每根手指的位置也受多指手指基座的限制以及每根手指驱动力矩的约束方程(8)和(9),进而从Pi(i=1,2,…,n)中筛选出符合上述约束的可行手指构型Ri(i=1,2,…,n);最后,将每根手指的构型组合起来得到整个多指手机构的构型;
每个手指的最终运动是由服务航天器的姿轨运动和手指自身的张合运动组合而成的,设简化后的手指i位置矢量为pi,则有
Figure FDA0002354238860000033
其中,
Figure FDA0002354238860000034
是手指i与服务航天器连接点的位置矢量,pei是手指i对目标实施包络的位置相对于手指i与服务航天器连接点的坐标,由手指的张合角决定;rs是服务航天器质心位置矢量,其满足:
Figure FDA0002354238860000041
考虑手指在实现包络前每根手指不能与目标发生碰撞以及每根手指间也不能发生碰撞的约束,对于
Figure FDA0002354238860000042
t0和tf分别是包络过程开始和结束时刻,如下表达式都应成立:
Figure FDA0002354238860000043
其中,S指目标或单个手指在某一特定构型下所占据的空间区域;
每根手指的位置,由多指手指基座的限制以及每根手指自身驱动力矩的约束决定的,用散布函数来表示手指间的位置约束,采用如下两种散布函数来表示手指间的约束:
每对手指间的最大距离δ
δ(P(t))≡max{||Pi(t)-Pj(t)|||i,j∈{1,2,…,n}} (8)
相邻手指间的最大距离
Figure FDA0002354238860000044
Figure FDA0002354238860000045
其中,P={P1,P2,…,Pn}是手指构型,t∈[tc,tc+Δtc]。
6.根据权利要求5所述的面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,步骤4中成功包络的手指构型是指多指手抓捕机构能够将空间翻滚目标约束在由多指机构形成的抓捕空间区域内,目标只能在这一区域内运动;具体为:
在tc+Δtc时,检测所有手指可行构型区域(R={R1,R2,…,Rn})内是否存在对目标成功包络的手指构型CF,即能够保证目标不会从多指机构形成的抓捕空间区域逃走的构型,如果
Figure FDA0002354238860000051
则在tc+Δtc时成功实现包络,反之则是不成功。
7.根据权利要求1所述的面向空间翻滚失效目标的多指包络式容错抓捕方法,其特征在于,步骤5中收紧手指是指只需要控制手指的张合角,将包络构型进一步收拢直至多指手抓捕机构的每个手指都与目标接触。
CN201810872895.6A 2018-08-02 2018-08-02 面向空间翻滚失效目标的多指包络式容错抓捕装置及方法 Active CN108974396B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201810872895.6A CN108974396B (zh) 2018-08-02 2018-08-02 面向空间翻滚失效目标的多指包络式容错抓捕装置及方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201810872895.6A CN108974396B (zh) 2018-08-02 2018-08-02 面向空间翻滚失效目标的多指包络式容错抓捕装置及方法

Publications (2)

Publication Number Publication Date
CN108974396A CN108974396A (zh) 2018-12-11
CN108974396B true CN108974396B (zh) 2020-04-21

Family

ID=64554481

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201810872895.6A Active CN108974396B (zh) 2018-08-02 2018-08-02 面向空间翻滚失效目标的多指包络式容错抓捕装置及方法

Country Status (1)

Country Link
CN (1) CN108974396B (zh)

Families Citing this family (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109649698B (zh) * 2018-12-17 2022-01-04 北京精密机电控制设备研究所 一种软体臂抓捕系统及空间非合作目标消旋方法
CN110304272B (zh) * 2019-06-25 2020-09-11 西北工业大学 基于桁架装配微纳卫星追踪器及其追踪方法
CN110371325B (zh) * 2019-07-02 2021-08-31 西北工业大学 一种基于超冗余机械臂的失效卫星自适应包络抓捕方法
CN110502028B (zh) * 2019-09-18 2020-10-13 中国人民解放军军事科学院国防科技创新研究院 一种空间翻滚目标位姿同步跟踪控制方法
CN111360828B (zh) * 2020-03-09 2021-12-03 西北工业大学 一种基于多指机构的三维空间翻滚目标包络抓捕方法
CN112009729B (zh) * 2020-08-04 2021-09-21 北京航空航天大学 一种空间机器人球形外包络抓捕方法
CN112389686B (zh) * 2020-11-24 2022-06-07 西北工业大学深圳研究院 一种基于空间多臂接触的被动目标同步消旋抓捕操作方法
CN112809675B (zh) * 2020-12-31 2022-04-01 西北工业大学深圳研究院 基于强化学习算法的超冗余机械臂自主抓捕空间碎片方法
CN114137880B (zh) * 2021-11-30 2024-02-02 深蓝汽车科技有限公司 运动部件姿态测试系统
CN114955020B (zh) * 2022-06-08 2023-06-09 南京理工大学 一种基于异构多柔性臂空间机器人的在轨目标安全捕获方法及系统

Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103863583A (zh) * 2014-02-27 2014-06-18 中国空间技术研究院 一种飞舌抓捕机构及空间目标捕获方法
CN106218921A (zh) * 2016-07-25 2016-12-14 西北工业大学 一种柔性可伸缩碰撞触发的抓捕机构及方法
CN106428632A (zh) * 2016-09-30 2017-02-22 西北工业大学 一种机械臂可弹出的空间碎片大包络抓捕系统
CN107685881A (zh) * 2017-09-14 2018-02-13 中国人民解放军国防科技大学 一种空间柔性捕获装置以及其捕获方法

Family Cites Families (2)

* Cited by examiner, † Cited by third party
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
RU2505461C1 (ru) * 2009-11-25 2014-01-27 Поулос Эйр Энд Спейс Стабилизация движения неустойчивых фрагментов космического мусора

Patent Citations (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103863583A (zh) * 2014-02-27 2014-06-18 中国空间技术研究院 一种飞舌抓捕机构及空间目标捕获方法
CN106218921A (zh) * 2016-07-25 2016-12-14 西北工业大学 一种柔性可伸缩碰撞触发的抓捕机构及方法
CN106428632A (zh) * 2016-09-30 2017-02-22 西北工业大学 一种机械臂可弹出的空间碎片大包络抓捕系统
CN107685881A (zh) * 2017-09-14 2018-02-13 中国人民解放军国防科技大学 一种空间柔性捕获装置以及其捕获方法

Also Published As

Publication number Publication date
CN108974396A (zh) 2018-12-11

Similar Documents

Publication Publication Date Title
CN108974396B (zh) 面向空间翻滚失效目标的多指包络式容错抓捕装置及方法
Zhao et al. Motion measurement using inertial sensors, ultrasonic sensors, and magnetometers with extended kalman filter for data fusion
CN106055901B (zh) 一种自由漂浮空间机器人捕获翻滚目标的时机确定方法
CN104252574B (zh) 一种基于空间系绳抓捕系统的非合作目标质量辨识方法
CN106625671A (zh) 一种空间机器人抓捕翻滚目标的最优轨迹规划方法
CN106814753B (zh) 一种目标位置矫正方法、装置及系统
CN108919649B (zh) 一种针对故障卫星外包络抓捕的抓捕最优路径设计方法
CN107609222B (zh) 一种空间机器人末端接触碰撞力计算方法
CN111552326B (zh) 空间碎片绳系拖曳离轨目标姿态章动抑制控制方法及系统
Kaplan et al. Engineering issues for all major modes of in situ space debris capture
CN107696033B (zh) 一种基于视觉测量的空间机械臂轨迹滚动规划方法
CN108594802A (zh) 探测器目标着陆区域确定及避障制导方法与装置
Xu et al. A pose measurement method of a non-cooperative GEO spacecraft based on stereo vision
CN106864776A (zh) 一种基于对接环的捕获目标卫星的方法与系统
CN110361001A (zh) 一种用于空间碎片运动测量系统及标定方法
CN111470070B (zh) 一种空间非合作目标无接触消旋辨识装置及方法
KR102172362B1 (ko) 인체 무게 중심의 이동을 이용한 모션 캡쳐 장치 및 그 방법
CN114476132B (zh) 一种空间翻滚目标电磁涡流消旋过程的制导策略
Nishida et al. Dynamical simulations for space debris capture
JP2000025700A (ja) 単点観測による宇宙デブリ検出装置および検出方法
CN111640153B (zh) 基于视觉与惯性单元融合的空间刚体质心位置检测方法
CN110188494B (zh) 一种针对柔性捕获中期望包络点的确定方法
Velasquez et al. Experimental evaluation of a machine vision based pose estimation system for autonomous capture of satellites with interface rings
RU2247684C2 (ru) Способ трехосной ориентации космического аппарата в орбитальной системе координат
Aghili et al. Robotic docking of a free-falling space object with occluded visual condition

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant