CN111857181B - 分布式航天器编队自适应有限时间姿态协同跟踪控制方法 - Google Patents

分布式航天器编队自适应有限时间姿态协同跟踪控制方法 Download PDF

Info

Publication number
CN111857181B
CN111857181B CN202010721523.0A CN202010721523A CN111857181B CN 111857181 B CN111857181 B CN 111857181B CN 202010721523 A CN202010721523 A CN 202010721523A CN 111857181 B CN111857181 B CN 111857181B
Authority
CN
China
Prior art keywords
spacecraft
attitude
follower
distributed
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
Application number
CN202010721523.0A
Other languages
English (en)
Other versions
CN111857181A (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.)
Yancheng Institute of Technology
Original Assignee
Yancheng Institute of Technology
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 Yancheng Institute of Technology filed Critical Yancheng Institute of Technology
Priority to CN202010721523.0A priority Critical patent/CN111857181B/zh
Publication of CN111857181A publication Critical patent/CN111857181A/zh
Application granted granted Critical
Publication of CN111857181B publication Critical patent/CN111857181B/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, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • 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

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明公开了一种分布式航天器编队自适应有限时间姿态协同跟踪控制方法,方法包括建立仅有部分跟随者航天器可以与领航者航天器进行通信的通信拓扑结构,设计分布式有限时间观测器,实现了跟随者航天器对领航者信息进行观测,并采用快速非奇异终端滑模控制变量使跟随者航天器对领航者航天器进行快速协同和跟踪。本发明提供的方法具有协同时间短、控制精度高的特点。

Description

分布式航天器编队自适应有限时间姿态协同跟踪控制方法
技术领域
本发明涉及多航天器编队飞行技术领域,具体涉及一种分布式航天器编队自适应有限时间姿态协同跟踪控制方法。
背景技术
随着航天任务多样化,由单个航天器独自完成任务的传统工作模式已经难以满足合成孔径成像、太空探测、卫星捕捉、空基干涉测量、远程通信等实际航天任务的需求。在此背景下,多航天器编队飞行研究得到迅速发展,姿态协同作为航天器编队飞行基础技术,成为近年来研究的热点之一。
编队航天器个体之间通过信息传递进行姿态协同控制,从而实现特定的航天任务。多个小型航天器编队解决了传统单个大型航天器所受有效载荷体积和质量等物理性能方面的约束,提高了整体系统的可重构性和鲁棒性。
由于编队航天器特殊的运行环境,航天器之间的通信会受到环境的制约,领航者信息可能无法把参考信息传递给每一个跟随者,且考虑到节约通信资源,需采用仅有部分跟随者可获得领航者参考信息的通信拓扑。与此同时,航天器会受到重力梯度、太阳光压、太阳辐射等引起的未知干扰力矩,并且由于燃料消耗、液体晃动及太阳能帆板转动的影响,导致航天器的转动惯量是时刻变化的且变化程度未知。基于上述情况,目前迫切需要一种分布式航天器编队自适应有限时间姿态协同跟踪控制方法,能够同时考虑通信资源、快速收敛性、外界干扰和惯量不确定性对航天器控制性能的影响,增加姿态协同系统的鲁棒性。
发明内容
本发明的目的:提供一种同时考虑通信资源、快速收敛性、外界干扰和惯量不确定性的分布式航天器编队自适应有限时间姿态协同跟踪控制方法。
技术方案:本发明提供的一种分布式航天器编队自适应有限时间姿态协同跟踪控制方法,包括如下步骤:
步骤A、针对包含n个跟随者航天器和1个领航者航天器的航天器编队系统,在各个航天器的本体坐标系下,建立各个航天器j的姿态运动学方程和动力学方程;j=0,1,2……n,其中,j=0时表示领航者航天器,j=1,2……n时表示跟随航天器;
步骤B、基于领航者航天器的姿态运动学方程和动力学方程,根据领航者航天器的角速度,获取领航者航天器的角加速度、姿态;
步骤C、根据航天器编队系统中各个航天器之间的通信状态构建航天器编队系统的通信拓扑结构,将所述通信拓扑结构以邻接矩阵元素aij表示;若航天器i可以接收到航天器j的信息,aij>0;否则aij=0;其中,i=1,2……n,i≠j;
步骤D、基于有限时间原理和一致性算法,设计分布式有限时间观测器;
步骤E、根据领航者航天器的角速度、角加速度、姿态、航天器编队系统的通信拓扑结构,以及分布式有限时间观测器,获取航天器编队系统中各个跟随者航天器对领航者航天器角速度的估计和姿态的估计;
步骤F、将各个航天器对领航者航天器角速度的估计和姿态的估计输入设定的估计误差系统,获取各个跟随者航天器的角速度跟踪误差估计值、姿态跟踪误差估计值;所述估计误差系统为各跟随者航天器的姿态跟踪误差估计方程和角速度跟踪误差估计方程;
步骤G、分别针对航天器编队系统中的各个跟随者航天器i,执行如下步骤G1至步骤G4:
步骤G1、根据跟随者航天器i和其各邻居航天器的角速度跟踪误差估计值和姿态跟踪误差估计值,构建跟随者航天器i、以及其各邻居航天器分别对应的快速非奇异终端滑模变量,进而设计跟随者航天器i的分布式航天器编队有限时间协同跟踪算法控制器fi1;所述邻居航天器为到跟随者航天器i通信的航天器;
步骤G2、根据跟随者航天器i的快速非奇异终端滑模变量、以及设定的外界干扰和不确定转动惯量自适应补偿控制器参数自适应律,设计跟随者航天器i的外界干扰和不确定转动惯量自适应补偿控制器fi2
步骤G3、根据与跟随者航天器i的分布式航天器编队有限时间协同跟踪算法控制器fi1和跟随者航天器i的外界干扰和不确定转动惯量自适应补偿控制器fi2,设计跟随者航天器i的控制力矩τi=fi1+fi2
步骤G4:跟随者航天器i的执行机构根据控制力矩τi控制航天器,使跟随者航天器i的姿态和领航者航天器的姿态同步,最终实现航天器编队系统中的各航天器姿态一致。
在步骤A中,各个航天器j对应的姿态运动学方程和动力学方程分别如公式(1)和公式(2)所示:
Figure GDA0003750775230000021
Figure GDA0003750775230000022
其中,
Figure GDA0003750775230000023
分别表示航天器j的姿态四元数矢量、航天器j的姿态四元数标量,I是单位矩阵,ωj表示航天器j本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量,
Figure GDA0003750775230000024
Figure GDA0003750775230000025
分别为
Figure GDA0003750775230000026
ωj的导数,
Figure GDA0003750775230000027
表示
Figure GDA0003750775230000028
的转置;
Figure GDA0003750775230000029
分别是
Figure GDA00037507752300000210
ωj的斜对称矩阵;Jj是航天器j转动惯量矩阵,τj和dj分别表示航天器j的执行机构控制力矩和干扰力矩。
在步骤C中,所述航天器编队系统的通信拓扑结构为以领航者航天器为根节点的有向生成树状结构;在该通信拓扑结构中,获取领航者航天器信息的航天器数量为k,k<n。
在步骤D中,所述分布式有限时间观测器包括:如公式(3)所示的分布式参考角加速度有限时间观测器、如公式(4)所示的分布式参考角速度有限时间观测器,以及如公式(5)和公式(6)所示的分布式参考姿态有限时间观测器:
Figure GDA0003750775230000031
Figure GDA0003750775230000032
Figure GDA0003750775230000033
Figure GDA0003750775230000034
式中,
Figure GDA0003750775230000035
分别为跟随者航天器i对领航者航天器姿态的估计的矢量和标量,
Figure GDA0003750775230000036
Figure GDA0003750775230000037
的斜对称矩阵,σi和ρi分别为航天器i对领航者航天器的角速度和角加速度的估计值,
Figure GDA0003750775230000038
分别为跟随者航天器i的邻居航天器j对领航者航天器的姿态的估计的矢量和标量,σj和ρj分别为航天器i的邻居航天器j对领航者航天器的角速度和角加速度的估计值,ω0为领航者航天器的角速度矢量;
Figure GDA0003750775230000039
分别为领导者航天器的姿态矢量和标量,
Figure GDA00037507752300000310
分别为ω0、ρi、σi
Figure GDA00037507752300000311
的导数,
Figure GDA00037507752300000312
表示
Figure GDA00037507752300000313
的转置,α为设定的常数;r1、r2、r3、θ1、θ2、θ3和θ4均为预设的正常数。
在步骤F中,各跟随者航天器的姿态跟踪误差估计方程和角速度跟踪误差估计方程分别如公式(7)和公式(8)所示:
Figure GDA00037507752300000314
ωie=ωi-Ciσi (8)
式中,
Figure GDA00037507752300000315
分别为航天器i的姿态跟踪误差估计矢量和姿态跟踪误差估计值,
Figure GDA00037507752300000316
为航天器i的姿态矢量和姿态标量,
Figure GDA00037507752300000317
表示
Figure GDA00037507752300000318
的转置,ωie表示航天器i的角速度跟踪误差估计,ωi表示航天器i本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量;
其中,
Figure GDA00037507752300000319
Figure GDA00037507752300000320
的斜对称矩阵,
Figure GDA00037507752300000321
表示
Figure GDA00037507752300000322
的转置。
在步骤G1中,航天器i的快速非奇异终端滑模变量Si如公式(9)所示:
Figure GDA00037507752300000323
式中,β1和β2为预设的不可约正奇数,β1>0、β2>0、
Figure GDA0003750775230000041
在步骤G1中,航天器i的分布式航天器编队有限时间协同跟踪算法控制器fi1的表达式如公式(10)所示:
Figure GDA0003750775230000042
式中,Sj为航天器i的邻居航天器j的快速非奇异终端滑模变量,ki=diag(ki1,ki2,ki3),ki1,ki2,ki3是正常数,diag(ki1,ki2,ki3)表示对角矩阵;
sigα(Si)=[sign(Si1)|Si1|α,sign(Si2)|Si2|α,sign(Si3)|Si3|α]T,0<α=α12<1,α1和α2为互质的正奇数,其中:
Figure GDA0003750775230000043
sign(·)为符号函数。
在步骤G2中,航天器i的外界干扰和不确定转动惯量自适应补偿控制器fi2的表达式如下式所示:
Figure GDA0003750775230000044
式中,φi=1+||ωi||+||ωi||2;外界干扰和不确定转动惯量自适应补偿控制器参数自适应律
Figure GDA0003750775230000045
βi1和βi2为大于0的常数。
有益效果:相对于现有技术,本发明提供的优点为:未对未知时变惯量和干扰分别进行估计,控制器结构简单,易于实际工程实现;不需要惯量和外界干扰的任何先验知识,例如惯量的标称值和干扰界值等;领航者轨迹路径为时变的,但同样适用于静态参考位置。
附图说明
图1是根据本发明实施例提供的限幅自适应姿态协同跟踪控制方法原理图;
图2是根据本发明实施例提供的航天器编队系统中的通信拓扑图;
图3是根据本发明实施例提供的航天器1的姿态协同跟踪误差图;
图4是根据本发明实施例提供的航天器1的角速度协同跟踪误差图;
图5是根据本发明实施例提供的航天器2的姿态协同跟踪误差图;
图6是根据本发明实施例提供的航天器2的角速度协同跟踪误差图;
图7是根据本发明实施例提供的航天器3的姿态协同跟踪误差图;
图8是根据本发明实施例提供的航天器3的角速度协同跟踪误差图;
图9是根据本发明实施例提供的航天器4的姿态协同跟踪误差图;
图10是根据本发明实施例提供的航天器4的角速度协同跟踪误差图;
图11是根据本发明实施例提供的航天器1的控制力矩曲线图;
图12是根据本发明实施例提供的航天器2的控制力矩曲线图;
图13是根据本发明实施例提供的航天器3的控制力矩曲线图;
图14是根据本发明实施例提供的航天器4的控制力矩曲线图。
具体实施方式
下面结合附图对本发明作进一步描述。以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
参照图1,本发明提供的分布式航天器编队自适应有限时间姿态协同跟踪控制方法具体包括如下步骤:
步骤1、建立惯量坐标系和本体坐标系,确定航天器的姿态;
步骤2、考虑包含n个跟随者航天器和1个领航者航天器的编队系统,以惯量时变的航天器为研究对象,建立各个航天器的四元数姿态运动学方程和动力学方程:
Figure GDA0003750775230000051
Figure GDA0003750775230000052
其中,
Figure GDA0003750775230000053
是第j个航天器的姿态单位四元数矢量,R表示实数空间,ωj∈R3表示航天器本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量,
Figure GDA0003750775230000054
代表变量的导数,即
Figure GDA0003750775230000055
Figure GDA0003750775230000056
分别为
Figure GDA0003750775230000057
ωj的导数,×表示斜对称矩阵含义,即
Figure GDA0003750775230000058
是ωj=[ωj1j2j3]T的斜对称矩阵
Figure GDA0003750775230000059
ωj1j2j3分别表示ωj的3个元素,Jj∈R3×3是航天器转动惯量矩阵,τj∈R3和dj∈R3分别表示航天器的执行机构控制力矩和干扰力矩,j=0,1,…,n,j=0表示领航者,其它的为跟随者;
步骤3、根据坐标变换建立跟随者航天器i和领航者之间的姿态运动学和动力学跟踪误差方程如下:
Figure GDA00037507752300000510
Figure GDA00037507752300000511
其中,
Figure GDA00037507752300000512
Figure GDA00037507752300000513
是航天器i的姿态四元数误差,且满足
Figure GDA00037507752300000514
Figure GDA0003750775230000061
是领航者的姿态单位四元数,ωi0=ωi-Niω0是角速度跟踪误差,i=1,2,…,n,ω0表示领航者的角速度,
Figure GDA0003750775230000062
是坐标旋转矩阵;
步骤4、利用代数图论描述航天器编队系统的通信拓扑结构,为减少通信路径和避免资源浪费,本发明采用通信量较少的通信拓扑结构,该通信拓扑结构包括一个领航者航天器为根节点的有向生成树,且在航天器编队系统中,仅有部分跟随者航天器可以获得领航者信息,aij是邻接矩阵元素,如果存在从航天器j到i的通信,aij>0;相反,aij=0;bi=ai0为领航者邻接矩阵元素;
步骤5、通过通信拓扑结构,得到各跟随者航天器i的邻居航天器j对领航者的姿态估计
Figure GDA0003750775230000063
角速度估计σj∈R3和角加速度估计ρj∈R3
步骤6、通过有限时间原理和一致性算法,设计分布式有限时间观测器:
Figure GDA0003750775230000064
Figure GDA0003750775230000065
Figure GDA0003750775230000066
Figure GDA0003750775230000067
式中,
Figure GDA0003750775230000068
σi和ρi分别为第i个跟随航天器对领航者状态q0
Figure GDA0003750775230000069
ω0
Figure GDA00037507752300000610
的估计,α为设定的常数,α介于0和1之间的常量,r1、r2、r3、θ1、θ2、θ3和θ4均为正常数;
Figure GDA00037507752300000611
Figure GDA00037507752300000612
分别为ω0、ρi、σi
Figure GDA00037507752300000613
的导数,
Figure GDA00037507752300000614
表示
Figure GDA00037507752300000615
的转置,α为设定的常数,;r1、r2、r3、θ1、θ2、θ3和θ4均为预设的正常数。观测器对领航者信息进行快速观测,得到观测领航者轨迹,作为跟随者航天器的领航者航天器。
其中,分布式参考角加速度有限时间观测器如公式(5)所示,分布式角速度有限时间观测器如公式(6)所示,分布式参考姿态有限时间观测器如公式(7)和公式(8)所示。
步骤7、设计估计误差系统,估计误差系统为各个跟随者航天器的姿态跟踪误差估计方程和角速度跟踪误差估计方程。
各个跟随者航天器的姿态跟踪误差估计方程为:
Figure GDA00037507752300000616
各个跟随者航天器的角速度跟踪误差估计方程为:ωie=ωi-Ciσi
其中,
Figure GDA00037507752300000617
分别为航天器i的姿态跟踪误差估计矢量和姿态跟踪误差估计值,
Figure GDA0003750775230000071
表示航天器i的姿态矢量
Figure GDA0003750775230000072
的转置,ωie表示航天器i的角速度跟踪误差估计,ωi表示航天器i本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量,
Figure GDA0003750775230000073
分别为
Figure GDA0003750775230000074
Figure GDA0003750775230000075
的斜对称矩阵,
Figure GDA0003750775230000076
表示
Figure GDA0003750775230000077
的转置。
步骤8、定义快速非奇异终端滑模变量
Figure GDA0003750775230000078
其中,β1>0、β2>0、
Figure GDA0003750775230000079
Figure GDA00037507752300000710
为不可约正奇数;
步骤9、通过通信拓扑结构,可得到各跟随者航天器i的邻居航天器j的快速非奇异终端滑模变量Sj
步骤10、根据步骤8中跟随者航天器i的快速非奇异终端滑模变量Si以及步骤9中的邻居航天器j的滑模变量Sj,设计分布式航天器编队有限时间协同跟踪算法控制器:
Figure GDA00037507752300000711
式中ki=diag(ki1,ki2,ki3),ki1,ki2,ki3>0是正常数,diag(ki1,ki2,ki3)为对角矩阵,矩阵中的元素为ki1,ki2,ki3,其中:
sigα(Si)=[sign(Si1)|Si1|α,sign(Si2)|Si2|α,sign(Si3)|Si3|α]T,0<α=α12<1,α1和α2是互质的正奇数,sign(·)为符号函数,
Figure GDA00037507752300000712
步骤11、根据自身滑模变量,设计外界干扰和不确定转动惯量自适应补偿控制器
Figure GDA00037507752300000713
其中,φi=1+||ωi||+||ωi||2
设计外界干扰和不确定转动惯量自适应补偿控制器参数自适应律
Figure GDA00037507752300000714
式中,βi1>0,βi2>0;
步骤12、设计分布式有限时间姿态协同跟踪控制器为τi=fi1+fi2,分布式有限时间姿态协同跟踪控制器即为公式(2)中的控制力矩。
步骤13、跟随者航天器i的执行机构根据控制力矩τi控制航天器,使跟随者航天器i的姿态和领航者航天器的姿态同步,最终实现航天器编队系统中的各航天器姿态一致。
本发明提供的分布式航天器编队自适应有限时间姿态协同跟踪控制方法,仅有部分跟随航天器可获得领航者信息的通信拓扑相比较所有跟随航天器可获得领航航天器的通信拓扑结构具有占用更少通信带宽、应用范围更广;有限时间控制器较常规控制器具有协同时间短、控制精度高;未对未知时变惯量和干扰分别进行估计,控制器结构简单,易于实际工程实现;不需要惯量和外界干扰的任何先验知识,例如惯量的标称值和干扰界值等;领航者轨迹路径为时变的,但同样适用于静态参考位置。
参照图2,本实施例提供的分布式航天器编队包括一个领航者航天器和四个跟随者航天器,领航者航天器标注为节点0,四个跟随者航天器分别标注为节点1、2、3、4,其中只有航天器1可以获得领航者的信息。
在本实施例中,领航者航天器的角速度ω0表示为:ω0=[0.1sin(0.2t),0.1cos(0.2t),0.1cos(0.5t)]T,根据运动学方程可以获取领航者航天器的姿态矢量
Figure GDA0003750775230000085
和姿态值
Figure GDA0003750775230000086
四个跟随者航天器的转动惯量矩阵和初始姿态如表1所述:
表1
Figure GDA0003750775230000081
外部的干扰力矩为:di=(0.5+||ωi||2)[0.02sin(t),0.05cos(t),0.03cos(t)]T,i=1,2,3,4。观测器状态和自适应参数初始值为
Figure GDA0003750775230000082
σi(0)=[0,0,0]T,ρi(0)=[0,0,0]T
Figure GDA0003750775230000083
观测器和控制器参数为r1=r2=20,r3=2,θ1=θ3=θ4=1,θ2=0.5,k1=k2=k3=k4=100,β1=2,β2=3,
Figure GDA0003750775230000084
β11=β21=β31=β41=1,β12=β22=β32=50,β42=100。
在MATLAB/Simulink中搭建航天器编队系统模型,仿真时间为30s,通过仿真获取的跟随者航天器1、2、3、4的姿态和角速度的协同跟踪误差曲线如图3至图10所示,根据图3至图10所示的结果可知,跟随者航天器实现了对具有时变参考轨迹的领航者航天器的快速跟踪,根据各图中的内嵌图可以看出姿态误差精度和角速度误差精度分别为4×10-3和5×10-3;根据图11至图14所示的跟随者航天器1、2、3、4的控制力矩曲线图可知,在整个航天器的协同跟踪过程中,控制力矩变化平稳。
根据图3至图14所示的结果可以验证:本发明完善了分布式自适应有限时间姿态协同跟踪控制策略,通过合理的观测器设计和快速非奇异终端滑模设计,实现仅有部分跟随者可获得领航者信息的通信拓扑下的姿态协同控制方法,且能够使航天器协同跟踪误差系统快速的收敛,同时,设计自适应控制项补偿了惯量变化和干扰的影响,进一步提高了控制系统的鲁棒性和实用性。
以上所述仅是本发明的优选实施方式,对于本技术领域的普通技术人员来说,在不脱离本发明技术原理的前提下,还可以做出若干改进和变形,这些改进和变形也应视为本发明的保护范围。

Claims (8)

1.一种分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,所述方法包括如下步骤:
步骤A、针对包含n个跟随者航天器和1个领航者航天器的航天器编队系统,在各个航天器的本体坐标系下,建立各个航天器j的姿态运动学方程和动力学方程;j=0,1,2……n,其中,j=0时表示领航者航天器,j=1,2……n时表示跟随航天器;
步骤B、基于领航者航天器的姿态运动学方程和动力学方程,根据领航者航天器的角速度,获取领航者航天器的角加速度、姿态;
步骤C、根据航天器编队系统中各个航天器之间的通信状态构建航天器编队系统的通信拓扑结构,将所述通信拓扑结构以邻接矩阵元素aij表示;若航天器i可以接收到航天器j的信息,aij>0;否则aij=0;其中,i=1,2……n,i≠j;
步骤D、基于有限时间原理和一致性算法,设计分布式有限时间观测器;
步骤E、根据领航者航天器的角速度、角加速度、姿态、航天器编队系统的通信拓扑结构,以及分布式有限时间观测器,获取航天器编队系统中各个跟随者航天器对领航者航天器角速度的估计和姿态的估计;
步骤F、将各个航天器对领航者航天器角速度的估计和姿态的估计输入设定的估计误差系统,获取各个跟随者航天器的角速度跟踪误差估计值、姿态跟踪误差估计值;所述估计误差系统为各跟随者航天器的姿态跟踪误差估计方程和角速度跟踪误差估计方程;
步骤G、分别针对航天器编队系统中的各个跟随者航天器i,执行如下步骤G1至步骤G4:
步骤G1、根据跟随者航天器i和其各邻居航天器的角速度跟踪误差估计值和姿态跟踪误差估计值,构建跟随者航天器i、以及其各邻居航天器分别对应的快速非奇异终端滑模变量,进而设计跟随者航天器i的分布式航天器编队有限时间协同跟踪算法控制器fi1;所述邻居航天器为到跟随者航天器i通信的航天器;
步骤G2、根据跟随者航天器i的快速非奇异终端滑模变量、以及设定的外界干扰和不确定转动惯量自适应补偿控制器参数自适应律,设计跟随者航天器i的外界干扰和不确定转动惯量自适应补偿控制器fi2
步骤G3、根据与跟随者航天器i的分布式航天器编队有限时间协同跟踪算法控制器fi1和跟随者航天器i的外界干扰和不确定转动惯量自适应补偿控制器fi2,设计跟随者航天器i的控制力矩τi=fi1+fi2
步骤G4:跟随者航天器i的执行机构根据控制力矩τi控制航天器,使跟随者航天器i的姿态和领航者航天器的姿态同步,最终实现航天器编队系统中的各航天器姿态一致。
2.根据权利要求1所述的分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,在步骤A中,各个航天器j对应的姿态运动学方程和动力学方程分别如公式(1)和公式(2)所示:
Figure FDA0003750775220000021
Figure FDA0003750775220000022
其中,
Figure FDA0003750775220000023
分别表示航天器j的姿态四元数矢量、航天器j的姿态四元数标量,I是单位矩阵,ωj表示航天器j本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量,
Figure FDA0003750775220000024
Figure FDA0003750775220000025
分别为
Figure FDA0003750775220000026
ωj的导数,
Figure FDA0003750775220000027
表示
Figure FDA0003750775220000028
的转置;
Figure FDA0003750775220000029
分别是
Figure FDA00037507752200000210
ωj的斜对称矩阵;Jj是航天器j转动惯量矩阵,τj和dj分别表示航天器j的执行机构控制力矩和干扰力矩。
3.根据权利要求1所述的分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,在步骤C中,所述航天器编队系统的通信拓扑结构为以领航者航天器为根节点的有向生成树状结构;在该通信拓扑结构中,获取领航者航天器信息的航天器数量为k,k<n。
4.根据权利要求1所述的分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,在步骤D中,所述分布式有限时间观测器包括:如公式(3)所示的分布式参考角加速度有限时间观测器、如公式(4)所示的分布式参考角速度有限时间观测器,以及如公式(5)和公式(6)所示的分布式参考姿态有限时间观测器:
Figure FDA00037507752200000211
Figure FDA00037507752200000212
Figure FDA00037507752200000213
Figure FDA00037507752200000214
式中,
Figure FDA00037507752200000215
分别为跟随者航天器i对领航者航天器姿态的估计的矢量和标量,
Figure FDA00037507752200000216
Figure FDA00037507752200000217
的斜对称矩阵,σi和ρi分别为航天器i对领航者航天器的角速度和角加速度的估计值,
Figure FDA00037507752200000218
分别为跟随者航天器i的邻居航天器j对领航者航天器的姿态的估计的矢量和标量,σj和ρj分别为航天器i的邻居航天器j对领航者航天器的角速度和角加速度的估计值,ω0为领航者航天器的角速度矢量;
Figure FDA0003750775220000031
分别为领导者航天器的姿态矢量和标量,
Figure FDA0003750775220000032
分别为ω0、ρi、σi
Figure FDA0003750775220000033
的导数,
Figure FDA0003750775220000034
表示
Figure FDA0003750775220000035
的转置,α为设定的常数;r1、r2、r3、θ1、θ2、θ3和θ4均为预设的正常数。
5.根据权利要求4所述的分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,在步骤F中,各跟随者航天器的姿态跟踪误差估计方程和角速度跟踪误差估计方程分别如公式(7)和公式(8)所示:
Figure FDA0003750775220000036
ωie=ωi-Ciσi (8)
式中,
Figure FDA0003750775220000037
分别为航天器i的姿态跟踪误差估计矢量和姿态跟踪误差估计值,
Figure FDA0003750775220000038
为航天器i的姿态矢量和姿态标量,
Figure FDA0003750775220000039
表示
Figure FDA00037507752200000310
的转置,ωie表示航天器i的角速度跟踪误差估计,ωi表示航天器i本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量;
其中,
Figure FDA00037507752200000311
Figure FDA00037507752200000312
Figure FDA00037507752200000313
的斜对称矩阵,
Figure FDA00037507752200000314
表示
Figure FDA00037507752200000315
的转置。
6.根据权利要求5所述的分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,在步骤G1中,航天器i的快速非奇异终端滑模变量Si如公式(9)所示:
Figure FDA00037507752200000316
式中,β1和β2为预设的不可约正奇数,β1>0、β2>0、
Figure FDA00037507752200000317
7.根据权利要求6所述的分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,在步骤G1中,航天器i的分布式航天器编队有限时间协同跟踪算法控制器fi1的表达式如公式(10)所示:
Figure FDA00037507752200000318
式中,Sj为航天器i的邻居航天器j的快速非奇异终端滑模变量,ki=diag(ki1,ki2,ki3),ki1,ki2,ki3是正常数,diag(ki1,ki2,ki3)表示对角矩阵;
其中,sigα(Si)=[sign(Si1)|Si1|α,sign(Si2)|Si2|α,sign(Si3)|Si3|α]T,0<α=α12<1,α1和α2为互质的正奇数,其中:
Figure FDA00037507752200000319
sign(·)为符号函数。
8.根据权利要求6所述的分布式航天器编队自适应有限时间姿态协同跟踪方法,其特征在于,在步骤G2中,航天器i的外界干扰和不确定转动惯量自适应补偿控制器fi2的表达式如下式所示:
Figure FDA0003750775220000041
式中,φi=1+||ωi||+||ωi||2;外界干扰和不确定转动惯量自适应补偿控制器参数自适应律
Figure FDA0003750775220000042
βi1和βi2为大于0的常数。
CN202010721523.0A 2020-07-24 2020-07-24 分布式航天器编队自适应有限时间姿态协同跟踪控制方法 Active CN111857181B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010721523.0A CN111857181B (zh) 2020-07-24 2020-07-24 分布式航天器编队自适应有限时间姿态协同跟踪控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010721523.0A CN111857181B (zh) 2020-07-24 2020-07-24 分布式航天器编队自适应有限时间姿态协同跟踪控制方法

Publications (2)

Publication Number Publication Date
CN111857181A CN111857181A (zh) 2020-10-30
CN111857181B true CN111857181B (zh) 2022-11-11

Family

ID=72949498

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010721523.0A Active CN111857181B (zh) 2020-07-24 2020-07-24 分布式航天器编队自适应有限时间姿态协同跟踪控制方法

Country Status (1)

Country Link
CN (1) CN111857181B (zh)

Families Citing this family (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113406967B (zh) * 2021-06-17 2022-07-15 北京航空航天大学 一种多航天器分布式协同编队控制方法
CN115079715B (zh) * 2021-07-06 2024-05-14 天津大学 角速度及输入约束下分布式航天器编队姿态同步控制方法
CN114415504B (zh) * 2021-12-28 2023-06-20 苏州大学 一种基于自适应控制与迭代学习控制的统一化控制方法
CN115535305B (zh) * 2022-10-08 2023-05-12 哈尔滨工业大学 一种抗振抗饱和的多星分布式定时姿态协同跟踪控制方法
CN116466735B (zh) * 2023-06-12 2023-09-12 中南大学 一种航天器编队姿态定向协同控制方法及相关设备

Family Cites Families (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN109459931A (zh) * 2018-05-09 2019-03-12 南京理工大学 一种航天器编队有限时间姿态容错控制方法
CN108508751A (zh) * 2018-05-09 2018-09-07 南京理工大学 一种输入饱和自适应姿态协同跟踪控制方法
CN109557818B (zh) * 2019-01-10 2021-01-12 南京航空航天大学 具有多故障的多智能体跟踪系统的滑模容错控制方法
CN110456807B (zh) * 2019-07-02 2021-01-12 西北工业大学 一种多航天器一致性动态增益控制方法
CN111284732B (zh) * 2020-03-13 2021-08-03 北京航空航天大学 一种基于事件触发通信的航天器抗干扰姿态协同控制方法

Also Published As

Publication number Publication date
CN111857181A (zh) 2020-10-30

Similar Documents

Publication Publication Date Title
CN111857181B (zh) 分布式航天器编队自适应有限时间姿态协同跟踪控制方法
CN110456807B (zh) 一种多航天器一致性动态增益控制方法
CN111752292B (zh) 一种分布式航天器的姿态协同跟踪控制方法
Liu et al. Robust distributed formation controller design for a group of unmanned underwater vehicles
Ihle et al. Passivity-based designs for synchronized path-following
Wu et al. Decentralized robust adaptive control for attitude synchronization under directed communication topology
CN109189085B (zh) 基于事件触发的航天器网络化系统姿态控制方法
Li et al. Decentralized fault-tolerant control for satellite attitude synchronization
Cui et al. Velocity-observer-based distributed finite-time attitude tracking control for multiple uncertain rigid spacecraft
CN107703742B (zh) 一种柔性航天器传感器故障调节方法
Zou et al. Velocity-free leader–follower cooperative attitude tracking of multiple rigid bodies on SO (3)
CN109459931A (zh) 一种航天器编队有限时间姿态容错控制方法
CN112357119A (zh) 一种输入受限的有限时间姿态协同跟踪容错控制方法
CN115639841B (zh) 一种基于鲁棒牵制的无人机集群编队控制系统及控制方法
CN112000117A (zh) 无角速度反馈的航天器姿态协同跟踪控制方法
Yan et al. Distributed observer-based formation trajectory tracking method of leader-following multi-AUV system
Liu et al. Adaptive fault‐tolerant formation control for quadrotors with actuator faults
CN113296507A (zh) 一种基于时空解耦的多动力定位船舶协同编队控制方法
CN115509248A (zh) 一种基于序列凸优化和模型预测控制的卫星集群重构控制方法
Yu et al. Enhanced recurrent fuzzy neural fault-tolerant synchronization tracking control of multiple unmanned airships via fractional calculus and fixed-time prescribed performance function
CN113220007B (zh) 执行机构故障的挠性航天器有限时间姿态协同控制方法
Xu et al. Distributed fixed-time time-varying formation-containment control for networked underactuated quadrotor UAVs with unknown disturbances
Qu et al. Distributed H∞-consensus filtering for attitude tracking using ground-based radars
CN117891277A (zh) 多航天器仅姿态反馈的分布式抗退绕姿态跟踪控制方法
Sahoo et al. Attitude synchronization of satellites with internal actuation

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