CN112966386A - 一种柔性绳网系统捕获小行星的控制运动参数计算方法 - Google Patents

一种柔性绳网系统捕获小行星的控制运动参数计算方法 Download PDF

Info

Publication number
CN112966386A
CN112966386A CN202110270177.3A CN202110270177A CN112966386A CN 112966386 A CN112966386 A CN 112966386A CN 202110270177 A CN202110270177 A CN 202110270177A CN 112966386 A CN112966386 A CN 112966386A
Authority
CN
China
Prior art keywords
flexible rope
rope net
asteroid
model
flexible
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.)
Granted
Application number
CN202110270177.3A
Other languages
English (en)
Other versions
CN112966386B (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.)
Tsinghua University
Original Assignee
Tsinghua 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 Tsinghua University filed Critical Tsinghua University
Priority to CN202110270177.3A priority Critical patent/CN112966386B/zh
Publication of CN112966386A publication Critical patent/CN112966386A/zh
Application granted granted Critical
Publication of CN112966386B publication Critical patent/CN112966386B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F30/00Computer-aided design [CAD]
    • G06F30/20Design optimisation, verification or simulation
    • GPHYSICS
    • G06COMPUTING; CALCULATING OR COUNTING
    • G06FELECTRIC DIGITAL DATA PROCESSING
    • G06F2119/00Details relating to the type or aim of the analysis or the optimisation
    • G06F2119/14Force analysis or force optimisation, e.g. static or dynamic forces

Landscapes

  • Engineering & Computer Science (AREA)
  • Physics & Mathematics (AREA)
  • Theoretical Computer Science (AREA)
  • Computer Hardware Design (AREA)
  • Evolutionary Computation (AREA)
  • Geometry (AREA)
  • General Engineering & Computer Science (AREA)
  • General Physics & Mathematics (AREA)
  • Management, Administration, Business Operations System, And Electronic Commerce (AREA)

Abstract

本发明提出一种柔性绳网系统捕获小行星的控制运动参数计算方法,属于小行星探测领域。该方法在小行星本体坐标系下,依次建立柔性绳网的力学模型、小行星引力场模型和小行星表面模型;通过小行星表面模型与柔性绳网的力学模型构建柔性绳网系统碰撞动力学模型;设计柔性绳网每个控制器在坐标系三个方向上的控制输入,进而建立柔性绳网系统动力学模型并求解,最终得到柔性绳网系统捕获小行星的控制运动参数。本发明通过引入球谐参数曲面数学模型以及滑模控制方法,求解柔性绳网位移矢量与速度矢量随时间的变化,可实现对柔性绳网系统在小行星引力场中的展开、接近及捕获过程进行仿真,利用本发明可以解决柔性绳网系统对小行星进行捕获的难题。

Description

一种柔性绳网系统捕获小行星的控制运动参数计算方法
技术领域
本发明属于小行星探测领域,具体涉及一种柔性绳网系统捕获小行星的控制运动参数计算方法。
背景技术
即使是一颗直径为百米左右的小行星,也蕴含着丰富的矿物资源,比如黄金、稀土、铂等及其他金属氧化物。如果能将小行星捕获至地球,将会有取之不尽的资源供人类利用。迄今为止,对于小行星的捕获机构、捕获方案却很少有人研究。近年来,柔性绳网系统在太空探索中的巨大潜力逐步引起人们的重视。柔性绳网系统由柔性绳网与连接在柔性绳网角点的控制器组成,柔性绳网系统中柔性绳网的构型及控制器的数量可根据任务背景进行设定。现阶段对柔性绳网系统的研究主要关注其在空间碎片捕获任务中的应用,采用柔性绳网系统作为捕获机构,对小行星进行捕获的仿真研究尚属于空白。考虑到柔性绳网系统具备较大的灵活性及较强的机动性,故采用其对具有复杂形状的小行星进行捕获,在未来空间探测任务中具有极为广阔的应用前景。采用数值仿真的手段对此捕获过程进行前期模拟,即仿真计算得到柔性绳网系统在小行星引力场中的运动轨迹、运动速度,从而有效规避实际任务中柔性绳网系统初始展开位置、初始发射速度设置不当,也可为实际捕获任务中柔性绳网系统的构型设计、材料的选取进行有效指导。
发明内容
本发明的目的是为了填补已有技术空白,提出一种柔性绳网系统捕获小行星的控制运动参数计算方法。本发明可求解其位移矢量与速度矢量随时间的变化,进而对柔性绳网系统在小行星引力场中的展开、接近及捕获过程进行仿真,利用本发明可以解决柔性绳网系统对小行星进行捕获的难题。
本发明提出一种柔性绳网系统捕获小行星的控制运动参数计算方法,其特征在于,该方法在小行星本体坐标系下,依次建立柔性绳网的力学模型、小行星引力场模型和小行星表面模型;通过小行星表面模型与柔性绳网的力学模型构建柔性绳网系统碰撞动力学模型;设计柔性绳网每个控制器在坐标系三个方向上的控制输入,进而建立柔性绳网系统动力学模型并求解,最终得到柔性绳网系统捕获小行星的控制运动参数。该方法包括以下步骤:
1)建立小行星本体坐标系;
2)建立柔性绳网的力学模型,计算柔性绳网中每个绳段单元的内力;具体步骤如下:
2-1)将柔性绳网中的每根绳均分为初始长度相等的绳段单元,然后使用弹簧阻尼元件近似替代每个绳段单元,绳段单元质量由在绳段单元两端的节点的质量替代;
2-2)获取柔性绳网的弹性模量E,阻尼比ζ,泊松比υ,截面积A,密度ρs,确定第i个绳段单元中弹簧元件的刚度系数ki,第i个绳段单元中阻尼元件的阻尼系数ci,进而确定第i个绳段单元的力学模型,表达式如下:
Figure BDA0002974005570000021
Figure BDA0002974005570000022
其中,li为第i个绳段单元的当前长度;
2-3)根据式(1)与式(2),确定柔性绳网中第i个绳段单元的内力
Figure BDA0002974005570000023
计算表达式如下:
Figure BDA0002974005570000024
Figure BDA0002974005570000025
Figure BDA0002974005570000026
其中Ti为第i个绳段单元内部的拉力,Di为第i个绳段单元内部的阻尼力,||Δri||为第i个绳段单元的当前变形量,
Figure BDA0002974005570000027
为第i个绳段单元的当前变形速度,
Figure BDA0002974005570000028
为第i个绳段单元的初始长度;
3)建立小行星引力场模型,计算位于小行星引力场中每个柔性绳网节点受到的引力大小;
其中,小行星引力场中每个柔性绳网节点i受到的引力大小
Figure BDA0002974005570000029
表达式如下:
Figure BDA0002974005570000031
其中ri为柔性绳网节点i当前的位移矢量,mi为柔性绳网节点i的质量,G为小行星引力常数,ρ为小行星密度,f表示小行星的多面体模型中任意多面体单元的任意侧面,e表示小行星的多面体模型中任意相邻两侧面f1与f2的公共棱边,ES表示小行星的多面体模型中所有棱边的集合,FS表示小行星的多面体模型中所有侧面的集合,nf表示侧面f的单位外法向量,
Figure BDA0002974005570000032
Figure BDA0002974005570000033
分别表示侧面f1与f2的单位外法向量,
Figure BDA0002974005570000034
表示侧面f内的棱边e的单位法向量,Le表示棱边e对应的线积分项,
Figure BDA0002974005570000035
ds表示棱边e的弧长积分元,θf表示侧面f对应的面积分项,
Figure BDA0002974005570000036
dS表示侧面f的面积分元;
4)建立小行星表面模型,表达式如下:
Figure BDA0002974005570000037
其中,
Figure BDA0002974005570000038
为小行星本体坐标系中小行星任一表面点的球坐标,
Figure BDA0002974005570000039
为原点到该表面点处的径向距离,
Figure BDA00029740055700000310
为球谐复系数;l为非负整数,是式(7)的中间参数;m为式(7)的中间参数;
Figure BDA00029740055700000311
为球谐基函数:
Figure BDA00029740055700000312
其中h表示复数;
Figure BDA00029740055700000313
表示l阶勒让德多项式:
Figure BDA00029740055700000314
根据式(9)得到球坐标为
Figure BDA00029740055700000315
的小行星表面点的法向量
Figure BDA00029740055700000316
表达式如下:
Figure BDA0002974005570000041
其中
Figure BDA0002974005570000042
为球坐标为
Figure BDA0002974005570000043
的单位矢量;
由式(7)得到:
Figure BDA0002974005570000044
Figure BDA0002974005570000045
其中
Figure BDA0002974005570000046
表示l阶勒让德多项式的一阶差商:
Figure BDA0002974005570000047
5)建立柔性绳网系统碰撞动力学模型;具体步骤如下:
5-1)碰撞检测;
采用式(7)的小行星表面模型与步骤2)中柔性绳网的力学模型得到柔性绳网与小行星表面发生碰撞的条件,表达式如下:
Figure BDA0002974005570000048
其中
Figure BDA0002974005570000049
为柔性绳网节点i的球坐标,di为柔性绳网节点i与球坐标同样为
Figure BDA00029740055700000410
的小行星表面点的相对距离大小,
Figure BDA00029740055700000411
表示球坐标为
Figure BDA00029740055700000412
的小行星表面点的径向距离;
当di≥0时,柔性绳网节点i与小行星发生碰撞,转入步骤5-2),此时di为柔性绳网节点i在小行星表面的嵌入量;当di<0时,柔性绳网节点i与小行星未发生碰撞,转入步骤6);
5-2)建立柔性绳网法向碰撞模型,计算柔性绳网节点受到的法向碰撞力;具体步骤如下:
5-2-1)获取小行星表面物质的弹性模量Ea和泊松比υa,计算柔性绳网节点i在与小行星碰撞处的弹簧元件的刚度系数Si以及柔性绳网节点i在与小行星碰撞处的阻尼元件的阻尼系数Pi,表达式分别如下:
Figure BDA0002974005570000051
Figure BDA0002974005570000052
其中,
Figure BDA0002974005570000053
为柔性绳网节点i对应的在碰撞位置的等效曲率半径,
Figure BDA0002974005570000054
εi为柔性绳网节点i在碰撞点处的曲率半径,δi为与柔性绳网节点i对应的小行星表面碰撞点处的曲率半径;E*为等效弹性模量,
Figure BDA0002974005570000055
eres为恢复系数,
Figure BDA0002974005570000056
为柔性绳网节点i刚接触小行星表面的速度大小;
5-2-2)计算柔性绳网节点i受到的法向碰撞力Ni,表达式如下:
Figure BDA0002974005570000057
其中,
Figure BDA0002974005570000058
表示球坐标同样为
Figure BDA0002974005570000059
的小行星表面点的法向量;
5-3)建立柔性绳网切向碰撞模型,计算柔性绳网节点受到的摩擦力,表达式如下:
Figure BDA00029740055700000510
其中,fi为柔性绳网节点i受到的摩擦力,μ为摩擦系数;
Figure BDA00029740055700000516
为柔性绳网节点i当前的速度矢量;然后进入步骤6);
6)设计柔性绳网系统的控制力;具体步骤如下:
6-1)对柔性绳网系统中每个控制器k,设计该控制器x方向上的滑模面
Figure BDA00029740055700000511
y方向上的滑模面
Figure BDA00029740055700000512
和z方向上的滑模面
Figure BDA00029740055700000513
表达式如下:
Figure BDA00029740055700000514
其中,c为常数;k代表控制器序号;t为时间,
Figure BDA00029740055700000515
为控制器k在x方向上的实际位移xk(t)与期望位移
Figure BDA0002974005570000061
之差,
Figure BDA0002974005570000062
Figure BDA0002974005570000063
的一阶导数;
Figure BDA0002974005570000064
为控制器在y方向上的实际位移yk(t)与期望位移
Figure BDA0002974005570000065
之差,
Figure BDA0002974005570000066
Figure BDA0002974005570000067
的一阶导数;
Figure BDA0002974005570000068
为控制器在z方向上的实际位移zk(t)与期望位移
Figure BDA0002974005570000069
之差,
Figure BDA00029740055700000610
Figure BDA00029740055700000611
的一阶导数;
6-2)设计控制器k在x方向的控制输入
Figure BDA00029740055700000612
在y方向的控制输入
Figure BDA00029740055700000613
在z方向的控制输入
Figure BDA00029740055700000614
表达式如下:
Figure BDA00029740055700000615
其中
Figure BDA00029740055700000616
为控制器k受到的外部作用力,
Figure BDA00029740055700000617
为控制器k受到来自柔性绳网的内力,(·)x表示矢量在x方向上的投影,(·)y表示矢量在y方向上的投影,(·)z表示矢量在y方向上的投影;
7)建立柔性绳网系统动力学模型并求解,得到柔性绳网系统捕获小行星的控制运动参数;具体步骤如下:
7-1)建立柔性绳网的每个节点在小行星引力场中的动力学模型,表达式如下:
Figure BDA00029740055700000618
其中,mi为柔性绳网节点i的质量,
Figure BDA00029740055700000619
为柔性绳网节点i受到的外部作用力,
Figure BDA00029740055700000620
为柔性绳网中第i个绳段单元的内力;Np表示柔性绳网中节点总数,ω为小行星绕自身惯性主轴旋转的角速度;δi为节点i的指示碰撞函数,当δi=1时,柔性绳网节点i与小行星发生碰撞,当δi=0时,二者未发生碰撞;
7-2)建立柔性绳网系统中每个控制器的动力学模型,表达式如下:
Figure BDA0002974005570000071
其中,mk为柔性绳网系统控制器k的质量;
7-3)对式(21)求解,得到每个时刻柔性绳网系统的每个柔性绳网节点在小行星引力场中的位移矢量ri,i=1,2,3...,Np,和速度矢量
Figure BDA0002974005570000072
对式(22)求解,得到每个时刻柔性绳网系统中每个控制器在小行星引力场中的位移矢量rk,k=1,2,3...,8,和速度矢量
Figure BDA0002974005570000073
柔性绳网系统捕获小行星的控制运动参数计算完毕。
本发明的特点及有益效果是:
本发明通过引入球谐参数曲面数学模型以及滑模控制方法,从而快速建立了柔性绳网系统在小行星引力场中的动力学模型。通过求解上述动力学模型即可得到柔性绳网系统在小行星引力场中的位移矢量与速度矢量随时间的变化,进而实现柔性绳网系统在小行星引力场中的展开、接近及捕获过程运动仿真,同时也为小行星捕捉提供了一种新技术。本发明未来可用于小行星表面大范围巡视探测、小行星采矿及小行星表面资源开发等场景。
附图说明
图1为本发明方法的整体流程图。
图2为本发明实施例中坐标系示意图。
图3为本发明实施例中柔性绳网的力学模型示意图。
图4为本发明实施例中四面体单元模型示意图。
图5为本发明实施例中采用的柔性绳网系统示意图。
具体实施方式
本发明提出一种柔性绳网系统捕获小行星的控制运动参数计算方法,下面结合附图和具体实施例对本发明进一步详细说明如下。
本发明提出一种柔性绳网系统捕获小行星的控制运动参数计算方法,整体流程如图1所示,包括以下步骤:
1)建立坐标系。本发明实施例中采用的坐标系为小行星本体坐标系,后续说明均基于此坐标系。图2为本发明实施例中坐标系示意图。如图2所示,小行星本体坐标系以小行星质心O为坐标的原点,其中x轴为小行星最小转动惯量主轴,y轴为小行星中间转动惯量主轴,z轴为小行星最大转动惯量主轴,三者形成右手系。θ表示x-y平面内原点O与小行星表面任一点a在x-y平面内对应投影点b的连线和x轴的夹角,
Figure BDA0002974005570000085
表示原点O与表面点a的连线和z轴的夹角,R为原点O到表面点a的径向距离。
2)建立柔性绳网的力学模型,计算柔性绳网中每个绳段单元的内力;
柔性绳网孔目形状可为方形、菱形、矩形等,柔性绳网尺寸可依据不同的任务背景进行设计。本发明实施例中采用集中质量弹簧阻尼法建立柔性绳网的仿真力学模型。具体步骤如下:
2-1)将柔性绳网中的每根绳均分为初始长度相等的若干绳段单元(在本发明实施例中均分后每个绳段单元初始长度均为50米),然后使用弹簧阻尼元件近似替代每个绳段单元,绳段单元质量由在绳段单元两端的节点的质量替代(绳段单元质量平均分配给该绳段单元两端的节点)。图3为本发明实施例中柔性绳网的力学模型示意图。如图3所示为第i个绳段单元的力学模型,包括质量为mi的节点i、质量为mi+1的节点i+1、第i个绳段单元中刚度系数为ki的弹簧元件以及第i个绳段单元中阻尼系数为ci的阻尼元件。通过柔性绳网的力学模型,即可给出柔性绳网的内力计算表达式。
2-2)通过查阅资料或实验等方式获取柔性绳网的弹性模量E,阻尼比ζ,泊松比υ,截面积A,密度ρs参数,从而确定第i个绳段单元中弹簧元件的刚度系数ki,第i个绳段单元中阻尼元件的阻尼系数ci,进而确定第i个绳段单元的力学模型,表达式如下:
Figure BDA0002974005570000081
Figure BDA0002974005570000082
其中,li(单位:米)为第i个绳段单元的当前长度。
2-3)根据式(1)与式(2),即可确定柔性绳网中第i个绳段单元的内力
Figure BDA0002974005570000083
计算表达式如下:
Figure BDA0002974005570000084
Figure BDA00029740055700000912
Figure BDA0002974005570000091
其中Ti为第i个绳段单元内部的拉力,Di为第i个绳段单元内部的阻尼力,||Δri||为第i个绳段单元的当前变形量,
Figure BDA0002974005570000092
为第i个绳段单元的当前变形速度,
Figure BDA0002974005570000093
为第i个绳段单元的初始长度(本实施例为50米)。
3)建立小行星引力场模型,计算位于小行星引力场中每个柔性绳网节点受到的引力大小。
本发明实施例中采用多面体法建立小行星引力场模型。首先通过查阅资料获取小行星的多面体模型数据,本发明实施例中采用小行星Didymos的多面体模型,该多面体模型总共包含8162个四面体顶点,16320个侧面以及22480条棱。之后即可计算位于小行星引力场中每个柔性绳网节点i受到的引力大小
Figure BDA0002974005570000094
表达式如下:
Figure BDA0002974005570000095
其中ri为柔性绳网节点i当前的位移矢量,mi为柔性绳网节点i的质量,G为小行星引力常数,ρ为小行星密度,f表示小行星的多面体模型中任意多面体单元的任意侧面,e表示小行星的多面体模型中任意相邻两侧面f1与f2的公共棱边,ES表示小行星的多面体模型中所有棱边的集合,FS表示小行星的多面体模型中所有侧面的集合。以图4所示任意多面体单元为例(图4中为一个四面体),
Figure BDA0002974005570000096
表示从ri处到侧面f内棱边e上任意点的矢量,rf表示从ri处到侧面f上任意点的矢量,nf表示侧面f的单位外法向量,
Figure BDA0002974005570000097
Figure BDA0002974005570000098
分别表示侧面f1与f2的单位外法向量,
Figure BDA0002974005570000099
表示侧面f内的棱边e的单位法向量,Le表示棱边e对应的线积分项,
Figure BDA00029740055700000910
ds表示棱边e的弧长积分元,θf表示侧面f对应的面积分项,
Figure BDA00029740055700000911
dS表示侧面f的面积分元。
4)建立小行星表面模型。本发明实施例中采用球谐参数曲面建立小行星的表面模型,在步骤1)所建坐标系中,对小行星表面模型的拟合表达式如下:
Figure BDA0002974005570000101
其中,
Figure BDA0002974005570000102
为步骤1)所建坐标系中小行星任一表面点的球坐标,
Figure BDA0002974005570000103
为原点到该表面点处的径向距离,
Figure BDA0002974005570000104
为球谐复系数,在本发明实施例中由步骤3)的小行星的多面体模型中顶点坐标数据经最小二乘法拟合得到,l取值为非负整数,是式(7)的中间参数,m为式(7)的中间参数,
Figure BDA0002974005570000105
为球谐基函数:
Figure BDA0002974005570000106
其中h表示复数;
Figure BDA0002974005570000107
表示l阶勒让德多项式:
Figure BDA0002974005570000108
根据式(9)即可得到球坐标为
Figure BDA0002974005570000109
的小行星表面点的法向量
Figure BDA00029740055700001010
表达式如下:
Figure BDA00029740055700001011
其中
Figure BDA00029740055700001012
为球坐标为
Figure BDA00029740055700001013
的单位矢量,另外由式(7)可得:
Figure BDA00029740055700001014
Figure BDA00029740055700001015
其中
Figure BDA00029740055700001016
表示l阶勒让德多项式的一阶差商:
Figure BDA00029740055700001017
5)建立柔性绳网系统碰撞动力学模型。具体步骤如下:
5-1)碰撞检测。本发明实施例中采用式(7)小行星表面模型与步骤2)中柔性绳网的力学模型可以给出柔性绳网与小行星表面发生碰撞的条件,表达式如下:
Figure BDA0002974005570000111
其中
Figure BDA0002974005570000112
为柔性绳网节点i的球坐标,di为柔性绳网节点i与球坐标同样为
Figure BDA0002974005570000113
的小行星表面点的相对距离大小,
Figure BDA0002974005570000114
表示球坐标为
Figure BDA0002974005570000115
的小行星表面点的径向距离,ri表示柔性绳网节点i当前的位移矢量。当di≥0时,柔性绳网节点i与小行星发生碰撞,转入步骤5-2),此时di为柔性绳网节点i在小行星表面的嵌入量;当di<0时,二者未发生碰撞,转入步骤6)。
5-2)建立柔性绳网法向碰撞模型,计算柔性绳网节点受到的法向碰撞力。本发明实施例中采用非线性弹簧阻尼法建立柔性绳网在小行星表面的法向碰撞模型,计算法向碰撞力的大小;具体步骤如下:
5-2-1)通过查阅资料获取小行星表面物质的弹性模量Ea和泊松比υa,并结合步骤2)中给出的柔性绳网的弹性模量E、泊松比υ、截面积A、密度ρs参数,从而根据Hertz接触理论给出柔性绳网节点i在与小行星碰撞处的弹簧元件的刚度系数Si,根据Hunt-Crossley阻尼理论给出柔性绳网节点i在与小行星碰撞处的阻尼元件的阻尼系数Pi,表达式如下:
Figure BDA0002974005570000116
Figure BDA0002974005570000117
其中,
Figure BDA0002974005570000118
为柔性绳网节点i对应的在碰撞位置的等效曲率半径,
Figure BDA0002974005570000119
εi为柔性绳网节点i在碰撞点处的曲率半径,本发明实施例中所有柔性绳网节点曲率半径均设为4米,δi为与柔性绳网节点i对应的小行星表面碰撞点处的曲率半径。E*为等效弹性模量,
Figure BDA00029740055700001110
其中E为柔性绳网的弹性模量,Ea为小行星表面物质的弹性模量,υa为小行星表面物质的泊松比,υ为柔性绳网的泊松比。eres为恢复系数,在本发明实施例中取0.5。
Figure BDA00029740055700001111
为柔性绳网节点i刚接触小行星表面的速度大小。
5-2-2)计算柔性绳网节点i受到的法向碰撞力Ni,表达式如下:
Figure BDA0002974005570000121
其中,di为步骤5-1)计算得到的柔性绳网节点i在小行星表面的嵌入量;
Figure BDA0002974005570000122
为柔性绳网中节点i的球坐标,
Figure BDA0002974005570000123
表示球坐标同样为
Figure BDA0002974005570000124
的小行星表面点的法向量。
5-3)建立柔性绳网切向碰撞模型,计算柔性绳网节点受到的摩擦力,表达式如下:
Figure BDA0002974005570000125
其中,fi为柔性绳网节点i受到的摩擦力,μ为摩擦系数;当柔性绳网节点处于动摩擦状态时μ=0.5;当柔性绳网节点处于静摩擦状态时,μ=0.6;Ni为柔性绳网节点i受到的法向碰撞力,
Figure BDA0002974005570000126
为柔性绳网节点i当前的速度矢量。之后进入步骤6)。
6)设计柔性绳网系统控制力。
本发明实施例中采用图5所示的柔性绳网系统,包括8个控制器以及1个柔性绳网,柔性绳网构型以及控制器数量可以根据不同的任务需求自行设计。本发明实施例中采用滑模控制方法设计柔性绳网系统中各控制器的控制力,将每个控制器三个方向的位移分别作为该控制器的控制变量,控制器产生的推力作为控制输入。通过恰当设计控制输入,可使控制变量稳定至期望值。具体步骤如下:
6-1)以控制器k为例,设计其x方向上的滑模面
Figure BDA0002974005570000127
y方向上的滑模面
Figure BDA0002974005570000128
和z方向上的滑模面
Figure BDA0002974005570000129
表达式如下:
Figure BDA00029740055700001210
本发明实施例中c为常数,取为10;控制器序号k=1,2,...8.,t为时间,
Figure BDA00029740055700001211
为控制器k在x方向上的实际位移xk(t)与期望位移
Figure BDA00029740055700001212
之差,
Figure BDA00029740055700001213
其中
Figure BDA00029740055700001214
需人为设计给定,
Figure BDA00029740055700001215
Figure BDA00029740055700001216
的一阶导数;
Figure BDA00029740055700001217
为控制器在y方向上的实际位移yk(t)与期望位移
Figure BDA00029740055700001218
之差,
Figure BDA00029740055700001219
其中
Figure BDA00029740055700001220
需人为设计给定,
Figure BDA00029740055700001221
Figure BDA00029740055700001222
的一阶导数;
Figure BDA00029740055700001223
为控制器在z方向上的实际位移zk(t)与期望位移
Figure BDA00029740055700001224
之差,
Figure BDA00029740055700001225
其中
Figure BDA00029740055700001226
需人为设计给定,
Figure BDA00029740055700001227
Figure BDA00029740055700001228
的一阶导数。
6-2)设计控制器k在x方向的控制输入
Figure BDA0002974005570000131
在y方向的控制输入
Figure BDA0002974005570000132
在z方向的控制输入
Figure BDA0002974005570000133
在本发明实施例中,根据快速幂次趋近律知识,控制输入可设计为如下表达式:
Figure BDA0002974005570000134
其中
Figure BDA0002974005570000135
为控制器k受到的外部作用力,采用公式(21)即可求得控制器k受到的外部作用力,
Figure BDA0002974005570000136
为控制器k受到来自柔性绳网的内力,采用公式(3)可求得与控制器k相连的绳网的内力,(·)x表示矢量在x方向上的投影,(·)y表示矢量在y方向上的投影,(·)z表示矢量在y方向上的投影。
7)建立柔性绳网系统动力学模型并求解,得到柔性绳网系统捕获小行星的控制运动参数;具体步骤如下:
7-1)建立柔性绳网的每个节点在小行星引力场中的动力学模型,表达式如下:
Figure BDA0002974005570000137
其中,mi为柔性绳网节点i的质量,
Figure BDA0002974005570000138
为柔性绳网节点i受到的外部作用力,
Figure BDA0002974005570000139
为柔性绳网中第i个绳段单元的内力;Np表示柔性绳网中节点总数,ω为小行星绕自身惯性主轴旋转的角速度,Ni为柔性绳网节点i受到的法向碰撞力;fi为柔性绳网节点i受到的摩擦力;δi为节点i的指示碰撞函数,当δi=1时,柔性绳网节点i与小行星发生碰撞,当δi=0时,二者未发生碰撞;
7-2)建立柔性绳网系统中每个控制器的动力学模型,表达式如下:
Figure BDA00029740055700001310
其中,mk为柔性绳网系统控制器k的质量。
7-3)在本发明实施例中,采用四阶龙格库塔法对式(21)求解,即可计算得到每个时刻柔性绳网系统的每个柔性绳网节点在小行星引力场中的位移矢量ri,i=1,2,3...,Np,和速度矢量
Figure BDA0002974005570000141
采用四阶龙格库塔法对式(22)求解,即可计算得到每个时刻柔性绳网系统中每个控制器在小行星引力场中的位移矢量rk,k=1,2,3...,8,和速度矢量
Figure BDA0002974005570000142
之后即可对柔性绳网系统捕获小行星的过程进行仿真。
进一步地,柔性绳网展开、接近及捕获过程仿真;具体步骤如下:
在本发明实施例中,柔性绳网系统在小行星北极正上方100米处展开,采用平面内弹射控制器的方式展开,每个控制器的弹射速度为1m/s,当柔性绳网首次展开到最大面积时,采用式(22)的模型加入控制作用,维持最大展开面积直至稳定。通过推力使每个控制器获得方向沿小行星南极正下方,大小为0.1m/s的初速度,柔性绳网系统开始接近小行星,并与之发生碰撞。当柔性绳网系统中探测器运动至小行星南极下方,采用式(22)的模型加入控制作用,使探测器稳定至小行星南极点上方5米位置,直至系统稳定,小行星捕获过程结束。

Claims (2)

1.一种柔性绳网系统捕获小行星的控制运动参数计算方法,其特征在于,该方法在小行星本体坐标系下,依次建立柔性绳网的力学模型、小行星引力场模型和小行星表面模型;通过小行星表面模型与柔性绳网的力学模型构建柔性绳网系统碰撞动力学模型;设计柔性绳网每个控制器在坐标系三个方向上的控制输入,进而建立柔性绳网系统动力学模型并求解,最终得到柔性绳网系统捕获小行星的控制运动参数。
2.如权利要求1所述的方法,其特征在于,该方法包括以下步骤:
1)建立小行星本体坐标系;
2)建立柔性绳网的力学模型,计算柔性绳网中每个绳段单元的内力;具体步骤如下:
2-1)将柔性绳网中的每根绳均分为初始长度相等的绳段单元,然后使用弹簧阻尼元件近似替代每个绳段单元,绳段单元质量由在绳段单元两端的节点的质量替代;
2-2)获取柔性绳网的弹性模量E,阻尼比ζ,泊松比υ,截面积A,密度ρs,确定第i个绳段单元中弹簧元件的刚度系数ki,第i个绳段单元中阻尼元件的阻尼系数ci,进而确定第i个绳段单元的力学模型,表达式如下:
Figure FDA0002974005560000011
Figure FDA0002974005560000012
其中,li为第i个绳段单元的当前长度;
2-3)根据式(1)与式(2),确定柔性绳网中第i个绳段单元的内力
Figure FDA0002974005560000013
计算表达式如下:
Figure FDA0002974005560000014
Figure FDA0002974005560000015
Figure FDA0002974005560000016
其中Ti为第i个绳段单元内部的拉力,Di为第i个绳段单元内部的阻尼力,||Δri||为第i个绳段单元的当前变形量,
Figure FDA0002974005560000021
为第i个绳段单元的当前变形速度,
Figure FDA0002974005560000022
为第i个绳段单元的初始长度;
3)建立小行星引力场模型,计算位于小行星引力场中每个柔性绳网节点受到的引力大小;
其中,小行星引力场中每个柔性绳网节点i受到的引力大小
Figure FDA0002974005560000023
表达式如下:
Figure FDA0002974005560000024
其中ri为柔性绳网节点i当前的位移矢量,mi为柔性绳网节点i的质量,G为小行星引力常数,ρ为小行星密度,f表示小行星的多面体模型中任意多面体单元的任意侧面,e表示小行星的多面体模型中任意相邻两侧面f1与f2的公共棱边,ES表示小行星的多面体模型中所有棱边的集合,FS表示小行星的多面体模型中所有侧面的集合,nf表示侧面f的单位外法向量,
Figure FDA0002974005560000025
Figure FDA0002974005560000026
分别表示侧面f1与f2的单位外法向量,
Figure FDA0002974005560000027
表示侧面f内的棱边e的单位法向量,Le表示棱边e对应的线积分项,
Figure FDA0002974005560000028
ds表示棱边e的弧长积分元,θf表示侧面f对应的面积分项,
Figure FDA0002974005560000029
dS表示侧面f的面积分元;
4)建立小行星表面模型,表达式如下:
Figure FDA00029740055600000210
其中,
Figure FDA00029740055600000211
为小行星本体坐标系中小行星任一表面点的球坐标,
Figure FDA00029740055600000212
为原点到该表面点处的径向距离,
Figure FDA00029740055600000213
为球谐复系数;l为非负整数,是式(7)的中间参数;m为式(7)的中间参数;
Figure FDA00029740055600000214
为球谐基函数:
Figure FDA00029740055600000215
其中h表示复数;
Figure FDA00029740055600000216
表示l阶勒让德多项式:
Figure FDA0002974005560000031
根据式(9)得到球坐标为
Figure FDA0002974005560000032
的小行星表面点的法向量
Figure FDA0002974005560000033
表达式如下:
Figure FDA0002974005560000034
其中
Figure FDA0002974005560000035
为球坐标为
Figure FDA0002974005560000036
的单位矢量;
由式(7)得到:
Figure FDA0002974005560000037
Figure FDA0002974005560000038
其中Pl m(·)′表示l阶勒让德多项式的一阶差商:
Figure FDA0002974005560000039
5)建立柔性绳网系统碰撞动力学模型;具体步骤如下:
5-1)碰撞检测;
采用式(7)的小行星表面模型与步骤2)中柔性绳网的力学模型得到柔性绳网与小行星表面发生碰撞的条件,表达式如下:
Figure FDA00029740055600000310
其中
Figure FDA00029740055600000311
为柔性绳网节点i的球坐标,di为柔性绳网节点i与球坐标同样为
Figure FDA00029740055600000312
的小行星表面点的相对距离大小,
Figure FDA00029740055600000313
表示球坐标为
Figure FDA00029740055600000314
的小行星表面点的径向距离;
当di≥0时,柔性绳网节点i与小行星发生碰撞,转入步骤5-2),此时di为柔性绳网节点i在小行星表面的嵌入量;当di<0时,柔性绳网节点i与小行星未发生碰撞,转入步骤6);
5-2)建立柔性绳网法向碰撞模型,计算柔性绳网节点受到的法向碰撞力;具体步骤如下:
5-2-1)获取小行星表面物质的弹性模量Ea和泊松比υa,计算柔性绳网节点i在与小行星碰撞处的弹簧元件的刚度系数Si以及柔性绳网节点i在与小行星碰撞处的阻尼元件的阻尼系数Pi,表达式分别如下:
Figure FDA0002974005560000041
Figure FDA0002974005560000042
其中,
Figure FDA0002974005560000043
为柔性绳网节点i对应的在碰撞位置的等效曲率半径,
Figure FDA0002974005560000044
εi为柔性绳网节点i在碰撞点处的曲率半径,δi为与柔性绳网节点i对应的小行星表面碰撞点处的曲率半径;E*为等效弹性模量,
Figure FDA0002974005560000045
eres为恢复系数,
Figure FDA0002974005560000046
为柔性绳网节点i刚接触小行星表面的速度大小;
5-2-2)计算柔性绳网节点i受到的法向碰撞力Ni,表达式如下:
Figure FDA0002974005560000047
其中,
Figure FDA0002974005560000048
表示球坐标同样为
Figure FDA0002974005560000049
的小行星表面点的法向量;
5-3)建立柔性绳网切向碰撞模型,计算柔性绳网节点受到的摩擦力,表达式如下:
Figure FDA00029740055600000410
其中,fi为柔性绳网节点i受到的摩擦力,μ为摩擦系数;
Figure FDA00029740055600000411
为柔性绳网节点i当前的速度矢量;然后进入步骤6);
6)设计柔性绳网系统的控制力;具体步骤如下:
6-1)对柔性绳网系统中每个控制器k,设计该控制器x方向上的滑模面
Figure FDA00029740055600000412
y方向上的滑模面
Figure FDA00029740055600000413
和z方向上的滑模面
Figure FDA00029740055600000414
表达式如下:
Figure FDA0002974005560000051
其中,c为常数;k代表控制器序号;t为时间,
Figure FDA0002974005560000052
为控制器k在x方向上的实际位移xk(t)与期望位移
Figure FDA0002974005560000053
之差,
Figure FDA0002974005560000054
Figure FDA0002974005560000055
的一阶导数;
Figure FDA0002974005560000056
为控制器在y方向上的实际位移yk(t)与期望位移
Figure FDA0002974005560000057
之差,
Figure FDA0002974005560000058
Figure FDA0002974005560000059
Figure FDA00029740055600000510
的一阶导数;
Figure FDA00029740055600000511
为控制器在z方向上的实际位移zk(t)与期望位移
Figure FDA00029740055600000512
之差,
Figure FDA00029740055600000513
Figure FDA00029740055600000514
Figure FDA00029740055600000515
的一阶导数;
6-2)设计控制器k在x方向的控制输入
Figure FDA00029740055600000516
在y方向的控制输入
Figure FDA00029740055600000517
在z方向的控制输入
Figure FDA00029740055600000518
表达式如下:
Figure FDA00029740055600000519
其中
Figure FDA00029740055600000520
为控制器k受到的外部作用力,
Figure FDA00029740055600000521
为控制器k受到来自柔性绳网的内力,(·)x表示矢量在x方向上的投影,(·)y表示矢量在y方向上的投影,(·)z表示矢量在y方向上的投影;
7)建立柔性绳网系统动力学模型并求解,得到柔性绳网系统捕获小行星的控制运动参数;具体步骤如下:
7-1)建立柔性绳网的每个节点在小行星引力场中的动力学模型,表达式如下:
Figure FDA00029740055600000522
其中,mi为柔性绳网节点i的质量,
Figure FDA00029740055600000523
为柔性绳网节点i受到的外部作用力,
Figure FDA00029740055600000524
为柔性绳网中第i个绳段单元的内力;Np表示柔性绳网中节点总数,ω为小行星绕自身惯性主轴旋转的角速度;δi为节点i的指示碰撞函数,当δi=1时,柔性绳网节点i与小行星发生碰撞,当δi=0时,二者未发生碰撞;
7-2)建立柔性绳网系统中每个控制器的动力学模型,表达式如下:
Figure FDA0002974005560000061
其中,mk为柔性绳网系统控制器k的质量;
7-3)对式(21)求解,得到每个时刻柔性绳网系统的每个柔性绳网节点在小行星引力场中的位移矢量ri,i=1,2,3...,Np,和速度矢量
Figure FDA0002974005560000062
对式(22)求解,得到每个时刻柔性绳网系统中每个控制器在小行星引力场中的位移矢量rk,k=1,2,3...,8,和速度矢量
Figure FDA0002974005560000063
柔性绳网系统捕获小行星的控制运动参数计算完毕。
CN202110270177.3A 2021-03-12 2021-03-12 一种柔性绳网系统捕获小行星的控制运动参数计算方法 Active CN112966386B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110270177.3A CN112966386B (zh) 2021-03-12 2021-03-12 一种柔性绳网系统捕获小行星的控制运动参数计算方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110270177.3A CN112966386B (zh) 2021-03-12 2021-03-12 一种柔性绳网系统捕获小行星的控制运动参数计算方法

Publications (2)

Publication Number Publication Date
CN112966386A true CN112966386A (zh) 2021-06-15
CN112966386B CN112966386B (zh) 2024-03-19

Family

ID=76277706

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110270177.3A Active CN112966386B (zh) 2021-03-12 2021-03-12 一种柔性绳网系统捕获小行星的控制运动参数计算方法

Country Status (1)

Country Link
CN (1) CN112966386B (zh)

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6147674A (en) * 1995-12-01 2000-11-14 Immersion Corporation Method and apparatus for designing force sensations in force feedback computer applications
CN108363837A (zh) * 2018-01-18 2018-08-03 西北工业大学 一种绳系飞网系统碰撞力的计算方法
CN110765547A (zh) * 2019-09-25 2020-02-07 上海航天控制技术研究所 一种简化的飞网捕获空间碎片动力学建模方法
CN111552003A (zh) * 2020-05-11 2020-08-18 中国人民解放军军事科学院国防科技创新研究院 基于球卫星编队的小行星引力场全自主测量系统及方法
CN111695239A (zh) * 2020-05-14 2020-09-22 南京航空航天大学 基于动态多面体混合模型的小行星着陆段引力计算方法
CN111881555A (zh) * 2020-06-30 2020-11-03 清华大学 一种柔性绳网在小行星引力场中的附着运动参数计算方法
CN112395795A (zh) * 2020-11-19 2021-02-23 北京理工大学 小天体探测器多节点柔性连接方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6147674A (en) * 1995-12-01 2000-11-14 Immersion Corporation Method and apparatus for designing force sensations in force feedback computer applications
CN108363837A (zh) * 2018-01-18 2018-08-03 西北工业大学 一种绳系飞网系统碰撞力的计算方法
CN110765547A (zh) * 2019-09-25 2020-02-07 上海航天控制技术研究所 一种简化的飞网捕获空间碎片动力学建模方法
CN111552003A (zh) * 2020-05-11 2020-08-18 中国人民解放军军事科学院国防科技创新研究院 基于球卫星编队的小行星引力场全自主测量系统及方法
CN111695239A (zh) * 2020-05-14 2020-09-22 南京航空航天大学 基于动态多面体混合模型的小行星着陆段引力计算方法
CN111881555A (zh) * 2020-06-30 2020-11-03 清华大学 一种柔性绳网在小行星引力场中的附着运动参数计算方法
CN112395795A (zh) * 2020-11-19 2021-02-23 北京理工大学 小天体探测器多节点柔性连接方法

Non-Patent Citations (2)

* Cited by examiner, † Cited by third party
Title
张江: "空间绳网捕获过程碰撞动力学研究", 中国优秀硕士学位论文全文数据库, no. 2, 5 February 2016 (2016-02-05), pages 22 - 40 *
陈钦;杨乐平;: "空间绳网系统发射动力学问题研究", 宇航学报, no. 05, 30 September 2009 (2009-09-30), pages 91 - 95 *

Also Published As

Publication number Publication date
CN112966386B (zh) 2024-03-19

Similar Documents

Publication Publication Date Title
CN111881555B (zh) 一种柔性绳网在小行星引力场中的附着运动参数计算方法
Ng et al. Computer graphics techniques for modeling cloth
CN102073755B (zh) 近空间高超声速飞行器运动控制仿真方法
CN107610208B (zh) 一种颗粒介质环境下动画角色的运动仿真方法
CN114580224B (zh) 一种分布式气动融合轨道耦合姿态摄动分析方法
Otsuka et al. Aeroelastic deployable wing simulation considering rotation hinge joint based on flexible multibody dynamics
Mahmood et al. Application of multibody simulation tool for dynamical analysis of tethered aerostat
CN112966386A (zh) 一种柔性绳网系统捕获小行星的控制运动参数计算方法
Attar et al. Physics-based generative design
CN103679751B (zh) 一种基于量子计算的碰撞检测方法
CN104318601A (zh) 一种流体环境下人体运动仿真方法
CN109003319A (zh) 角色动画中带有动力学约束的元球驱动蒙皮方法
CN115285380A (zh) 一种基于神经网络的微小卫星磁力矩器姿态控制方法
CN112140098B (zh) 基于近端策略优化的水下蛇形机器人高速步态生成方法
Mokry Numerical simulation of aircraft trailing vortices interacting with ambient shear or ground
Luo et al. Analyzing the driving method for the ball tensegrity robot
CN106569441A (zh) 一种分布式驱动的整体张拉式变形翼装置与控制方法
CN109492285B (zh) 一种可变形三维任意圆化凸多面体块体离散单元法
Yang et al. Physically-based tree animation and leaf deformation using CUDA in real-time
CN111008417A (zh) 一种大长细比连续结构的风致振动分析方法
CN109284537B (zh) 一种可变形二维任意圆化凸多边形离散单元法
Ying A fast Predictive-Corrective Mass Spring method in cloth simulation
Gu et al. Constraint solving order in position based dynamics
Li et al. Development of a Human Activity Recognition Algorithm Based on BiLSTM for Construction Workers
Kobayashi et al. Tensegric mobile controlled by pseudo forces

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