编队卫星有限时间构型包含控制方法
技术领域
本发明涉及编队卫星构型包含控制方法。
背景技术
自1957年苏联发射第一颗人造地球卫星,使人类进入太空的梦想成为现实以来,经过50余年的发展,航天技术已成为现代科学技术中最具影响力的高水平技术之一,对世界各国的政治、经济、军事以及人类生活的各个方面都产生了广泛而深远的影响。这些卫星被应用于人类生活的方方面面,如通讯卫星、气象卫星、军事侦察卫星、深空探测等。但是随着航天技术的不断发展,航天任务越来越多样化,使得单一卫星的体积变大,结构也越来越复杂,以适应多变的环境。并且,一旦卫星某结构出现故障,整个任务可能面临失败的危险。因此,20世纪90年代后期,多星协同编队控制方法应运而生。
相对于单星控制,多星系统编队控制具有以下优点:具有更高的灵活性和冗余度、对故障具有较好的容错能力,降低任务失败的风险、更低廉的发射和制造成本、简化日常操作维护、能在近地轨道为科学实验提供分布式空间平台。并且可以根据不同的科研任务,改变卫星间的拓扑结构,实时改变系统性能指标。当前的编队控制按照控制策略的位置不同可以分为主从式和分布式;
吴锦杰等人的《基于对偶四元数的卫星主从式编队姿轨跟踪的优化控制》在对偶四元数的框架下研究了主从式编队卫星相对姿态和相对位置跟踪控制的优化问题。主从结构具有方法成熟、控制器易于实现等优点,但存在单点失败的可能,一旦主星受到摄动影响而偏离轨道,整个编队系统将存在失控的风险。并且,由于主从结构的领航星与跟随星之间没有信息交互,导致整个系统的鲁棒性较差。相比较而言,分布式结构的卫星编队控制策略具有更强的容错性和鲁棒性,近年来成为人们关注的热点。
毕鹏等人的《一种基于一致性理论的航天器编队飞行协同控制方法》利用一致性理论设计了非线性的航天器编队飞行协同控制律,使用的卫星间通讯拓扑为无向图,即要求卫星两两之间存在双向的信息交互。然而在实际应用中,往往不能满足双向通讯,例如某卫星上安装有单向的光学仪器测量其他卫星状态时,则不能按照无向通讯拓扑处理。并且空间飞行时卫星会受摄动影响,大多存在模型不确定性和未知干扰。因此基于有向图且考虑鲁棒性要求的编队卫星协同控制具有较大的研究意义,而多智能体领域的一些研究成果具有较好的借鉴价值。
胡敏等人的《卫星编队飞行有限时间控制方法》利用有限时间控制技术,设计了卫星编队构形维持控制律,为单个领航者的跟踪控制问题。在实际的应用中,类似卫星编队这类多智能体系统,不仅需要所有的编队卫星集合到某一共同状态或跟踪单个领航星,而且要集合到多领航星围成的构形凸包内。这种分布式控制方法称为包含控制,目前已引起了广泛关注。例如多个领航星检测到环境中的危险情况后形成一个安全区域,跟随星通过信息交互与分布式控制律最终运动到该区域内。
《Distributed Containment Control for Lagrangian Networks with ParametricUncertainties under a Directed Graph》考虑了参数不确定性,在存在多个动态领航者的情况下,基于有向图设计了分布式滑模估计器以及自适应算法。但是对于卫星编队问题,构形包含控制的研究结果目前还比较少。对卫星编队问题,有必要考虑有限时间需求的协同控制,因为对实际控制系统的控制行为,需要在一个有限时间内完成,否则应用价值和作用将受到影响。有限时间控制具有更快速的收敛性能、更强大的抗扰动性能以及更广泛的应用范围。《Distributed finite-time attitude containment control for multiple rigid bodies》设计了基于终端滑模控制理论的多智能体包含控制算法,并且证明闭环系统状态可以在有限时间内收敛。
发明内容
本发明为了解决现有的多星系统编队控制方法的鲁棒性较差的问题和使用的卫星间通讯拓扑为无向图不能完全符合实际应用环境的问题。
1、编队卫星有限时间构型包含控制方法,
建立在以下假设的基础上:
(1)所有领航星的时变形式的控制输入τoi=[τoix τoiy τoiz]T对所有跟随星都是未知的,但是其上界信息可以被领航星的相邻跟随星获得,即
(2)广义干扰τdoi是时变且未知的,满足其中为未知、有界的正常数,定义
(3)存在正常数M,使得0<M≤min[|mo1|,…,|moN+m|];
(4)对于任意一个跟随星,至少存在一个领航星有到该跟随星的有向路径;
本方法包括以下步骤:
步骤一:地心惯性坐标系,如图1:原点在地心,OiXi轴沿地球赤道平面与黄道平面的交线,指向春分点γ,OiZi轴指向北极,OiYi轴与OiXi、OiZi轴形成右手旋转坐标系;轨道坐标系,如图2:原点在卫星质心,OoZo轴指向地心方向,OoXo轴在轨道平面上与OoZo轴垂直,指向卫星飞行方向,OoYo轴垂直于轨道平面,与OoXo、OoZo轴形成右手坐标系;轨道坐标系与地心惯性坐标系的相对坐标系,如图3:原点与参考卫星s的质心固连并随其沿轨道运动,X轴与参考卫星的地心矢量rs重合,由地心指向参考卫星s,Y轴在参考卫星的轨道面内垂直于X轴,并指向运动方向,Z轴由右手规则确定;
建立参考卫星和伴随卫星的相对运动动力学方程;
式中:x、y、z,和分别为伴随卫星与参考卫星在轨道坐标系中的相对位置矢量,相对速度矢量和相对加速度矢量在轨道坐标系的三个坐标轴的分量;n为参考卫星的平均角速度μ为地心引力常数,a为参考卫星沿近圆轨道运动的轨道半径,rc为伴随卫星到地心的距离;fx,fy和fz分别为伴随卫星和参考卫星除地心引力外的其他作用力的合力的加速度矢量之差在轨道坐标系的三个坐标轴的分量;
步骤二:在考虑广义干扰(包括未建模动力学、噪声、环境干扰等)的情况下,卫星编队系统及其参考轨道坐标系如图4,编队卫星i对应伴随卫星,相对参考点对应参考卫星,根据公式(1),建立卫星编队系统的编队卫星i与相对参考点的相对轨道动力学模型为:
式中:xi,yi,zi;和别为编队卫星i与参考点在轨道坐标系中的相对位置矢量,相对速度矢量和相对加速度矢量在轨道坐标系的三个坐标轴的分量;n为参考点的平均角速度μ为地心引力常数,R0为参考点沿近圆轨道运动的轨道半径,Ri为编队卫星i到地心的距离;moi为编队卫星i的质量,τoi=[τoix τoiy τoiz]T为作用在编队卫星i上的控制输入;τoix、τoiy、τoiz分别为控制输入在轨道坐标系的三个轴上的分量;τdoi=[τdoix τdoiy τdoiz]T为广义干扰(包括未建模动力学、噪声、环境干扰等);τdoix、τdoiy、τdoiz分别为广义干扰在轨道坐标系的三个轴上的分量;
将得出的卫星编队系统的编队卫星i相对参考点的相对轨道动力学模型转化为如公式(3)的简化形式,
其中pi=(xi,yi,zi)T,
设编队卫星i中有N个跟随星、m个领航星;跟随星记为i1,与i1对应的参数的角标均记为i1;领航星记为i2,与i2对应的参数的角标均记为i2;跟随星的数目大于领航星的数目;
跟随星i1的相对轨道动力学模型为:
领航星i2的相对动力学模型为:
其中为对应领航星的轨迹的控制输入与外界干扰的总和;
步骤三:根据各个编队卫星i的编队形式,对于任意一个跟随星,当至少存在一个领航星有到该跟随星的有向路径,给出卫星编队系统的有向图图论中的加权邻接矩阵A及Laplacian矩阵;
步骤四:根据步骤二得出的跟随星i1的相对轨道动力学模型(4),通过步骤三的拓扑结构中的加权邻接矩阵A及Laplacian矩阵的运算,设计多动态领航星卫星编队系统的分布式有限时间构形包含控制律,实现每个跟随星在有限时间内到达领航星形成的构型凸包内,完成编队卫星有限时间构型包含控制。
本发明具有以下有益效果:
本发明只对跟随星进行控制,而且考虑广义干扰,控制律中只用到相邻编队卫星的信息,是严格的分布式控制,并且此控制为有限时间的包含控制,最终使跟随星在有限时间内进入领航星所形成的凸包内,这使多星系统编队控制具有较好的快速性,并更有实际应用价值,并且使用的卫星间通讯拓扑为有向图符合实际应用环境的问题。由于应用了滑模控制,所以在系统进入滑模面之后具有对外界干扰的不敏感,即可以在存在干扰的情况下依旧完成良好的控制性能。通过仿真分析,本发明的控制精度数值更低,收敛时间更短。
附图说明
图1地心惯性坐标系OiXiYiZi示意图;
图2轨道坐标系OoXoYoZo示意图;
图3相对运动坐标系与地心惯性坐标系的关系示意图;
图4卫星编队系统及其参考轨道坐标系示意图;
图5跟随星与领航星的拓扑图;
图6pi1,i=1,…,13的轨迹图;
图7pi2,i=1,…,13的轨迹图;
图8pi3,i=1,…,13的轨迹图;
图9t=0s跟随星与领航星的相对位置图;
图10t=10s跟随星与领航星的相对位置图;
图11t=15s跟随星与领航星的相对位置图;
图12t=20s跟随星与领航星的相对位置图。
具体实施方式
具体实施方式一:
1、编队卫星有限时间构型包含控制方法,
建立在以下假设的基础上:
(1)所有领航星的时变形式的控制输入τoi=[τoix τoiy τoiz]T对所有跟随星都是未知的,但是其上界信息可以被领航星的相邻跟随星获得,即
(2)广义干扰τdoi是时变且未知的,满足其中为未知、有界的正常数,定义
(3)存在正常数M,使得0<M≤min[|mo1|,…,|moN+m|];
(4)对于任意一个跟随星,至少存在一个领航星有到该跟随星的有向路径;
本方法包括以下步骤:
步骤一:地心惯性坐标系,如图1:原点在地心,OiXi轴沿地球赤道平面与黄道平面的交线,指向春分点γ,OiZi轴指向北极,OiYi轴与OiXi、OiZi轴形成右手旋转坐标系;轨道坐标系,如图2:原点在卫星质心,OoZo轴指向地心方向,OoXo轴在轨道平面上与OoZo轴垂直,指向卫星飞行方向,OoYo轴垂直于轨道平面,与OoXo、OoZo轴形成右手坐标系;轨道坐标系与地心惯性坐标系的相对坐标系,如图3:原点与参考卫星s的质心固连并随其沿轨道运动,X轴与参考卫星的地心矢量rs重合,由地心指向参考卫星s,Y轴rc在参考卫星的轨道面内垂直于X轴,并指向运动方向,Z轴由右手规则确定;
建立参考卫星和伴随卫星的相对运动动力学方程;
式中:x、y、z,和分别为伴随卫星与参考卫星在轨道坐标系中的相对位置矢量,相对速度矢量和相对加速度矢量在轨道坐标系的三个坐标轴的分量;n为参考卫星的平均角速度μ为地心引力常数,a为参考卫星沿近圆轨道运动的轨道半径,rc为伴随卫星到地心的距离;fx,fy和fz分别为伴随卫星和参考卫星除地心引力外的其他作用力的合力的加速度矢量之差在轨道坐标系的三个坐标轴的分量;
步骤二:在考虑广义干扰(包括未建模动力学、噪声、环境干扰等)的情况下,卫星编队系统及其参考轨道坐标系如图4,编队卫星i对应伴随卫星,相对参考点对应参考卫星,根据公式(1),建立卫星编队系统的编队卫星i与相对参考点的相对轨道动力学模型为:
式中:xi,yi,zi;和分别为编队卫星i与参考点在轨道坐标系中的相对位置矢量,相对速度矢量和相对加速度矢量在轨道坐标系的三个坐标轴的分量;n为参考点的平均角速度μ为地心引力常数,R0为参考点沿近圆轨道运动的轨道半径,Ri为编队卫星i到地心的距离;moi为编队卫星i的质量,τoi=[τoix τoiy τoiz]T为作用在编队卫星i上的控制输入;τoix、τoiy、τoiz分别为控制输入在轨道坐标系的三个轴上的分量;τdoi=[τdoix τdoiy τdoiz]T为广义干扰(包括未建模动力学、噪声、环境干扰等);τdoix、τdoiy、τdoiz分别为广义干扰在轨道坐标系的三个轴上的分量;
将得出的卫星编队系统的编队卫星i相对参考点的相对轨道动力学模型转化为如公式(3)的简化形式,
其中pi=(xi,yi,zi)T,i1=1,…,N,,
设编队卫星i中有N个跟随星、m个领航星;跟随星记为i1,与i1对应的参数的角标均记为i1;领航星记为i2,与i2对应的参数的角标均记为i2;跟随星的数目大于领航星的数目;
跟随星i1的相对轨道动力学模型为:
领航星i2的相对动力学模型为:
其中为对应领航星的轨迹的控制输入与外界干扰的总和;
步骤三:根据各个编队卫星i的编队形式,对于任意一个跟随星,当至少存在一个领航星有到该跟随星的有向路径,给出卫星编队系统的有向图图论中的加权邻接矩阵A及Laplacian矩阵;
步骤四:根据步骤二得出的跟随星i1的相对轨道动力学模型(4),通过步骤三的拓扑结构中的加权邻接矩阵A及Laplacian矩阵的运算,设计多动态领航星卫星编队系统的分布式有限时间构形包含控制律,实现每个跟随星在有限时间内到达领航星形成的构型凸包内,完成编队卫星有限时间构型包含控制。
具体实施方式二:
本实施方式的步骤三给出卫星编队系统的有向图图论中的加权邻接矩阵A及Laplacian矩阵的具体实现过程为:
νF={1,…,N}为跟随星集合,νL={N+1,…,N+m}为领航星集合,卫星编队系统的集合为ν=νL∪νF;
编队卫星之间的通讯拓扑用有向图G=(ν,ε)表示,ν为所有节点组成的集合,为所有边组成的集合;对于编队卫星i与j,边(νi,νj)∈ε表示编队卫星j能够接收编队卫星i的信息,但反之并不一定成立;节点νi的邻居定义为满足(νj,νi)∈ε关系的所有编队卫星j的集合,表示为Ni={νj:(νj,νi)∈ε};
有向图G的加权邻接矩阵A=[aij],如果(vj,vi)∈ε那么aij=1,否则aij=0;一般假设节点自身不具有连通性,即aii=0;有向图G的路径是一个有限的节点序列vi1,…,vis,满足(vik,vik+1)∈ε;
在有向图G中,若除了一个节点,即根节点外,其余每个节点有且仅有一个父节点,并且存在根节点到达所有节点的有向路径,那么称该有向图G为有向树;包含有向图G所有节点的有向树称为有向图G的有向生成树;有向图G具有有向生成树是指有向图G包含一个为有向生成树的子图;
Laplacian矩阵表示为L=[lij],定义为和lij=-aij,i≠j;
多领航星卫星编队系统的Laplacian矩阵可写成分块的形式
式中:L1∈RN×N,L2∈RN×m;
定义
则
如果假设对于任意一个跟随星,至少存在一个领航星有到该跟随星的有向路径成立,那么矩阵的每个元素都是非负的。
其他步骤和参数与具体实施方式一相同。
具体实施方式三:
本实施方式的步骤四的具体实现过程为:
首先定义如下误差函数
式中,j1表示区别于i1的跟随星,与j1对应的参数的角标均记为j1;j2表示区别于i2的领航星,与j2对应的参数的角标均记为j2;
选取终端滑模变量
式中,sig(x)α定义为:sig(x)α=|x|αsign(x),sign(i)为符号函数;α,β为实数,并且满足1<α<2,β>0;
分布式构形包含控制律设计为:
式中:i1∈vF,k为实数并且k>0, 为跟随星i1的控制输入,为跟随星j1的控制输入;
为所有领航星的时变形式的控制输入的上界信息,满足假设所有领航星的时变形式的控制输入τoi=[τoix τoiy τoiz]T对所有跟随星都是未知的,但是其上界信息可以被领航星的相邻跟随星获得;其中为未知、有界的正常数,满足M是正常数,满足0<M≤min[|mo1|,…,|moN+m|];
根据编队卫星中的每个跟随星的分布式构形包含控制律(10),实现每个跟随星在有限时间内到达领航星形成的构型凸包内,完成编队卫星有限时间构型包含控制。
所有跟随星在有限时间内趋于领航星形成的构形闭包内的证明如下:
定义如下向量:
Ω=diag(Ω1,…,ΩN), coF=diag(co1,…,coN),coL=diag(coN+1,…,coN+m),
选取如下Lyapunov函数:
对V求导,得到
其中,终端滑模变量简记为s,s的导数及控制律τoi的列向量形式τoF分别为:
又有如下关系式:
将式(15)代入式(14)控制律可整理得到如下形式:
将式(13)和式(16)代入式(12)得:
对式(17)进一步化简得:
通过定义: 得:
可知是可以在有限时间内收敛到0的,即和也可以在有限时间内收敛到0;
由于假设4的存在,则
同理可得所有跟随星在有限时间内趋于领航星形成的构形闭包内。
其他步骤和参数与具体实施方式一或二相同。
实施例
仿真验证中,选取如下参数验证本文提出的分布式有限时间构形包含控制律的有效性。
8个跟随星(编号为1-8),5个领航星(编号为9-13)的情况,参考点运行在近圆轨道上,初始轨道根数为:[aeiΔωf]=[7136.0km 0.001 60° 10° 30° 0°]。其中:a为参考轨道的半长轴,e为偏心率,i为轨道倾角,Δ为升交点赤经,ω为近地点幅角,f为初始时刻的真近点角。
跟随星的相对轨道动力学方程为:
领航星的相对轨道动力学方程为:
领航星与跟随星之间的通讯拓扑,如图5。
跟随星的质量与初始位置,速度与领航星的质量与运动轨迹的信息如表1和表2所示。
表1 跟随星的质量,初始位置与速度表
表2 领航星的质量与运动轨迹表
pi1/m、pi2/m、pi3/m分别是编队系统的编队卫星i的轨迹pi分解在三个坐标轴方向上的轨迹;分别是领航星i2的轨迹pi分解在三个坐标轴方向上的轨迹;
控制参数选取为α=1.8,k=0.8,β=0.1。
上界信息选取为 M=35。
跟随星的模型广义干扰选取为:
在α=1.8,k=0.8,β=0.1时的,仿真结果如图6—12。
性能指标定义为:
(1)精度的定义,通过包含控制的变量的运算可以得到每个跟随星在包含控制理论上要跟踪的曲线qdi,精度数值定义为
(2)收敛时间定义为到达所有精度数值中最大值时所需要的时间。
(3)执行机构积累效果,简称积累效果,定义为:t为收敛时间。
(4)本发明的收敛时间最小值的计算公式为,
非有限时间的滑模选取量为表3-表5分别针对控制变量法,针对α变化,β,k固定不变;β变化,α,k固定不变;k变化,α,β固定不变的情况给出了性能对比。表6给出了本文的算法与非有限时间的性能对比。
表3 β=0.1,k=0.8,α变的性能指标对比表
可以看出在β=0.1,k=0.8不变的情况下,随着α的增大,精度变化不大,但是收敛时间逐渐变短又变长,这是由于公式计算收敛时间关于α的项既出现在分母又出现在初值的幂次上的缘故,执行机构积累效果变化不是很明显。
表4 α=1.8,k=0.8,β变的性能指标对比表
可以看出在α=1.8,k=0.8不变的情况下,随着β的增大精度数值有所降低,但变化不大,收敛时间逐渐减少,这是由于公式计算收敛时间β在分母的位置,随着β的增大,收敛时间变短。同时执行机构积累效果也逐渐增加。
表5 α=1.8,β=0.1,k变的性能指标对比表
可以看出k对收敛时间的影响不大,但趋势是减小的。原因在于k在收敛时间的分母部分,随着k的增加,收敛时间变短。积累效果在收敛时间降低的情况下迅速增加,通过增加k的数值而获取更加小的收敛时间,在考虑能耗的情况下是不明智的。
表6 本发明与非有限时间的的性能指标对比表
通过与非有限时间的对比可以发现,在相同的参数情况下本发明的方法,拥有更加短的收敛时间,更加小的精度数值。并且在到达收敛时间时所需要的能耗更少,性能更加好。