CN110007681B - 一种利用连续推进器实现绳系编队自旋稳定展开优化方法 - Google Patents
一种利用连续推进器实现绳系编队自旋稳定展开优化方法 Download PDFInfo
- Publication number
- CN110007681B CN110007681B CN201811432334.0A CN201811432334A CN110007681B CN 110007681 B CN110007681 B CN 110007681B CN 201811432334 A CN201811432334 A CN 201811432334A CN 110007681 B CN110007681 B CN 110007681B
- Authority
- CN
- China
- Prior art keywords
- formation system
- spin
- equation
- stable
- rope formation
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 128
- 238000000034 method Methods 0.000 title claims abstract description 68
- 238000005457 optimization Methods 0.000 title claims abstract description 14
- 238000009987 spinning Methods 0.000 claims abstract description 19
- 238000013507 mapping Methods 0.000 claims abstract description 16
- 230000008569 process Effects 0.000 claims abstract description 14
- 230000033001 locomotion Effects 0.000 claims abstract description 12
- 238000001228 spectrum Methods 0.000 claims abstract description 12
- 238000004364 calculation method Methods 0.000 claims abstract description 10
- 230000008859 change Effects 0.000 claims description 8
- 238000005381 potential energy Methods 0.000 claims description 8
- 230000005484 gravity Effects 0.000 claims description 5
- 239000011159 matrix material Substances 0.000 claims description 5
- 238000013461 design Methods 0.000 claims description 3
- 230000004069 differentiation Effects 0.000 claims description 3
- NAWXUBYGYWOOIX-SFHVURJKSA-N (2s)-2-[[4-[2-(2,4-diaminoquinazolin-6-yl)ethyl]benzoyl]amino]-4-methylidenepentanedioic acid Chemical compound C1=CC2=NC(N)=NC(N)=C2C=C1CCC1=CC=C(C(=O)N[C@@H](CC(=C)C(O)=O)C(O)=O)C=C1 NAWXUBYGYWOOIX-SFHVURJKSA-N 0.000 claims description 2
- 230000003190 augmentative effect Effects 0.000 claims description 2
- 238000012544 monitoring process Methods 0.000 claims description 2
- 230000009897 systematic effect Effects 0.000 claims description 2
- 230000009466 transformation Effects 0.000 claims description 2
- 238000002407 reforming Methods 0.000 claims 1
- 238000005755 formation reaction Methods 0.000 description 83
- 230000010355 oscillation Effects 0.000 description 13
- 230000035945 sensitivity Effects 0.000 description 7
- 238000010586 diagram Methods 0.000 description 6
- 230000007423 decrease Effects 0.000 description 4
- 230000008878 coupling Effects 0.000 description 3
- 238000010168 coupling process Methods 0.000 description 3
- 238000005859 coupling reaction Methods 0.000 description 3
- 241000282414 Homo sapiens Species 0.000 description 2
- 238000013459 approach Methods 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000003247 decreasing effect Effects 0.000 description 2
- 238000011161 development Methods 0.000 description 2
- 239000000446 fuel Substances 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000009471 action Effects 0.000 description 1
- 238000004422 calculation algorithm Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Artificial Intelligence (AREA)
- Evolutionary Computation (AREA)
- Combustion & Propulsion (AREA)
- Aviation & Aerospace Engineering (AREA)
- Health & Medical Sciences (AREA)
- Chemical & Material Sciences (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Radar, Positioning & Navigation (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Feedback Control In General (AREA)
Abstract
本发明公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,属于航天器制导与控制领域。本发明实现方法为:定义不同的参考坐标系来描述绳系编队系统运动,利用拉格朗日方程来建立自旋稳定绳系编队系统的动力学模型;在实时域中描述有限时域最优控制问题,然后基于时域映射将其转化为Mayer形式,对自旋稳定绳系编队系统的动力学模型给定控制输入和状态变量约束,构建自旋稳定绳系编队系统最优展开模型;利用Legendre‑Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上,通过高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,能够减少需要输入的参数,提高计算精度。
Description
技术领域
本发明涉及一种利用连续推进器实现绳系编队自旋稳定展开优化方法,尤其涉及一种寻找开环最优轨迹,将子星从初始位置引导到最终旋转状态方法,属于航天器制导与控制领域。
背景技术
绳系卫星系统是指由绳系连接两颗或多颗卫星而组成的航天器系统,绳系卫星在大气探测、空间环境探测、空间碎片清除等领域有着广阔的应用前景,可以将其作为人类探索宇宙空间、获取宇宙中的资源、拓宽人类生存空间的新结构。例如利用系绳将空间探测平台从主星上释放到地球大气层,实现对近地大气的探测。通过绳系卫星系统在高速运行时绳系切割地磁力线,产生电流并在地磁场作用下提升或降低系统轨道且不消耗燃料。
近年来,利用自旋稳定绳系编队构建大型柔性空间系统的概念引起了人们极大的关注。自旋稳定的绳系编队可以通过自旋产生的离心力保持其构型,这样相比传统空间系统可以用更少的燃料消耗来控制空间系统。此外通过调节连接绳索的长度,编队还能够提供长而可变的基线,从而可以进行高质量的空间观测。但绳系编队系统自旋稳定展开过程中存在动力学耦合及约束控制非线性问题。
对于仅考虑拉伸情况的绳系卫星系统选用拉格朗日法建模。如果绳系编队包括三个或更多个星体,编队操作会由于实际挑战变得困难,其中一个挑战是将编队从初始状态展开到最终期望的结构。由于科里奥利加速度和重力梯度,子星受到平面内和平面外的振动,导致绳系松弛甚至相邻构件之间的碰撞。总的来说,这些挑战主要来自编队动力学的复杂性;虽然许多研究人员已经研究了绳系编队的控制问题,但较少考虑具有中心体的自旋稳定绳系编队,这使得编队展开更加复杂。
发明内容
针对绳系编队系统自旋稳定展开过程中的动力学耦合及约束控制非线性问题,求解具体非线性方程存在需要输入的参数较多、计算精度差的缺点,本发明公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法要解决的技术问题是:利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上,通过高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度。利用所述的数值求解能够为绳系编队系统提供高精度控制方案,进而提高绳系编队系统自旋稳定展开控制精度。
本发明的目的通过以下技术方案实现。
本发明公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,定义不同的参考坐标系来描述绳系编队系统运动,利用拉格朗日方程来建立自旋稳定绳系编队系统的动力学模型。在实时域中描述有限时域最优控制问题,然后基于时域映射将其转化为Mayer形式,对自旋稳定绳系编队系统的动力学模型给定控制输入和状态变量约束,构建自旋稳定绳系编队系统最优展开模型。利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上,通过高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度。
本发明公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,包括如下步骤:
步骤一:定义不同的参考坐标系来描述绳系编队系统运动,利用拉格朗日方程来建立自旋稳定绳系编队系统的动力学模型;
步骤1.1:定义地球惯性坐标系ECI、局部垂直局部水平LVLH坐标系和本体固连坐标系;
以OXYZ表示的地球惯性坐标系ECI是非旋转坐标系;其x轴和y轴位于赤道平面,x轴与春分点重合,Z轴穿过地球北极,y轴由右手定则确定。以Oxoyozo表示的局部垂直局部水平LVLH坐标系与主星相连,其zo轴是沿着从航天器到地球质心的半径矢量,xo轴是沿着轨道速度的矢量yo轴由右手定则确定。表示为Oxbybzb的本体固连坐标系用来定义动力学变量,它的原点固定在主星的质心,xb轴称为局部径向,源于原点到系绳连接点,yb轴与系统的旋转轴对齐,zb轴由右手定则确定。
步骤1.2:计算绳系编队系统的总动能;
当编队沿着旋转轴对称时,在局部垂直局部水平坐标系内,得:
其中:ρi=[ρxρyρz]T表示第i子星相对于局部垂直局部水平坐标系的位置矢量,还表示为:
其中:r是主星的半径,θi是主星的自旋角。αi是从连接绳系测量到局部径向的振动角度,li表示连接绳系的长度。此外,vi表示为地球惯性坐标系内的子星速度,由公式(3)计算:
vi=vo+vci (3)
其中:vo表示地球惯性坐标系内系统质心的速度,vci表示子星相对于地球惯性坐标系中主星的速度。由于编队应处于圆形轨道,地球惯性坐标系内系统质心的速度vo由公式(4)计算:
v0=Ω×R (4)
其中Ω=[0,-Ω,0]T是轨道速度矢量,R是编队中心的轨道位置矢量。另外,vci由公式(5)计算:
将式(2)代入式(5)可得:
最后,通过公式(7)获得绳系编队系统的总动能:
其中:
Tci=mi(vo+vci)·(vo+vci) (9)
其中:Jc表示主星相对于旋转轴的惯性动量,mc和mi分别代表主星和子星的质量。式(7)右边的第二项可以扩展为:
由式(1)得:
将式(3),式(4)和式(11)代入式(10)然后得到:
步骤1.3:计算绳系编队系统的总势能;
忽略地球扁率扰动,将绳系编队系统的重力势能公式化为:
其中:μe是恒定的引力系数,接下来将(Rc+ρi)-1项扩展为泰勒级数并忽略高阶项:
其中ρi=||ρi||。将式(14)代入式(13)最终得到:
步骤1.4:利用拉格朗日方程建立自旋稳定绳系编队系统的动力学模型,并将所述自旋稳定绳系编队系统的动力学模型用状态空间形式表示。
拉格朗日方程根据动能和势能条件描述编队的运动:
其中:qj是广义坐标,Qj表示作用于系统上的广义力。通过选择之前定义的自变量作为广义坐标,并将动能和势能项代入式(16),获得如公式 (17)至(19)所示的自旋稳定绳系编队系统的动力学模型:
其中:f=[uθ,uαi,uli]T表示主动控制输入向量,而f=[udθ,udαi,udli]T表示与重力梯度和离心力相关的扰动,每个扰动分量表示为:
现有技术中主星通常被认为是质点,进而限制主星和绳系之间动态耦合的动力学问题处理。由于动力学和扰动的复杂性,很难为编队的展开设计解析的控制方案。因此,通常只能获得编队动力学的近似值。当主星在完全主动控制下不断旋转时,对绳系编队系统解耦,实现对每个子星的动力学解耦分析。因此,对于每个子星,通过公式(23)、(24)分别独立地描述俯仰角和绳系长度的运动:
其中:是主星的恒定旋转速率。式(23)描述绳系编队系统平面内振动,式(24)表明绳系的长度变化。由于每颗子星的动力学形式相同,不失一般性,任何符号的下标i都被忽略。在展开过程中,编队的旋转速率总是大于轨道角速度;因此,式(20)到式(22)中的扰动项能够忽略不计。最后,定义状态向量自旋稳定绳系编队系统的动力学模型用状态空间公式表示为:
其中:u=[fα,fl]T表示控制输入,f(x,u)表示的向量函数为:
步骤二:在实时域中描述有限时域最优控制问题,然后基于时域映射将其转化为Mayer形式;对步骤一建立的自旋稳定绳系编队系统的动力学模型,给定控制输入和状态变量约束,构建自旋稳定绳系编队系统最优展开模型。
步骤2.1:在实时域中描述有限时域最优控制问题;
在实时域中自旋稳定绳系编队系统表示为:
其中:t∈[t0,tf],x(t)是系统状态,u(t)是控制输入。将成本函数定义为:
有限时域最优控制问题是确定状态控制对在式(28)中的成本函数最小化,且服从式(27)中的动力学和给定约束。
x(t0)=x0 x(tf)=xf (29)
Ψ(x)≥0 t∈[to,tf] (30)
Θ(u)≥0 t∈[t0,tf] (31)
其中:式(29)是边界条件,式(30)和式(31)是状态和控制输入的路径约束。
求解受约束的最优控制问题,其中成本函数以伴随变量的形式出现。最优控制问题在实际中视为两点边界问题,增广哈密顿量通常根据系统状态,控制输入和伴随变量来定义。哈密顿量的消失梯度为庞特里亚金优化提供必要条件,最终能够根据必要条件得到最优解。
步骤2.2:对步骤2.1描述的有限时域最优控制问题,基于时域映射将其转化为Mayer形式。
在高斯伪谱法的框架下,利用拉格朗日多项式在Legendre Gauss点近似求解最优控制问题的状态变量和控制变量。然后通过微分矩阵在 Legendre Gauss点计算状态变量的状态导数,同时,并将连续约束转化为离散的代数约束。由于Legendre Gauss点在[-1,1]的范围内,所以最优控制问题的原型通过将实时区间映射到[-1,1]域来重新形成Mayer型。对于实时区间t∈[t0,tf],通过以下变换实现域映射:
根据式(32),可推导:
以及:
在时域映射之后,计算状态的一阶导数:
通过式(34)和式(35),动力学改写为:
然后Mayer形式的最优控制问题可以表示为如下:在[-1,1]域内找到状态控制对,使成本函数最小化。
服从式(36)和边界条件的动态约束:
x(τ=-1)=x0 x(τ=-1)=xf (38)
路径约束:
Ψ(x(τ))≥0 τ∈[-1,1] (39)
Θ(u(τ))≥0 τ∈[-1,1] (40)
步骤2.3:根据步骤2.1描述的有限时域最优控制问题和步骤2.2基于时域映射将其转化为Mayer形式;对步骤一建立的自旋稳定绳系编队系统的动力学模型,给定控制输入和状态变量约束,构建自旋稳定绳系编队系统最优展开模型。
初始展开条件包括初始振动角度和速率及绳系长度和速率:
绳系编队系统成功展开后,预计达到最终状态:
其中:αf和lf表示最终的振动角度和绳系长度。在展开期间,绳系张力应限制为:
利用连续推进器产生供编队展开的控制力。由于绳系仅提供阻力,所以配备纵向推力器产生正向力。因此纵向控制力能够扩展到从负到正的范围,沿着绳系的总纵向控制力表示为:
fl=ftether+fthruster1 (44)
由于推进器的振幅限制,纵向推进器产生的力受到如下约束:
其中:对于切向推力器,连续控制力的界限如下:
为了实现实时监视,使用摄像机检查子星的运动。在展开期间,子星必须位于摄像机的视场FOV内。因此,振动角度的等效约束满足:
-αmax≤α≤αmax (47)
其中:αmax是由监视摄像机FOV范围确定的振动角边界。
最后,用于最小化功耗的成本函数表述为:
公式(48)服从下述约束及边界条件:式(27)的动力学约束,式(41) 和式(42)的边界条件,式(43)、式(45)和式(46)的输入约束,式(47) 的路径约束。
所述用于最小化功耗的成本函数即为构建的自旋稳定绳系编队系统最优展开模型。
步骤三:利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上,通过高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度。利用所述的数值求解能够为绳系编队系统提供解析的、高精度控制方案,进而提高绳系编队系统自旋稳定展开控制精度。
使用拉格朗日插值多项式,最终状态和控制输入在Legendre Gauss点处近似产生N次多项式为:
其中:k是Legendre Gauss点的数量,并且是拉格朗日插值多项式。
如式(49)和式(50)所示,拉格朗日插值能够确保x(τi)=X(τi)和 u(τi)=U(τi),其中非Legendre Gauss点的值仅近似等于真值。求式(49) 的微分为:
其中:微分矩阵Dki确定为:
其中k=1,2,...,K和PK(τ)是K阶Legendre多项式,表示为:
将式(55)代入式(27)中,绳系编队系统动力学改写为:
即实现利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上。
此外,通过高斯求积获得最终状态:
其中:ωk和DKi仅由Legendre Gauss点的数量决定,并且在数值传播的下一步之前离线计算。最后,基于高斯伪谱法,原型最优控制问题转化为非线性规划问题,形式如下:
即通过公式(57)、(58)实现高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度。利用所述的数值求解能够为绳系编队系统提供高精度控制方案,进而提高绳系编队系统自旋稳定展开控制精度。
有益效果:
1、本发明公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,在圆形轨道中将主星自旋考虑在内,给出考虑主星旋转的复杂绳系编队系统自旋展开的动力学模型,提高主星旋转的复杂绳系编队系统的建模精度。
2、本发明公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,在时域中以一般形式描述有限时域最优控制问题,然后基于时域映射将其转化为Mayer形式,再利用编队动力学以及控制输入和状态变量的操作约束来构造最优展开问题,实现了利用连续推进器产生供编队展开的控制力,同时使纵向控制力能够扩展到从负到正的范围。
3、本发明公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上,通过高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度。利用所述的数值求解能够为绳系编队系统提供高精度控制方案,进而提高绳系编队系统自旋稳定展开控制精度。
附图说明:
图1是本发明的一种利用连续推进器实现绳系编队自旋稳定展开优化方法流程图;
图2为本发明绳系卫星编队示意图;
图3为本发明步骤二展开约束示意图;
图4为本发明实施例A振动角度和角速度示意图;
图5为本发明实施例A绳系长度和展开速率示意图;
图6为本发明实施例A在局部垂直局部水平坐标系与本体固连坐标系子星的展开路径示意图;
图7为本发明实施例A最优控制输入示意图;
图8为本发明实施例B振动角度和角速度示意图;
图9为本发明实施例B绳系长度和展开速率示意图;
图10为本发明实施例B在局部垂直局部水平坐标系与本体固连坐标系子星的展开路径示意图;
图11为本发明实施例B最优控制输入示意图;
图12为本发明实施例中具有不同旋转速率的状态组件的展开曲线图;
图13为本发明实施例中具有不同旋转速率的控制曲线图;
图14为本发明实施例中推力器成本函数和最大振幅对自旋速率的灵敏度结果示意图;
图15为本发明实施例中具有不同展开时间的状态组件的展开曲线图;
图16为本发明实施例中具有不同展开时间的控制曲线图;
图17为本发明实施例中推进器成本函数和最大幅值对展开时间的灵敏度结果示意图。
具体实施方式
为了更好地说明本发明的目的和优点,下面结合附图对本发明的具体实施方式作进一步详细的说明。
实施例A与例B:
为验证本实施例公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法可行性,首先构造绳系卫星数值模型。系统基本参数如表1所示。为了便于比较,在仿真中考虑了两种典型的展开情况。第一种涉及切向和纵向推进器,而第二种只涉及切线推进器。为了避免由不等式约束引起的收敛问题,本实施例算法迭代地确定区间的数量/宽度和每个区间的多项式次数;因此,节点的数量和多项式的次数持续更新,直到满足指定的公差为止,并且伪线性化传播被设计为当且仅当所有 Legendre Gauss点满足|u(k+1)-u(k)|≤10-3时终止。两种情况的参数如表2 所示。
表1系统参数
表2实施例参数
如图1所示,本实施例公开的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,包括如下步骤:
步骤一:定义不同的参考坐标系来描述绳系编队系统运动,利用拉格朗日方程来建立自旋稳定绳系编队系统的动力学模型;
其中:u=[fα,fl]T表示控制输入,f(x,u)表示的向量函数为:
其中:r是主星的半径,α是从连接绳系测量到局部径向的振动角度, l表示连接绳系的长度,Ω是轨道速度矢量,ω是主星的恒定旋转速率。
所以f(x,u)表示的向量函数为改写为:
步骤二:在实时域中描述有限时域最优控制问题,然后基于时域映射将其转化为Mayer形式;对步骤一建立的自旋稳定绳系编队系统的动力学模型,给定控制输入和状态变量约束,构建自旋稳定绳系编队系统最优展开模型。
用于最小化功耗的成本函数表述为:
发明内容中公式(48)服从下述约束及边界条件:
-αmax≤α≤αmax (11)
步骤三:利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上,通过高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度。利用所述的数值求解能够为绳系编队系统提供解析的、高精度控制方案,进而提高绳系编队系统自旋稳定展开控制精度。
使用拉格朗日插值多项式,最终状态和控制输入在Legendre Gauss点处近似产生N次多项式为:
其中:k是Legendre Gauss点的数量,并且是拉格朗日插值多项式。
如式(12)和式(13)所示,拉格朗日插值能够确保x(τi)=X(τi)和 u(τi)=U(τi),其中非Legendre Gauss点的值仅近似等于真值。求式(12) 的微分为:
其中:微分矩阵Dki确定为:
其中k=1,2,...,K和PK(τ)是K阶Legendre多项式,表示为:
将式(18)代入式(5)中,绳系编队系统动力学改写为:
即实现利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上。
其中:ωk和DKi仅由Legendre Gauss点的数量决定,并且在数值传播的下一步之前离线计算。基于高斯伪谱法,原型最优控制问题转化为非线性规划问题。
如图3所示,振动角从零开始平滑变化,几乎减小到-1rad,并且始终保持负值,表明子星在旋转展开期间总是位于局部径向之后。另外,由于摄像机监视的约束,振动角的幅度受到-π/3rad的边界限制,并且在40s之后,振动角逐渐增加到零。振动角速率起始于初始阶段的快速振荡。这种快速振荡与初始快速下降的振动角很好地吻合,但在初始短期振荡之后,振动角速度缓慢变化并最终趋近于零。
如图4所示,在展开过程中绳系长度和展开速率平稳变化,绳系展开速率始终保持为正,表明绳系长度总是在增加并最终达到500米的长度,而绳系展开速率在t=60s达到最大值并在最终结束时接近零。
图5表示了包括局部垂直局部水平坐标系和主体固连坐标系中的子星轨迹。结果表明,在整个展开期间没有发生明显的轨道振动,这意味着编队保持良好并且最终在轨道上实现稳定的构型。所述结果能够支持子星相对于主星的相对运动分析。
图6绘出了控制输入曲线图,包括绳系张力的分量,切向和纵向推力器的力。结果表明,在t=20s之前所有的输入分量在相应的限制范围内变化,切向推力器总是产生负向力,以较小的振荡来调节子星的偏离角。在t=60s之前,纵向推力器提供正向力使绳系沿径向展开,但在t=50s后,纵向推进器保持不活动状态直到展开完成。如图6所示,绳系张力保持1N直到73s,然后在展开结束时逐渐增加到3.6N。
图7给出了振动角和角速率经历初始振荡,但是两个变量的振荡范围大于实施例A的振动范围,这导致局部垂直局部水平和本体固连坐标系中的子星轨道明显振荡,如图9所示。绳系长度和展开速率的变化如图8所示。结果表明,绳系长度在整个展开过程中持续增加,最终达到500m的长度。展开速率在t=56s时达到其最大值,但与实施例A结果相比,绳系展开速率在t=20s之前会出现明显振荡。在局部垂直局部水平和本体固连坐标系中都能够看到所述振荡。
图10中绘出了切向推力器的振幅始终保持为零,而纵向推进器的振幅在[-5,8]N范围内变化。绳系拉力保持1N直到82s,然后逐渐增加到最大值4N。其在展开结束时达到3.6N,同实施例A结果一致。更重要的是,图10表明通过在展开阶段停用切向推进器进行展开,应该增加主动推进器的最大振幅以确保解决方案可行,并且为了成功展开还需要增加功耗。
最佳展开问题可以通过120s的展开时间解决,如图11所示,所有状态变量在展开过程中都有相同的变化趋势。振动角变化平稳但总是受FOV约束的限制,并且在所有情况下几乎同时发生初始振荡。但值得注意的是,面内振动角速率的初始振荡的峰值以及系绳展开速率的最大值显示出对旋转速率变化的典型灵敏度。结果表明,增加旋转速率会降低振动角速率的峰值,同时增加最大绳系展开速率。
最优控制输入的结果如图12所示。对于所有情况,切向推力和绳系张力都没有发生明显的振荡,但两个输入分量的最大振幅随着主星自旋速率的增加而增大。通过分析底部曲线得到的推理结果具有较为鲜明的特点:如果旋转速率为ω=2π/80rad/s时,纵向推力始终保持为 1N;然而在较高的旋转速率下,超调将在展开开始时出现。该图还表明较低的旋转速率将与纵向推力的较大峰值相关。
为了证明成本函数和最大推力振幅对旋转速度的敏感性,将旋转周期从60s增加到160s,时间间隔为10s。不同旋转速率的结果如图 13所示,证明通过降低旋转速率,成本函数和切向推力(负)的最大振幅均单调减小,但当自旋周期大于120s时,减少变得不明显。曲线显示了最大纵向推力对旋转速率的敏感性,然而与切向推力的结果相比,仅当自旋周期长于90s时才出现敏感度增加的现象,而当旋转周期比90s短时,最大值几乎保持不变。
通过选择80s,100s和120s的展开时间,获得80s的旋转周期结果,如图14所示。该图显示,随着每次展开时间的增加,各变量的所有时间历程都以相同的趋势变化,并且振动角速率和绳系展开速率的峰值都没有变化。如图15所示,切向推力和绳系张力即使在不同的展开时间也具有相似的趋势,而对于纵向推力,在80s的展开时间发生超调,但对于其他情况它几乎保持恒定。
成本函数和最大推力振幅对展开时间的敏感性也在一系列仿真中进行分析,其中展开时间从50s增加到140s,时间间隔为10s。如图 16所示,所有结果都表明当展开时间增加时振幅减小。但是应该注意的是,当展开时间超过90s时,所有结果的减少变得不明显。
综上所述,以上仅为本发明的较佳实施例而已,并非用于限定本发明的保护范围。凡在本发明的精神和原则之内,所作的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (3)
1.一种利用连续推进器实现绳系编队自旋稳定展开优化方法,其特征在于:包括如下步骤,
步骤一:定义参考坐标系来描述携带连续推进器的绳系编队系统运动,利用拉格朗日方程来建立自旋稳定绳系编队系统的动力学模型;
步骤二:在实时域中描述有限时域最优控制问题,然后基于时域映射将其转化为Mayer形式;对步骤一建立的自旋稳定绳系编队系统的动力学模型,给定控制输入和状态变量约束,构建自旋稳定携带连续推进器绳系编队系统最优展开模型;
步骤三:利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上,通过高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度;利用所述的数值求解能够为绳系编队系统提供解析的、高精度控制方案,进而提高携带连续推进器绳系编队系统自旋稳定展开控制精度;
步骤一具体实现方法为,
步骤1.1:定义地球惯性坐标系ECI、局部垂直局部水平LVLH坐标系和本体固连坐标系;
以OXYZ表示的地球惯性坐标系ECI是非旋转坐标系;其x轴和y轴位于赤道平面,x轴与春分点重合,z轴穿过地球北极,y轴由右手定则确定;以Oxoyozo表示的局部垂直局部水平LVLH坐标系与主星相连,其zo轴是沿着从航天器到地球质心的半径矢量,xo轴是沿着轨道速度的矢量yo轴由右手定则确定;表示为Oxbybzb的本体固连坐标系用来定义动力学变量,它的原点固定在主星的质心,xb轴称为局部径向,源于原点到系绳连接点,yb轴与系统的旋转轴对齐,zb轴由右手定则确定;
步骤1.2:计算绳系编队系统的总动能;
当编队沿着旋转轴对称时,在局部垂直局部水平坐标系内,得:
其中:mi表示第i子星质量,ρi=[ρx ρy ρz]T表示第i子星相对于局部垂直局部水平坐标系的位置矢量,还表示为:
其中:r是主星的半径,θi是主星的自旋角;αi是从连接绳系测量到局部径向的振动角度,li表示连接绳系的长度;此外,vi表示为地球惯性坐标系内的子星速度,由公式(3)计算:
vi=v0+vci (3)
其中:vo表示地球惯性坐标系内系统质心的速度,vci表示子星相对于地球惯性坐标系中主星的速度;由于编队应处于圆形轨道,地球惯性坐标系内系统质心的速度vo由公式(4)计算:
v0=Ω×R (4)
其中Ω是轨道速度矢量,R是编队中心的轨道位置矢量;另外,vci由公式(5)计算:
将式(2)代入式(5)可得:
最后,通过公式(7)获得绳系编队系统的总动能:
其中:Tc和Tci由公式(8)和公式(9)计算:
Tci=mi(vo+vci)·(vo+vci) (9)
其中:Jc表示主星相对于旋转轴的惯性动量,mc和mi分别代表主星和子星的质量;式(7)右边的第二项可以扩展为:
由式(1)得:
将式(3),式(4)和式(11)代入式(10)然后得到:
步骤1.3:计算绳系编队系统的总势能;
忽略地球扁率扰动,将绳系编队系统的重力势能公式化为:
其中:μe是恒定的引力系数,接下来将(R+ρi)-1项扩展为泰勒级数并忽略高阶项:
其中ρi=||ρi||,即计算位置矢量的范数;将式(14)代入式(13)最终得到:
步骤1.4:利用拉格朗日方程建立自旋稳定绳系编队系统的动力学模型,并将所述自旋稳定绳系编队系统的动力学模型用状态空间形式表示;
拉格朗日方程根据动能和势能条件描述编队的运动:
其中:qj是广义坐标,Qj表示作用于系统上的广义力;通过选择之前定义的自变量作为广义坐标,并将动能和势能项代入式(16),获得如公式(17)至(19)所示的自旋稳定绳系编队系统的动力学模型:
其中,fθ,fαi和fli表示主动控制输入向量,而fdθ,fdαi和fdli表示与重力梯度和离心力相关的扰动,每个扰动分量表示为:
当主星在完全主动控制下不断旋转时,对绳系编队系统解耦,实现对每个子星的动力学解耦分析;因此,对于每个子星,通过公式(23)、(24)分别独立地描述俯仰角和绳系长度的运动:
其中:是主星的恒定旋转速率;式(23)描述绳系编队系统平面内振动,式(24)表明绳系的长度变化;由于每颗子星的动力学形式相同,不失一般性,任何符号的下标i都被忽略;在展开过程中,编队的旋转速率总是大于轨道角速度;因此,式(20)到式(22)中的扰动项能够忽略不计;最后,定义状态向量自旋稳定绳系编队系统的动力学模型用状态空间公式表示为:
其中:u=[fα,fl]T表示控制输入,f(x,u)表示的向量函数为:
2.如权利要求1所述的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,其特征在于:步骤二具体实现方法为,
步骤2.1:在实时域中描述有限时域最优控制问题;
在实时域中自旋稳定绳系编队系统表示为:
其中:t∈[t0,tf],x(t)是系统状态,u(t)是控制输入;将成本函数定义为:
有限时域最优控制问题是确定状态控制对在式(28)中的成本函数最小化,且服从式(27)中的动力学和给定约束;
x(t0)=x0 x(tf)=xf (29)
Ψ(x)≥0 t∈[to,tf] (30)
Θ(u)≥0 t∈[t0,tf] (31)
其中:式(29)是边界条件,式(30)和式(31)是状态和控制输入的路径约束;
求解受约束的最优控制问题,其中成本函数以伴随变量的形式出现;最优控制问题在实际中视为两点边界问题,增广哈密顿量通常根据系统状态,控制输入和伴随变量来定义;哈密顿量的消失梯度为庞特里亚金优化提供必要条件,最终能够根据必要条件得到最优解;
步骤2.2:对步骤2.1描述的有限时域最优控制问题,基于时域映射将其转化为Mayer形式;
在高斯伪谱法的框架下,利用拉格朗日多项式在Legendre Gauss点近似求解最优控制问题的状态变量和控制变量;然后通过微分矩阵在Legendre Gauss点计算状态变量的状态导数,同时,并将连续约束转化为离散的代数约束;由于Legendre Gauss点在[-1,1]的范围内,所以最优控制问题的原型通过将实时区间映射到[-1,1]域来重新形成Mayer型;对于实时区间t∈[t0,tf],通过以下变换实现域映射:
根据式(32),可推导:
以及:
在时域映射之后,计算状态的一阶导数:
通过式(34)和式(35),动力学改写为:
然后Mayer形式的最优控制问题可以表示为如下:在[-1,1]域内找到状态控制对,使成本函数最小化;
服从式(36)和边界条件的动态约束:
x(τ=-1)=x0 x(τ=-1)=xf (38)
路径约束:
Ψ(x(τ))≥0 τ∈[-1,1] (39)
Θ(u(τ))≥0 τ∈[-1,1] (40)
步骤2.3:根据步骤2.1描述的有限时域最优控制问题和步骤2.2基于时域映射将其转化为Mayer形式;对步骤一建立的自旋稳定绳系编队系统的动力学模型,给定控制输入和状态变量约束,构建自旋稳定绳系编队系统最优展开模型;
初始展开条件包括初始振动角度和速率及绳系长度和速率:
绳系编队系统成功展开后,预计达到最终状态:
其中:αf和lf表示最终的振动角度和绳系长度;在展开期间,绳系张力应限制为:
利用连续推进器产生供编队展开的控制力;由于绳系仅提供阻力,所以配备纵向推力器产生正向力;因此纵向控制力能够扩展到从负到正的范围,沿着绳系的总纵向控制力表示为:
fl=ftether+fthruster1 (44)
由于推进器的振幅限制,纵向推进器产生的力受到如下约束:
为了实现实时监视,使用摄像机检查子星的运动;在展开期间,子星必须位于摄像机的视场FOV内;因此,振动角度的等效约束满足:
-αmax≤α≤αmax (47)
其中:αmax是由监视摄像机FOV范围确定的振动角边界;
最后,用于最小化功耗的成本函数表述为:
公式(48)服从下述约束及边界条件:式(27)的动力学约束,式(41)和式(42)的边界条件,式(43)、式(45)和式(46)的输入约束,式(47)的路径约束;
所述用于最小化功耗的成本函数即为构建的自旋稳定绳系编队系统最优展开模型。
3.如权利要求2所述的一种利用连续推进器实现绳系编队自旋稳定展开优化方法,其特征在于:步骤三具体实现方法为,
使用拉格朗日插值多项式,最终状态和控制输入在Legendre Gauss点处近似产生N次多项式为:
如式(49)和式(50)所示,拉格朗日插值能够确保x(τi)=X(τi)和u(τi)=U(τi),其中非Legendre Gauss点的值仅近似等于真值;求式(49)的微分为:
其中:微分矩阵Dki确定为:
其中k=1,2,…,K,PK(τ)是K阶Legendre多项式,表示为:
将式(55)代入式(27)中,绳系编队系统动力学改写为:
即实现利用Legendre-Gauss离散化方法,将绳系编队系统自旋稳定展开的最终状态和控制输入离散在一系列离散点上;
此外,通过高斯求积获得最终状态:
其中:ωk和DKi仅由Legendre Gauss点的数量决定,并且在数值传播的下一步之前离线计算;最后,基于高斯伪谱法,原型最优控制问题转化为非线性规划问题,形式如下:
即通过公式(57)、(58)实现高斯伪谱法对绳系编队系统地自旋稳定展开动力学过程进行数值求解,进而能够减少需要输入的参数,提高计算精度;利用所述的数值求解能够为绳系编队系统提供高精度控制方案,进而提高绳系编队系统自旋稳定展开控制精度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811432334.0A CN110007681B (zh) | 2018-11-28 | 2018-11-28 | 一种利用连续推进器实现绳系编队自旋稳定展开优化方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811432334.0A CN110007681B (zh) | 2018-11-28 | 2018-11-28 | 一种利用连续推进器实现绳系编队自旋稳定展开优化方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110007681A CN110007681A (zh) | 2019-07-12 |
CN110007681B true CN110007681B (zh) | 2020-06-26 |
Family
ID=67165048
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811432334.0A Active CN110007681B (zh) | 2018-11-28 | 2018-11-28 | 一种利用连续推进器实现绳系编队自旋稳定展开优化方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110007681B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111552180A (zh) * | 2020-04-30 | 2020-08-18 | 西北工业大学 | 一种绳系卫星系统系绳展开振荡抑制控制方法 |
CN113311863B (zh) * | 2021-05-25 | 2022-07-08 | 南京航空航天大学 | 空间直线型绳系观测系统动力学行为稳定性的判别方法 |
CN113935176B (zh) * | 2021-10-19 | 2022-05-10 | 北京理工大学 | 一种电动力绳离轨装置的高效动力学建模方法 |
CN114253291B (zh) * | 2021-12-15 | 2023-11-14 | 北京航空航天大学 | 基于线性伪谱模型预测控制的航天器编队制导方法和系统 |
CN114895566B (zh) * | 2022-05-24 | 2023-11-10 | 西北工业大学 | 一种采用传递矩阵缩减技术的铣削过程的颤振预测方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6135387A (en) * | 1997-09-17 | 2000-10-24 | Rheinmetall W&M Gmbh | Method for autonomous guidance of a spin-stabilized artillery projectile and autonomously guided artillery projectile for realizing this method |
CN103901894A (zh) * | 2014-04-14 | 2014-07-02 | 西北工业大学 | 二体星型空间绳系编队系统自旋展开与回收最优控制方法 |
CN103914078A (zh) * | 2014-04-10 | 2014-07-09 | 西北工业大学 | 一种二体星型空间绳系编队系统构型保持协调控制方法 |
CN105468011A (zh) * | 2015-12-31 | 2016-04-06 | 北京理工大学 | 一种辐射开环绳系卫星编队匀速自旋展开控制方法 |
CN108319136A (zh) * | 2018-01-18 | 2018-07-24 | 西北工业大学 | 一种基于模型预测的系绳张力控制方法 |
-
2018
- 2018-11-28 CN CN201811432334.0A patent/CN110007681B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6135387A (en) * | 1997-09-17 | 2000-10-24 | Rheinmetall W&M Gmbh | Method for autonomous guidance of a spin-stabilized artillery projectile and autonomously guided artillery projectile for realizing this method |
CN103914078A (zh) * | 2014-04-10 | 2014-07-09 | 西北工业大学 | 一种二体星型空间绳系编队系统构型保持协调控制方法 |
CN103901894A (zh) * | 2014-04-14 | 2014-07-02 | 西北工业大学 | 二体星型空间绳系编队系统自旋展开与回收最优控制方法 |
CN105468011A (zh) * | 2015-12-31 | 2016-04-06 | 北京理工大学 | 一种辐射开环绳系卫星编队匀速自旋展开控制方法 |
CN108319136A (zh) * | 2018-01-18 | 2018-07-24 | 西北工业大学 | 一种基于模型预测的系绳张力控制方法 |
Non-Patent Citations (3)
Title |
---|
Deployment strategies for planar multi-tethered satellite formation;ZhaiGuang,等;《Aerospace Science and Technology》;20171231;第71卷;第475-484页 * |
基于集群空间机器人的合作目标协同定位技术;翟光,等;《北京理工大学学报》;20141031;第34卷(第10期);第1034-1039页 * |
辐射开环绳系卫星编队自旋展开动力学与控制策略;苏飞,等;《航空学报》;20160925;第37卷(第9期);第2809-2819页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110007681A (zh) | 2019-07-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110007681B (zh) | 一种利用连续推进器实现绳系编队自旋稳定展开优化方法 | |
Cai et al. | Quadrotor trajectory tracking and obstacle avoidance by chaotic grey wolf optimization-based active disturbance rejection control | |
CN104345738B (zh) | 一种绳系释放稳定控制方法及电动力绳系末级离轨稳定控制方法 | |
CN107505846B (zh) | 一种空间机械臂系统抗干扰姿态协调验证装置及控制方法 | |
Kazim et al. | Disturbance-rejection-based optimized robust adaptive controllers for UAVs | |
Guo et al. | Controlling a quadrotor carrying a cable-suspended load to pass through a window | |
Wang et al. | Attitude and altitude controller design for quad-rotor type MAVs | |
Liu et al. | Attitude dynamics of electric sail from multibody perspective | |
Liu et al. | Robust attitude control for quadrotors with input time delays | |
CN104309822A (zh) | 一种基于参数优化的航天器单脉冲水滴形绕飞轨迹悬停控制方法 | |
CN109613822A (zh) | 基于非线性模型预测控制的空间系绳系统展开控制方法 | |
Siddhardha | Autonomous reduced-gravity enabling quadrotor test-bed: Design, modelling and flight test analysis | |
Morgan et al. | Decentralized model predictive control of swarms of spacecraft using sequential convex programming | |
Wei et al. | Research on a combinatorial control method for coaxial rotor aircraft based on sliding mode | |
Wang et al. | Optimal variable amplitudes input shaping control for slew maneuver of flexible spacecraft | |
Gong et al. | Spin-stabilized solar sail for displaced solar orbits | |
Kumar | Satellite attitude stabilization using fluid rings | |
Hough et al. | Lyapunov vector fields for thrust-limited spacecraft docking with an elliptically-orbiting uncooperative tumbling target | |
Huang et al. | Pseudospectral method for optimal propellantless rendezvous using geomagnetic Lorentz force | |
Falcoz et al. | Integrated Control and Structure design framework for spacecraft applied to Biomass satellite. | |
CN116520719A (zh) | 适用于挠性航天器姿态动力学全物理仿真的方法及系统 | |
Zhang et al. | Space target surveillance based on non-linear model predictive control | |
Hassan et al. | Modeling, Trimming and Simulation of a Full Scale Helicopter | |
Lyu et al. | Navigation and control scheme for space rendezvous and docking with maneuvering noncooperative target based on dynamic compensation | |
Bestaoui et al. | Geometry of Translational Trajectories for an Autonomous Vehicle With Wind Effect |
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 |