CN110209194B - 一种空间绳系编队的稳定展开控制方法 - Google Patents

一种空间绳系编队的稳定展开控制方法 Download PDF

Info

Publication number
CN110209194B
CN110209194B CN201910493225.8A CN201910493225A CN110209194B CN 110209194 B CN110209194 B CN 110209194B CN 201910493225 A CN201910493225 A CN 201910493225A CN 110209194 B CN110209194 B CN 110209194B
Authority
CN
China
Prior art keywords
formation
rope
tether
formation system
potential energy
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
CN201910493225.8A
Other languages
English (en)
Other versions
CN110209194A (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 CN201910493225.8A priority Critical patent/CN110209194B/zh
Publication of CN110209194A publication Critical patent/CN110209194A/zh
Application granted granted Critical
Publication of CN110209194B publication Critical patent/CN110209194B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/10Simultaneous control of position or course in three dimensions
    • G05D1/101Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/104Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying

Abstract

本发明提出了一种空间绳系编队的稳定展开控制方法,首先通过将编队系统的动能、势能代入拉格朗日动力学方程,建立三角构型空间绳系编队的动力学模型,其次根据得到的三角构型空间绳系编队动力学模型,确定三角构型空间绳系编队稳定展开控制律。本发明在建立三角构型空间绳系编队的动力学模型时,在传统质点连杆模型的基础上,考虑了系绳中的弹性,充分保留了系统的柔性。而且本发明在三角构型空间绳系编队的稳定展开控制中,综合考虑了系绳长度和自转角速度,使系统能以一个边旋转边伸长的状态稳定的展开,有利于编队后续各种空间任务的完成。

Description

一种空间绳系编队的稳定展开控制方法
技术领域
本发明属于多航天器编队系统控制技术研究领域,具体涉及一种三角构型空间绳系编队的稳定展开控制方法。
背景技术
空间绳系编队通过系绳将多颗卫星连接起来形成特定结构,不仅具有传统多航天器系统成本低、性能好、可靠性高、灵活性强的特点,而且具有在精确定位的同时可降低燃料消耗、提高寿命等优点,继而被广泛应用于对地观测和对地定向等空间任务中。
典型的一个三角形空间绳系编队是由三颗卫星和三根系绳相隔串联而成的平面三角形封闭系统。该系统在发射到空间后需要从进行系统展开控制,在展开过程中,系绳长度从几米逐渐展开到几百米甚至几千米不等,并在展开过程中,系统需要通过自转以维持编队构型的稳定。
由于系统动力学具有非线性、强耦合的特点,系统的展开不仅包括系绳的完全释放,还包括系统的自转,因此如何实现系统的稳定展开是一个较为困难的问题,目前还没有相关在前技术对这一展开过程进行研究。
发明内容
为解决现有技术存在的问题,实现三角形空间绳系编队的稳定展开,为完成相关空间任务提供保障,本发明提出了一种三角构型空间绳系编队的稳定展开控制方法,为空间绳系编队的实际展开提供了一个可行的方案,为编队系统顺利执行对地观测和对地定向等空间任务奠定了基础。
本发明的技术方案为:
所述一种空间绳系编队的稳定展开控制方法,其特征在于:包括以下步骤:
步骤1:建立三角构型空间绳系编队的动力学模型:
步骤1.1:建立编队系统的动能T为
Figure BDA0002087703680000021
其中m是编队系统的总质量,ω是编队系统绕地球旋转的角速度,R0是地心到编队系统质心的距离,l1、l2分别是编队系统中系绳1和系绳2的长度,
Figure BDA0002087703680000022
分别为系绳1和系绳2的长度变化率,θ1、θ2分别是系绳1、系绳2与轨道坐标系x轴正向的夹角;所述轨道坐标系o-xyz的原点o始终位于编队系统质心,x轴始终沿着地心指向编队系统质心的方向,y轴在轨道面内垂直x轴并指向编队系统前进的方向,z轴由右手坐标准则确定;
建立编队系统的势能V,其中势能V包括重力势能V1和弹性势能V2,重力势能V1表示为:
Figure BDA0002087703680000023
弹性势能V2表示为:
Figure BDA0002087703680000024
其中:l3=[l1 2+l2 2+2l1l2cos(θ12)]1/2是编队系统中系绳3的长度,l0是编队系统中系绳未弹性拉伸时的原始长度,EA为系绳的弹性系数;系数ei表示为:
Figure BDA0002087703680000025
步骤1.2:将编队系统的动能T、势能V代入拉格朗日动力学方程:
Figure BDA0002087703680000026
其中qi=[l1 l2 θ1 θ2]T表示广义坐标,
Figure BDA0002087703680000027
表示广义坐标对应的广义力和广义力矩;并令Λi=li/l0,(i=1,2,3),τ=ωt,以对参数进行无量纲化;得到三角构型空间绳系编队的动力学模型为:
Figure BDA0002087703680000031
其中Λi′和Λi″表示无量纲量Λi的一阶和二阶导数,θi′和θi″表示无量纲量θi的一阶和二阶导数;
步骤2:根据步骤1得到的三角构型空间绳系编队动力学模型,确定三角构型空间绳系编队稳定展开控制律为:
Q=Q1+Q2+Q3+Q4+Qs
其中:
Figure BDA0002087703680000032
为控制对象,
Figure BDA0002087703680000033
Figure BDA0002087703680000034
上标
Figure BDA0002087703680000035
表示矩阵的伪逆,k、ε均为大于0的正数,
Figure BDA0002087703680000036
为符号函数;
Figure BDA0002087703680000037
Figure BDA0002087703680000038
Figure BDA0002087703680000041
Figure BDA0002087703680000042
Figure BDA0002087703680000043
Figure BDA0002087703680000044
Figure BDA0002087703680000045
Figure BDA0002087703680000046
s为滑模面,采用公式s=a1s1+a2s2+a3s3+s4表示,其中s1=c11-1)+Λ1′,s2=c22-1)+Λ2′,s3=c31′-θ′),s4=c42′-θ′),a1、a2、a3均为控制参数,c1、c2、c3、c4均为大于0的正数,θ′为期望的系统自转角速度。
有益效果
与现有技术相比,本发明具有以下有益效果:
1)本发明在建立三角构型空间绳系编队的动力学模型时,在传统质点连杆模型的基础上,考虑了系绳中的弹性,充分保留了系统的柔性。
2)本发明在三角构型空间绳系编队的稳定展开控制中,综合考虑了系绳长度和自转角速度,使系统能以一个边旋转边伸长的状态稳定的展开,有利于编队后续各种空间任务的完成。
本发明的附加方面和优点将在下面的描述中部分给出,部分将从下面的描述中变得明显,或通过本发明的实践了解到。
附图说明
本发明的上述和/或附加的方面和优点从结合下面附图对实施例的描述中将变得明显和容易理解,其中:
图1为三角构型空间绳系编队结构与参考坐标系示意图;
图2为三角构型空间绳系编队卫星展开过程示意图;
图3为编队系统展开控制过程中三根系绳无量纲长度变化示意图;
图4为编队系统展开控制过程中无量纲系统自转角速度变化示意图。
具体实施方式
下面详细描述本发明的实施例,所述实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制。
实现三角形空间绳系编队的稳定展开,为完成相关空间任务提供保障,本发明提出了一种三角构型空间绳系编队的稳定展开控制方法,为空间绳系编队的实际展开提供了一个可行的方案,为编队系统顺利执行对地观测和对地定向等空间任务奠定了基础。
为了实现上述目的,本发明所采用的技术方案包括以下步骤:
1)建立三角构型空间绳系编队的动力学模型;
2)设计三角构型空间绳系编队稳定展开控制律;
如上所述的步骤1)中,系统建模所使用的坐标系包括:地心惯性坐标系E-XYZ,原点E位于地心;轨道坐标系o-xyz,原点o始终位于系统质心,x轴始终沿着地心指向质心的方向,y轴在轨道面内垂直x轴并指向系统前进的方向,z轴由右手坐标准则确定。
编队系统的动能T为
Figure BDA0002087703680000051
其中m是编队系统的总质量,本实施例中m=m1+m2+m3,m1、m2、m3分别是三颗卫星的质量,且m1=m2=m3;ω是编队系统绕地球旋转的角速度,R0是地心到编队系统质心的距离,l1、l2分别是编队系统中系绳1和系绳2的长度,
Figure BDA0002087703680000061
分别为系绳1和系绳2的长度变化率,θ1、θ2分别是系绳1、系绳2与轨道坐标系x轴正向的夹角;
编队系统的势能V,其中势能V包括重力势能V1和弹性势能V2,重力势能V1表示为:
Figure BDA0002087703680000062
弹性势能V2表示为:
Figure BDA0002087703680000063
其中:l3=[l1 2+l2 2+2l1l2 cos(θ12)]1/2是编队系统中系绳3的长度,l0是编队系统中系绳未弹性拉伸时的原始长度,EA为系绳的弹性系数;系数ei表示为:
Figure BDA0002087703680000064
将编队系统的动能T、势能V代入拉格朗日动力学方程:
Figure BDA0002087703680000065
其中qi=[l1 l2 θ1 θ2]T表示广义坐标,
Figure BDA0002087703680000066
表示广义坐标对应的广义力和广义力矩,也是本发明中的控制对象;并令Λi=li/l0,(i=1,2,3),τ=ωt,以对参数进行无量纲化,此时d()/dt=ωd()/dτ,d2()/dt2=ω2d2()/dτ2
得到三角构型空间绳系编队的动力学模型为:
Figure BDA0002087703680000071
其中Λi′和Λi″表示无量纲量Λi的一阶和二阶导数,θi′和θi″表示无量纲量θi的一阶和二阶导数;
如上所述的步骤2)中,将式(4)简写为如下形式:
Figure BDA0002087703680000072
其中:
Figure BDA0002087703680000073
Figure BDA0002087703680000074
Figure BDA0002087703680000075
Figure BDA0002087703680000081
Figure BDA0002087703680000082
为控制律;
Figure BDA0002087703680000083
Figure BDA0002087703680000084
Figure BDA0002087703680000085
Figure BDA0002087703680000086
均是1×4的矩阵。
定义系统滑模面s为:s=a1s1+a2s2+a3s3+s4,其中s1=c11-1)+Λ1′,s2=c22-1)+Λ2′,s3=c31′-θ′),s4=c42′-θ′)。a1、a2、a3均为控制参数,c1、c2、c3、c4均为大于0的正数,θ′为期望的系统自转角速度。三角构型空间绳系编队稳定展开控制律可表示如下:
Q=Q1+Q2+Q3+Q4+Qs (6)
其中:
Figure BDA0002087703680000087
Figure BDA0002087703680000088
上标
Figure BDA0002087703680000089
表示矩阵的违逆,k、ε均为大于0的正数,
Figure BDA00020877036800000810
为符号函数。
图3和图4为实施例中编队系统展开控制过程中三根系绳无量纲长度变化示意图以及系统自转角速度变化示意图,可以看出采用该展开控制方法,三根系绳均可以从初始状态完全拉长并稳定,同时编队系统的自转角速度也可以稳定到期望值,这说明该控制方法很好的达到了期望的控制效果。
尽管上面已经示出和描述了本发明的实施例,可以理解的是,上述实施例是示例性的,不能理解为对本发明的限制,本领域的普通技术人员在不脱离本发明的原理和宗旨的情况下在本发明的范围内可以对上述实施例进行变化、修改、替换和变型。

Claims (2)

1.一种空间绳系编队的稳定展开控制方法,其特征在于:包括以下步骤:
步骤1:建立三角构型空间绳系编队的动力学模型:
步骤1.1:建立编队系统的动能T为
Figure FDA0002087703670000011
其中m是编队系统的总质量,ω是编队系统绕地球旋转的角速度,R0是地心到编队系统质心的距离,l1、l2分别是编队系统中系绳1和系绳2的长度,
Figure FDA0002087703670000012
分别为系绳1和系绳2的长度变化率,θ1、θ2分别是系绳1、系绳2与轨道坐标系x轴正向的夹角;所述轨道坐标系o-xyz的原点o始终位于编队系统质心,x轴始终沿着地心指向编队系统质心的方向,y轴在轨道面内垂直x轴并指向编队系统前进的方向,z轴由右手坐标准则确定;
建立编队系统的势能V,其中势能V包括重力势能V1和弹性势能V2,重力势能V1表示为:
Figure FDA0002087703670000013
弹性势能V2表示为:
Figure FDA0002087703670000014
其中:l3=[l1 2+l2 2+2l1l2cos(θ12)]1/2是编队系统中系绳3的长度,l0是编队系统中系绳未弹性拉伸时的原始长度,EA为系绳的弹性系数;系数ei表示为:
Figure FDA0002087703670000015
步骤1.2:将编队系统的动能T、势能V代入拉格朗日动力学方程:
Figure FDA0002087703670000016
其中qi=[l1 l2 θ1 θ2]T表示广义坐标,
Figure FDA0002087703670000017
表示广义坐标对应的广义力和广义力矩;并令Λi=li/l0,(i=1,2,3),τ=ωt,以对参数进行无量纲化;得到三角构型空间绳系编队的动力学模型为:
Figure FDA0002087703670000021
其中Λi′和Λi″表示无量纲量Λi的一阶和二阶导数,θi′和θi″表示无量纲量θi的一阶和二阶导数;
步骤2:根据步骤1得到的三角构型空间绳系编队动力学模型,确定三角构型空间绳系编队稳定展开控制律为:
Q=Q1+Q2+Q3+Q4+Qs
其中:
Figure FDA0002087703670000022
为控制对象,
Figure FDA0002087703670000023
Figure FDA0002087703670000024
上标
Figure FDA0002087703670000025
表示矩阵的伪逆,k、ε均为大于0的正数,
Figure FDA0002087703670000026
为符号函数;
Figure FDA0002087703670000031
Figure FDA0002087703670000032
Figure FDA0002087703670000033
Figure FDA0002087703670000034
Figure FDA0002087703670000035
Figure FDA0002087703670000036
Figure FDA0002087703670000037
Figure FDA0002087703670000038
s为滑模面,采用公式s=a1s1+a2s2+a3s3+s4表示,其中s1=c11-1)+Λ1′,s2=c22-1)+Λ2′,s3=c31′-θ′),s4=c42′-θ′),a1、a2、a3均为控制参数,c1、c2、c3、c4均为大于0的正数,θ′为期望的系统自转角速度。
2.根据权利要求1所述一种空间绳系编队的稳定展开控制方法,其特征在于:编队系统的总质量m=m1+m2+m3,m1、m2、m3分别是三颗卫星的质量,且m1=m2=m3
CN201910493225.8A 2019-06-06 2019-06-06 一种空间绳系编队的稳定展开控制方法 Active CN110209194B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201910493225.8A CN110209194B (zh) 2019-06-06 2019-06-06 一种空间绳系编队的稳定展开控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910493225.8A CN110209194B (zh) 2019-06-06 2019-06-06 一种空间绳系编队的稳定展开控制方法

Publications (2)

Publication Number Publication Date
CN110209194A CN110209194A (zh) 2019-09-06
CN110209194B true CN110209194B (zh) 2021-11-16

Family

ID=67791334

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910493225.8A Active CN110209194B (zh) 2019-06-06 2019-06-06 一种空间绳系编队的稳定展开控制方法

Country Status (1)

Country Link
CN (1) CN110209194B (zh)

Families Citing this family (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111552180A (zh) * 2020-04-30 2020-08-18 西北工业大学 一种绳系卫星系统系绳展开振荡抑制控制方法
CN113479346B (zh) * 2021-07-01 2022-08-23 西北工业大学 一种空间多绳系系统构型展开的分布式控制方法
CN114211479B (zh) * 2021-12-14 2023-05-23 西北工业大学 一种空间多绳系系统构型展开的事件触发控制方法

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103064420A (zh) * 2012-12-14 2013-04-24 西北工业大学 可移动系绳点的空间绳系机器人的逼近姿态协调控制方法
CN103955611A (zh) * 2014-04-28 2014-07-30 西北工业大学 一种空间绳系机器人的通用动力学模型的建立方法
CN104345738A (zh) * 2014-09-30 2015-02-11 中国运载火箭技术研究院 一种绳系释放稳定控制方法及电动力绳系末级离轨稳定控制方法
CN105159309A (zh) * 2015-09-01 2015-12-16 西北工业大学 一种利用偏置系绳的空间飞行器姿态稳定控制方法
CN105468011A (zh) * 2015-12-31 2016-04-06 北京理工大学 一种辐射开环绳系卫星编队匀速自旋展开控制方法
CN107145071A (zh) * 2017-05-19 2017-09-08 西北工业大学 一种空间系绳系统的拉格朗日动力模型及控制器
CN108319135A (zh) * 2018-01-18 2018-07-24 西北工业大学 基于神经网络鲁棒自适应的空间柔性系统展开控制方法
CN108415449A (zh) * 2018-05-21 2018-08-17 北京航空航天大学 一种应用于空间卫星系统系绳展开、回收及张力控制的装置
CN108750144A (zh) * 2018-04-26 2018-11-06 北京航空航天大学 一种立体联动式绳系卫星
CN109002050A (zh) * 2018-07-02 2018-12-14 南京航空航天大学 非惯性参考系下空间三体柔性绳系卫星编队系统建模方法

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103064420A (zh) * 2012-12-14 2013-04-24 西北工业大学 可移动系绳点的空间绳系机器人的逼近姿态协调控制方法
CN103955611A (zh) * 2014-04-28 2014-07-30 西北工业大学 一种空间绳系机器人的通用动力学模型的建立方法
CN104345738A (zh) * 2014-09-30 2015-02-11 中国运载火箭技术研究院 一种绳系释放稳定控制方法及电动力绳系末级离轨稳定控制方法
CN105159309A (zh) * 2015-09-01 2015-12-16 西北工业大学 一种利用偏置系绳的空间飞行器姿态稳定控制方法
CN105468011A (zh) * 2015-12-31 2016-04-06 北京理工大学 一种辐射开环绳系卫星编队匀速自旋展开控制方法
CN107145071A (zh) * 2017-05-19 2017-09-08 西北工业大学 一种空间系绳系统的拉格朗日动力模型及控制器
CN108319135A (zh) * 2018-01-18 2018-07-24 西北工业大学 基于神经网络鲁棒自适应的空间柔性系统展开控制方法
CN108750144A (zh) * 2018-04-26 2018-11-06 北京航空航天大学 一种立体联动式绳系卫星
CN108415449A (zh) * 2018-05-21 2018-08-17 北京航空航天大学 一种应用于空间卫星系统系绳展开、回收及张力控制的装置
CN109002050A (zh) * 2018-07-02 2018-12-14 南京航空航天大学 非惯性参考系下空间三体柔性绳系卫星编队系统建模方法

Non-Patent Citations (3)

* Cited by examiner, † Cited by third party
Title
Dynamics of a triangular tethered satellite system on a low Earth orbit;Topal E等;《Proceedings of the 2nd International Conference on Recent Advances in Space Technologies》;20051003;第218-222页 *
空间绳系机器人系统动力学建模与仿真研究;胡仄虹等;《宇航学报》;20140131;第35卷(第1期);第28-38页 *
辐射开环空间绳系机器人编队动力学及控制;马骏等;《宇航学报》;20140731;第35卷(第7期);第794-801页 *

Also Published As

Publication number Publication date
CN110209194A (zh) 2019-09-06

Similar Documents

Publication Publication Date Title
CN110209194B (zh) 一种空间绳系编队的稳定展开控制方法
CN110471450B (zh) 在高度速度剖面内直接规划再入轨迹的方法
CN107364589B (zh) 基于多系绳连接点对空间失稳目标的绕飞消旋控制方法
CN104374388B (zh) 一种基于偏振光传感器的航姿测定方法
US9205921B1 (en) Methods and systems for conserving power during hover flight
US20140257770A1 (en) Numerical simulation method for the flight-icing of helicopter rotary-wings
CN103991559B (zh) 一种洛伦兹航天器悬停控制方法
CN109002050B (zh) 非惯性参考系下空间三体柔性绳系卫星编队系统建模方法
CN108037662A (zh) 一种基于积分滑模障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
CN104252574A (zh) 一种基于空间系绳抓捕系统的非合作目标质量辨识方法
CN103112603B (zh) 欠驱动高速自旋卫星建立正常姿态的方法
CN110329550A (zh) 用于敏捷卫星应用的姿态控制
CN103231810B (zh) 一种利用卫星俯仰轴姿态机动卸载俯仰轴角动量的方法
Healy et al. Experimental analysis of the dynamics of flared folding wingtips via a novel tethered flight test
Ioppo The design, modelling and control of an autonomous tethered multirotor UAV
CN107942672A (zh) 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
CN106005483A (zh) 一种模块化手机星的主动姿态控制方法
CN110466803A (zh) 基于等倾角姿态控制的自旋稳定卫星姿态预测方法
CN108107726A (zh) 一种基于对称时变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法
Gorbunova et al. Complex simulation of the solar sail spacecraft
Crowther et al. Simulation of a spinstabilised sports disc
Zhai Angular velocity determination of spinning solar sails using only a sun sensor
CN114265420B (zh) 适于高动态、控制慢响应的制导控制一体化设计方法
Wang et al. Adaptive Control of Hypersonic Vehicles with Parametric uncertainties and Angular Velocity Constraints
CN114211479B (zh) 一种空间多绳系系统构型展开的事件触发控制方法

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