CN111752292A - 一种分布式航天器的姿态协同跟踪控制方法 - Google Patents

一种分布式航天器的姿态协同跟踪控制方法 Download PDF

Info

Publication number
CN111752292A
CN111752292A CN202010636317.XA CN202010636317A CN111752292A CN 111752292 A CN111752292 A CN 111752292A CN 202010636317 A CN202010636317 A CN 202010636317A CN 111752292 A CN111752292 A CN 111752292A
Authority
CN
China
Prior art keywords
spacecraft
attitude
pilot
distributed
angular velocity
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
CN202010636317.XA
Other languages
English (en)
Other versions
CN111752292B (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 CN202010636317.XA priority Critical patent/CN111752292B/zh
Publication of CN111752292A publication Critical patent/CN111752292A/zh
Application granted granted Critical
Publication of CN111752292B publication Critical patent/CN111752292B/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/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • 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

一种分布式航天器的姿态协同跟踪控制方法
技术领域
本发明涉及多航天器编队飞行技术领域,特别是一种分布式航天器的姿态协同跟踪控制方法。
背景技术
随着航天任务多样化,由单个航天器独自完成任务的传统工作模式已经难以满足合成孔径成像、太空探测、卫星捕捉、空基干涉测量、远程通信等实际航天任务的需求。在此背景下,多航天器编队飞行研究得到迅速发展,姿态协同作为航天器编队飞行基础技术,成为近年来研究的热点之一。
编队航天器个体之间通过信息传递进行姿态协同控制,从而实现特定的航天任务。多个小型航天器编队解决了传统单个大型航天器所受有效载荷体积和质量等物理性能方面的约束,提高了整体系统的可重构性和鲁棒性。
由于编队航天器特殊的运行环境,航天器之间的通信会受到环境的制约,领航者信息可能无法把参考信息传递给每一个跟随者,且考虑到节约通信资源,需采用仅有部分跟随者可获得领航者参考信息的通信拓扑。此外,航天器会受到重力梯度、太阳光压、太阳辐射等引起的未知干扰力矩,并且由于燃料消耗、液体晃动及太阳能帆板转动的影响,导致航天器的转动惯量是时刻变化的且变化程度未知。与此同时,航天器的执行机构受本身的物理特性的约束,其输出力矩不可能是任意所需要的控制力,即航天器姿态控制系统控制输入存在饱和问题。
发明内容
本发明所要解决的技术问题是克服现有技术的不足而提供一种分布式航天器的姿态协同跟踪控制方法,本发明能够同时考虑通信资源、输入饱和、快速收敛性、外界干扰和惯量不确定性对航天器控制性能的影响,增加姿态协同系统的鲁棒性。
本发明为解决上述技术问题采用以下技术方案:
根据本发明提出的一种分布式航天器的姿态协同跟踪控制方法,包括以下步骤:
步骤1、建立惯量坐标系和本体坐标系,确定航天器的姿态;
步骤2、考虑包含n个跟随者和1个领航者的航天器编队系统,以惯量时变的航天器为研究对象,建立其四元数姿态运动学和动力学方程;
步骤3、根据坐标变换建立跟随者和领航者之间的姿态运动学和动力学跟踪误差方程;
步骤4、利用代数图论描述航天器编队系统的通信拓扑结构,通信拓扑结构包括一个领航者为根节点的有向生成树且仅有部分跟随者能够获得领航者信息;
步骤5、通过通信拓扑图通信策略,得到各航天器的邻居航天器对领航者的姿态估计值、角速度估计值和角加速度估计值;
步骤6、根据步骤5得到的各航天器的邻居航天器对领航者的姿态估计值、角速度估计值和角加速度估计值,通过有限时间原理和一致性算法,设计分布式有限时间观测器,分布式有限时间观测器对领航者信息进行观测,得到观测领航者轨迹,分布式有限时间观测器作为跟随航天器的领航者;
步骤7、定义姿态跟踪误差估计值和角速度跟踪误差估计值;
步骤8、根据步骤7定义的姿态跟踪误差估计值和角速度跟踪误差估计值,来定义快速非奇异终端滑模变量Si
步骤9、通过通信拓扑图通信策略,得到各航天器的邻居航天器的滑模变量Sj
步骤10、根据步骤8中滑模变量以及步骤9中的邻居航天器的滑模变量,设计分布式航天器编队有限时间协同算法控制器
Figure BDA0002568961960000021
Figure BDA0002568961960000022
式中ki=diag(ki1,ki2,ki3)为第i个航天器的控制增益矩阵,ki1,ki2,ki3>0是正常数,diag(ki1,ki2,ki3)为对角矩阵,aij是邻接矩阵元素即如果存在从第j个航天器到第i个航天器的通信,aij>0,相反,aij=0,sigα(Si)=[sign(Si1)|Si1|α,sign(Si2)|Si2|α,sign(Si3)|Si3|α]T,Si1、Si2和Si3分别为滑模变量Si的第1、2和3个元素,α为指数变量,0<α=α12<1,α1和α2是互质的正奇数,上标T为转置,sign(·)为符号函数;
步骤11、根据自身滑模变量,设计外界干扰和不确定转动惯量自适应补偿控制器
Figure BDA0002568961960000023
其中,
Figure BDA0002568961960000024
为自适应控制参数,变量φi=1+||ωi||+||ωi||2,ωi∈R3表示航天器本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量,R3表示三维实数列向量;
步骤12、根据步骤11中变量φi,设计外界干扰和不确定转动惯量自适应补偿控制器参数自适应律
Figure BDA0002568961960000025
式中,βi1>0和βi2>0为正实数;
步骤13、根据步骤10、11和12得到的变量,设计分布式有限时间姿态协同跟踪控制器Fi
Figure BDA0002568961960000026
步骤14、根据步骤13中控制器Fi,利用饱和约束函数Sat(Fi),设计输入受限的分布式编队航天器的有限时间姿态协同跟踪控制器τi为τi=Sat(Fi)=[Sat(Fi(1)),Sat(Fi(2)),Sat(Fi(3))]T,式中,τi的元素
Figure BDA0002568961960000031
m=1,2,3,Fi(m)表示Fi的第m个矢量元素,Si(m)表示Si的第m个矢量元素,τimax=[τimax(1),τimax(2),τimax(3)]T为航天器执行机构产生的控制力矩受限值,τimax(m)表示控制力矩τimax的第m个矢量元素。
作为本发明所述的一种分布式航天器的姿态协同跟踪控制方法进一步优化方案,步骤2中,运动学和动力学方程如下:
Figure BDA0002568961960000032
Figure BDA0002568961960000033
其中,
Figure BDA0002568961960000034
是第i个航天器的姿态单位四元数,
Figure BDA0002568961960000035
Figure BDA0002568961960000036
分别为姿态四元数的矢量部分和标量部分,R4表示四维实数列向量,I是单位矩阵,ωi∈R3表示航天器本体坐标系相对惯量坐标系在其本体坐标系下的角速度,·代表变量的导数,即
Figure BDA0002568961960000037
Figure BDA0002568961960000038
分别为姿态四元数和角速度的导数,上标T表示转置,×表示斜对称矩阵含义,即
Figure BDA0002568961960000039
是ωi=[ωi1i2i3]T的斜对称矩阵
Figure BDA00025689619600000310
ωi1i2i3为ωi的元素,Ji∈R3×3是航天器转动惯量矩阵,R3×3表示三行三列的实数矩阵,τi∈R3和di∈R3分别表示航天器的执行机构控制力矩和干扰力矩,i=0,1,…,n,i=0表示领航者,其它的为跟随者。
作为本发明所述的一种分布式航天器的姿态协同跟踪控制方法进一步优化方案,步骤3中,随者和领航者之间的姿态运动学和动力学跟踪误差方程如下:
Figure BDA00025689619600000311
Figure BDA00025689619600000312
其中,
Figure BDA00025689619600000313
为姿态误差四元数矢量部分,
Figure BDA00025689619600000314
是姿态误差四元数标量部分且满足
Figure BDA00025689619600000315
Figure BDA00025689619600000316
是领航者的姿态单位四元数,
Figure BDA00025689619600000317
Figure BDA00025689619600000318
分别为领航者的姿态四元数矢量部分和标量部分,ωi0=ωi-Niω0是角速度跟踪误差,i=1,2,…,n,ω0表示领航者的角速度,
Figure BDA0002568961960000041
是坐标旋转矩阵。
作为本发明所述的一种分布式航天器的姿态协同跟踪控制方法进一步优化方案,步骤6中分布式有限时间观测器如下:
Figure BDA0002568961960000042
Figure BDA0002568961960000043
Figure BDA0002568961960000044
Figure BDA0002568961960000045
式中,
Figure BDA0002568961960000046
σi和ρi分别为第i个跟随航天器对领航者状态q0
Figure BDA0002568961960000047
ω0
Figure BDA0002568961960000048
的观测值,r1、r2、r3
Figure BDA0002568961960000049
Figure BDA00025689619600000410
均为正常数,aij是邻接矩阵元素即如果存在从第j个航天器到第i个航天器的通信,aij>0,相反,aij=0,各航天器的邻居航天器对领航者的姿态估计值
Figure BDA00025689619600000411
角速度估计值σj∈R3和角加速度估计值ρj∈R3,ai0用来描述第i个航天器接收领航者信息情况,即如果第i个航天器能够接收到领航者信息ai0=1,否则ai0=0,
Figure BDA00025689619600000412
Figure BDA00025689619600000413
分别为邻居航天器对领航者的姿态估计值的四元数矢量部分和标量部分。
作为本发明所述的一种分布式航天器的姿态协同跟踪控制方法进一步优化方案,步骤7中,定义姿态跟踪误差估计值
Figure BDA00025689619600000414
和角速度跟踪误差估计值ωie为:
Figure BDA00025689619600000415
和ωie=ωi-Ciσi,式中
Figure BDA00025689619600000416
为旋转矩阵,
Figure BDA00025689619600000417
Figure BDA00025689619600000418
分别为姿态跟踪误差四元数估计值矢量部分和标量部分。
作为本发明所述的一种分布式航天器的姿态协同跟踪控制方法进一步优化方案,步骤8中,
Figure BDA00025689619600000419
其中,β1>0和β2>0是正实数,
Figure BDA00025689619600000420
Figure BDA00025689619600000421
为不可约正奇数,
Figure BDA00025689619600000422
Figure BDA00025689619600000423
为函数
Figure BDA00025689619600000424
的指数。
本发明采用以上技术方案与现有技术相比,具有以下技术效果:
本发明对航天器通信资源、姿态协同跟踪收敛时间、输入饱和、外界干扰力矩及转动惯量不确定性的考虑更为完善,具体优点在于:
(1)仅有部分跟随航天器可获得领航者信息的通信拓扑相比较所有跟随航天器可获得领航航天器的通信拓扑结构具有占用更少通信带宽、应用范围更广;
(2)有限时间控制器较常规控制器具有协同时间短、控制精度高;
(3)未对未知时变惯量和干扰分别进行估计,控制器结构简单,易于实际工程实现;
(4)不需要惯量和外界干扰的任何先验知识,例如惯量的标称值和干扰界值等;
(5)深一步考虑执行机构饱和问题,更符合实际工程应用;
(6)领航者轨迹路径为时变的,但同样适用于静态参考位置。
附图说明
图1为本发明的限幅自适应姿态协同跟踪控制方法原理图。
图2为本发明具体实施例中编队航天器之间的通讯拓扑图。
图3a为具体实施例中跟随航天器1的姿态协同跟踪误差图,图3b为跟随航天器1的角速度协同跟踪误差图。
图4a为具体实施例中跟随航天器2的姿态协同跟踪误差图,图4b为跟随航天器2的角速度协同跟踪误差图。
图5a为具体实施例中跟随航天器3的姿态协同跟踪误差图,图5b为跟随航天器3的角速度协同跟踪误差图。
图6a为具体实施例中跟随航天器4的姿态协同跟踪误差图,图6b为跟随航天器4的角速度协同跟踪误差图。
图7a为具体实施例中跟随航天器1的控制力矩曲线图,图7b为跟随航天器2的控制力矩曲线图。
图8a为具体实施例中跟随航天器3的控制力矩曲线图,图8b为跟随航天器4的控制力矩曲线图。
具体实施方式
为了使本发明的目的、技术方案和优点更加清楚,下面将结合附图及具体实施例对本发明进行详细描述。
结合图1,本发明的一种输入饱和的分布式自适应有限时间姿态协同跟踪控制方法,包括以下步骤:
本发明的输入饱和的分布式自适应有限时间姿态协同跟踪控制原理图如图1所示。
步骤1、建立惯量坐标系和本体坐标系,确定航天器的姿态;
步骤2、考虑包含n个跟随者和1个领航者的航天器编队系统,以惯量时变的航天器为研究对象,建立其四元数姿态运动学和动力学方程如下:
Figure BDA0002568961960000061
Figure BDA0002568961960000062
其中,
Figure BDA0002568961960000063
是第i个航天器的姿态单位四元数,
Figure BDA0002568961960000064
Figure BDA0002568961960000065
分别为姿态四元数的矢量部分和标量部分,R4表示四维实数列向量,I是单位矩阵,ωi∈R3表示航天器本体坐标系相对惯量坐标系在其本体坐标系下的角速度,·代表变量的导数,即
Figure BDA0002568961960000066
Figure BDA0002568961960000067
分别为姿态四元数和角速度的导数,上标T表示转置,×表示斜对称矩阵含义,即
Figure BDA0002568961960000068
是ωi=[ωi1i2i3]T的斜对称矩阵
Figure BDA0002568961960000069
ωi1i2i3为ωi的元素,Ji∈R3×3是航天器转动惯量矩阵,R3×3表示三行三列的实数矩阵,τi∈R3和di∈R3分别表示航天器的执行机构控制力矩和干扰力矩,i=0,1,…,n,i=0表示领航者,其它的为跟随者;
步骤3、根据坐标变换建立跟随者和领航者之间的姿态运动学和动力学跟踪误差方程如下:
Figure BDA00025689619600000610
Figure BDA00025689619600000611
其中,
Figure BDA00025689619600000612
为姿态误差四元数矢量部分,
Figure BDA00025689619600000613
是姿态误差四元数标量部分且满足
Figure BDA00025689619600000614
Figure BDA00025689619600000615
是领航者的姿态单位四元数,
Figure BDA00025689619600000616
Figure BDA00025689619600000617
分别为领航者的姿态四元数矢量部分和标量部分,ωi0=ωi-Niω0是角速度跟踪误差,i=1,2,…,n,ω0表示领航者的角速度,
Figure BDA00025689619600000618
是坐标旋转矩阵;
步骤4、利用代数图论描述航天器编队系统的通信拓扑结构,为减少通信路径和避免资源浪费,本发明采用通信量较少的通信拓扑结构,其包括一个领航者为根节点的有向生成树且仅有部分跟随者可以获得领航者信息,aij是邻接矩阵元素,如果存在从航天器j到i的通信,aij>0;相反,aij=0;bi=ai0为领航者邻接矩阵元素;
步骤5、通过通信拓扑图通信策略,可得到各航天器的邻居航天器对领航者的姿态估计
Figure BDA00025689619600000619
角速度估计σj∈R3和角加速度估计ρj∈R3
步骤6、通过有限时间原理和一致性算法,设计分布式有限时间观测器
Figure BDA0002568961960000071
Figure BDA0002568961960000072
Figure BDA0002568961960000073
Figure BDA0002568961960000074
式中,
Figure BDA0002568961960000075
σi和ρi分别为第i个跟随航天器对领航者状态q0
Figure BDA0002568961960000076
ω0
Figure BDA0002568961960000077
的观测值,r1、r2、r3
Figure BDA0002568961960000078
Figure BDA0002568961960000079
均为正常数,aij是邻接矩阵元素即如果存在从第j个航天器到第i个航天器的通信,aij>0,相反,aij=0,各航天器的邻居航天器对领航者的姿态估计值
Figure BDA00025689619600000710
角速度估计值σj∈R3和角加速度估计值ρj∈R3,ai0用来描述第i个航天器接收领航者信息情况,即如果第i个航天器能够接收到领航者信息ai0=1,否则ai0=0,
Figure BDA00025689619600000711
Figure BDA00025689619600000712
分别为邻居航天器对领航者的姿态估计值的四元数矢量部分和标量部分;
步骤7、定义姿态跟踪误差估计值
Figure BDA00025689619600000713
和角速度跟踪误差估计值ωie
Figure BDA00025689619600000714
和ωie=ωi-Ciσi,式中
Figure BDA00025689619600000715
为旋转矩阵,
Figure BDA00025689619600000716
Figure BDA00025689619600000717
分别为姿态跟踪误差四元数估计值矢量部分和标量部分。
步骤8、定义快速非奇异终端滑模变量
Figure BDA00025689619600000718
其中,β1>0和β2>0是正实数,
Figure BDA00025689619600000719
Figure BDA00025689619600000720
为不可约正奇数,
Figure BDA00025689619600000721
Figure BDA00025689619600000722
为函数
Figure BDA00025689619600000723
的指数
步骤9、通过通信拓扑图通信策略,可得到各航天器的邻居航天器的快速非奇异终端滑模变量Sj
步骤10、根据步骤8中滑模变量以及步骤9中的邻居航天器的滑模变量,设计分布式航天器编队有限时间协同算法控制器
Figure BDA00025689619600000724
Figure BDA00025689619600000725
式中ki=diag(ki1,ki2,ki3)为第i个航天器的控制增益矩阵,ki1,ki2,ki3>0是正常数,diag(ki1,ki2,ki3)为对角矩阵,aij是邻接矩阵元素即如果存在从第j个航天器到第i个航天器的通信,aij>0,相反,aij=0,sigα(Si)=[sign(Si1)|Si1|α,sign(Si2)|Si2|α,sign(Si3)|Si3|α]T,Si1、Si2和Si3分别为滑模变量Si的第1、2和3个元素,α为指数变量,0<α=α12<1,α1和α2是互质的正奇数,上标T为转置,sign(·)为符号函数;;
步骤11、根据自身滑模变量,设计外界干扰和不确定转动惯量自适应补偿控制器
Figure BDA0002568961960000081
其中,
Figure BDA0002568961960000082
为自适应控制参数,变量φi=1+||ωi||+||ωi||2,ωi∈R3表示航天器本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量,R3表示三维实数列向量;
步骤12、根据步骤11中变量φi,设计外界干扰和不确定转动惯量自适应补偿控制器参数自适应律
Figure BDA0002568961960000083
式中,βi1>0和βi2>0为正实数;
步骤13、根据步骤10、11和12得到的变量,设计分布式有限时间姿态协同跟踪控制器Fi
Figure BDA0002568961960000084
步骤14、根据步骤13中控制器Fi,利用饱和约束函数Sat(Fi),设计输入受限的分布式编队航天器的有限时间姿态协同跟踪控制器τi为τi=Sat(Fi)=[Sat(Fi(1)),Sat(Fi(2)),Sat(Fi(3))]T,式中,τi的元素
Figure BDA0002568961960000085
m=1,2,3,Fi(m)表示Fi的第m个矢量元素,Si(m)表示Si的第m个矢量元素,τimax=[τimax(1),τimax(2),τimax(3)]T为航天器执行机构产生的控制力矩受限值,τimax(m)表示控制力矩τimax的第m个矢量元素。
实施例
采用一个由4个跟随航天器和1个领导者构成的编队系统作为研究对象,图2给出了一种有向通信拓扑,包括4个跟随航天器(标注为节点1,2,3,4)和1个领航者(标注为节点0),可以看出,仅有第1个航天器能够获得领航者的信息。
领导者轨迹:ω0=[0.1sin(0.2t),0.1cos(0.2t),0.1cos(0.5t)]T
Figure BDA0002568961960000086
Figure BDA0002568961960000087
可通过运动学方程(1)获得。
四个跟随航天器具体参数如下:
表1.航天器惯量矩阵及初始姿态
Figure BDA0002568961960000091
输入饱和值为τ1max=[3,1,2]TNm,τ2max=[4,2,2]TNm,τ3max=[2,3,2]TNm,τ4max=[4,2,2]TNm。外部干扰di=(0.5+||ωi||2)[0.02sin(t),0.05cos(t),0.03cos(t)]T,i=1,2,3,4。观测器状态和自适应参数初始值为
Figure BDA0002568961960000092
σi(0)=[0,0,0]T,ρi(0)=[0,0,0]T
Figure BDA0002568961960000093
观测器和控制器参数为r1=r2=20,r3=0.5,
Figure BDA0002568961960000094
k1=100,k2=k3=k4=150,β1=1,β2=5,
Figure BDA0002568961960000095
α=7/9,β11=β21=β31=β41=1,β12=β22=β32=50,β42=100。
首先,在MATLAB/Simulink中搭建航天器编队系统模型,仿真时间为30s。
航天器的姿态及角速度协同跟踪误差曲线如这几个图所示:图3a为具体实施例中跟随航天器1的姿态协同跟踪误差图,图3b为跟随航天器1的角速度协同跟踪误差图;图4a为具体实施例中跟随航天器2的姿态协同跟踪误差图,图4b为跟随航天器2的角速度协同跟踪误差图;图5a为具体实施例中跟随航天器3的姿态协同跟踪误差图,图5b为跟随航天器3的角速度协同跟踪误差图;图6a为具体实施例中跟随航天器4的姿态协同跟踪误差图,图6b为跟随航天器4的角速度协同跟踪误差图。从误差曲线图中可以看到跟随者实现了对具有时变参考轨迹的领导者航天器的快速跟踪,从误差放大图(内嵌图)可以看出误差精度达到10-4数量级。
图7a为具体实施例中跟随航天器1的控制力矩曲线图,图7b为跟随航天器2的控制力矩曲线图,图8a为具体实施例中跟随航天器3的控制力矩曲线图,图8b为跟随航天器4的控制力矩曲线图,这几个图给出了航天器1、2、3、4的控制力矩曲线图,可以看出,在整个航天器协同跟踪过程中,跟踪前期出现航天器控制力矩输入饱和情况。
由上述实施例,可以验证本发明完善了输入饱和的分布式自适应有限时间姿态协同跟踪控制策略,通过合理的观测器设计和快速非奇异终端滑模设计,实现仅有部分跟随者可获得领航者信息的通信拓扑下的姿态协同控制方法,且能够使航天器协同跟踪误差系统快速的收敛,同时,设计自适应控制项补偿了惯量变化和干扰的影响,进一步提高了控制系统的鲁棒性和实用性。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到的变化或替换,都应涵盖在本发明的保护范围内。

Claims (6)

1.一种分布式航天器的姿态协同跟踪控制方法,其特征在于,包括以下步骤:
步骤1、建立惯量坐标系和本体坐标系,确定航天器的姿态;
步骤2、考虑包含n个跟随者和1个领航者的航天器编队系统,以惯量时变的航天器为研究对象,建立其四元数姿态运动学和动力学方程;
步骤3、根据坐标变换建立跟随者和领航者之间的姿态运动学和动力学跟踪误差方程;
步骤4、利用代数图论描述航天器编队系统的通信拓扑结构,通信拓扑结构包括一个领航者为根节点的有向生成树且仅有部分跟随者能够获得领航者信息;
步骤5、通过通信拓扑图通信策略,得到各航天器的邻居航天器对领航者的姿态估计值、角速度估计值和角加速度估计值;
步骤6、根据步骤5得到的各航天器的邻居航天器对领航者的姿态估计值、角速度估计值和角加速度估计值,通过有限时间原理和一致性算法,设计分布式有限时间观测器,分布式有限时间观测器对领航者信息进行观测,得到观测领航者轨迹,分布式有限时间观测器作为跟随航天器的领航者;
步骤7、定义姿态跟踪误差估计值和角速度跟踪误差估计值;
步骤8、根据步骤7定义的姿态跟踪误差估计值和角速度跟踪误差估计值,来定义快速非奇异终端滑模变量Si
步骤9、通过通信拓扑图通信策略,得到各航天器的邻居航天器的滑模变量Sj
步骤10、根据步骤8中滑模变量以及步骤9中的邻居航天器的滑模变量,设计分布式航天器编队有限时间协同算法控制器
Figure FDA0002568961950000011
Figure FDA0002568961950000012
式中ki=diag(ki1,ki2,ki3)为第i个航天器的控制增益矩阵,ki1,ki2,ki3>0是正常数,diag(ki1,ki2,ki3)为对角矩阵,aij是邻接矩阵元素即如果存在从第j个航天器到第i个航天器的通信,aij>0,相反,aij=0,sigα(Si)=[sign(Si1)|Si1|α,sign(Si2)|Si2|α,sign(Si3)|Si3|α]T,Si1、Si2和Si3分别为滑模变量Si的第1、2和3个元素,α为指数变量,0<α=α12<1,α1和α2是互质的正奇数,上标T为转置,sign(·)为符号函数;
步骤11、根据自身滑模变量,设计外界干扰和不确定转动惯量自适应补偿控制器
Figure FDA0002568961950000021
其中,
Figure FDA0002568961950000022
为自适应控制参数,变量φi=1+||ωi||+||ωi||2,ωi∈R3表示航天器本体坐标系相对惯量坐标系在其本体坐标系下的角速度矢量,R3表示三维实数列向量;
步骤12、根据步骤11中变量φi,设计外界干扰和不确定转动惯量自适应补偿控制器参数自适应律
Figure FDA0002568961950000023
式中,βi1>0和βi2>0为正实数;
步骤13、根据步骤10、11和12得到的变量,设计分布式有限时间姿态协同跟踪控制器Fi
Figure FDA0002568961950000024
步骤14、根据步骤13中控制器Fi,利用饱和约束函数Sat(Fi),设计输入受限的分布式编队航天器的有限时间姿态协同跟踪控制器τi为τi=Sat(Fi)=[Sat(Fi(1)),Sat(Fi(2)),Sat(Fi(3))]T,式中,τi的元素
Figure FDA0002568961950000025
Fi(m)表示Fi的第m个矢量元素,Si(m)表示Si的第m个矢量元素,τimax=[τimax(1),τimax(2),τimax(3)]T为航天器执行机构产生的控制力矩受限值,τimax(m)表示控制力矩τimax的第m个矢量元素。
2.根据权利要求1所述的一种分布式航天器的姿态协同跟踪控制方法,其特征在于,步骤2中,运动学和动力学方程如下:
Figure FDA0002568961950000026
Figure FDA0002568961950000027
其中,
Figure FDA0002568961950000028
是第i个航天器的姿态单位四元数,
Figure FDA0002568961950000029
Figure FDA00025689619500000210
分别为姿态四元数的矢量部分和标量部分,R4表示四维实数列向量,I是单位矩阵,ωi∈R3表示航天器本体坐标系相对惯量坐标系在其本体坐标系下的角速度,·代表变量的导数,即
Figure FDA00025689619500000211
Figure FDA00025689619500000212
分别为姿态四元数和角速度的导数,上标T表示转置,×表示斜对称矩阵含义,即
Figure FDA00025689619500000213
是ωi=[ωi1i2i3]T的斜对称矩阵
Figure FDA00025689619500000214
ωi1i2i3为ωi的元素,Ji∈R3×3是航天器转动惯量矩阵,R3×3表示三行三列的实数矩阵,τi∈R3和di∈R3分别表示航天器的执行机构控制力矩和干扰力矩,i=0,1,…,n,i=0表示领航者,其它的为跟随者。
3.根据权利要求2所述的一种分布式航天器的姿态协同跟踪控制方法,其特征在于,步骤3中,随者和领航者之间的姿态运动学和动力学跟踪误差方程如下:
Figure FDA0002568961950000031
Figure FDA0002568961950000032
其中,
Figure FDA0002568961950000033
为姿态误差四元数矢量部分,
Figure FDA0002568961950000034
是姿态误差四元数标量部分且满足
Figure FDA0002568961950000035
Figure FDA0002568961950000036
是领航者的姿态单位四元数,
Figure FDA0002568961950000037
Figure FDA0002568961950000038
分别为领航者的姿态四元数矢量部分和标量部分,ωi0=ωi-Niω0是角速度跟踪误差,i=1,2,…,n,ω0表示领航者的角速度,
Figure FDA0002568961950000039
是坐标旋转矩阵。
4.根据权利要求2所述的一种分布式航天器的姿态协同跟踪控制方法,其特征在于,步骤6中分布式有限时间观测器如下:
Figure FDA00025689619500000310
Figure FDA00025689619500000311
Figure FDA00025689619500000312
Figure FDA00025689619500000313
式中,
Figure FDA00025689619500000314
σi和ρi分别为第i个跟随航天器对领航者状态q0
Figure FDA00025689619500000315
ω0
Figure FDA00025689619500000316
的观测值,r1、r2、r3、θ1、θ2、θ3和θ4均为正常数,aij是邻接矩阵元素即如果存在从第j个航天器到第i个航天器的通信,aij>0,相反,aij=0,各航天器的邻居航天器对领航者的姿态估计值
Figure FDA00025689619500000317
角速度估计值σj∈R3和角加速度估计值ρj∈R3,ai0用来描述第i个航天器接收领航者信息情况,即如果第i个航天器能够接收到领航者信息ai0=1,否则ai0=0,
Figure FDA0002568961950000041
Figure FDA0002568961950000042
分别为邻居航天器对领航者的姿态估计值的四元数矢量部分和标量部分。
5.根据权利要求4所述的一种分布式航天器的姿态协同跟踪控制方法,其特征在于,步骤7中,定义姿态跟踪误差估计值
Figure FDA0002568961950000043
和角速度跟踪误差估计值ωie为:
Figure FDA0002568961950000044
和ωie=ωi-Ciσi,式中
Figure FDA0002568961950000045
为旋转矩阵,
Figure FDA0002568961950000046
Figure FDA0002568961950000047
分别为姿态跟踪误差四元数估计值矢量部分和标量部分。
6.根据权利要求5所述的一种分布式航天器的姿态协同跟踪控制方法,其特征在于,步骤8中,
Figure FDA0002568961950000048
其中,β1>0和β2>0是正实数,
Figure FDA0002568961950000049
Figure FDA00025689619500000410
为不可约正奇数,
Figure FDA00025689619500000411
Figure FDA00025689619500000412
为函数
Figure FDA00025689619500000413
的指数。
CN202010636317.XA 2020-07-03 2020-07-03 一种分布式航天器的姿态协同跟踪控制方法 Active CN111752292B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202010636317.XA CN111752292B (zh) 2020-07-03 2020-07-03 一种分布式航天器的姿态协同跟踪控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202010636317.XA CN111752292B (zh) 2020-07-03 2020-07-03 一种分布式航天器的姿态协同跟踪控制方法

Publications (2)

Publication Number Publication Date
CN111752292A true CN111752292A (zh) 2020-10-09
CN111752292B CN111752292B (zh) 2022-09-02

Family

ID=72679106

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202010636317.XA Active CN111752292B (zh) 2020-07-03 2020-07-03 一种分布式航天器的姿态协同跟踪控制方法

Country Status (1)

Country Link
CN (1) CN111752292B (zh)

Cited By (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112363535A (zh) * 2020-11-23 2021-02-12 南京邮电大学 一种领导-跟随型多飞行器的分布式协同控制方法
CN113625744A (zh) * 2021-06-29 2021-11-09 南京理工大学 攻击高机动目标的抗饱和固定时间协同制导律
CN114861435A (zh) * 2022-04-29 2022-08-05 南京航空航天大学 有限时间观测器下的多智能体系统一致性滑模控制算法
CN115079715A (zh) * 2021-07-06 2022-09-20 天津大学 角速度及输入约束下分布式航天器编队姿态同步控制方法
CN117184452A (zh) * 2023-10-07 2023-12-08 四川大学 一种分布式无模型预设时间预设性能姿态跟踪控制方法
CN117193356A (zh) * 2023-09-05 2023-12-08 哈尔滨工业大学 基于分布式状态观测器的航天器编队预设时间预设精度的姿态协同控制方法及其控制系统
CN117311375A (zh) * 2023-10-16 2023-12-29 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) 有向通信多航天器分布式容错姿态协同控制方法

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105404304A (zh) * 2015-08-21 2016-03-16 北京理工大学 基于归一化神经网络的航天器容错姿态协同跟踪控制方法
US9694918B1 (en) * 2016-05-26 2017-07-04 Beihang University Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage
CN108508751A (zh) * 2018-05-09 2018-09-07 南京理工大学 一种输入饱和自适应姿态协同跟踪控制方法
CN108628330A (zh) * 2018-05-09 2018-10-09 南京理工大学 一种航天器限幅自适应姿态协同容错控制方法
CN110687915A (zh) * 2019-10-17 2020-01-14 哈尔滨工业大学 一种基于无向通信拓扑的航天器编队姿态协同控制方法

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105404304A (zh) * 2015-08-21 2016-03-16 北京理工大学 基于归一化神经网络的航天器容错姿态协同跟踪控制方法
US9694918B1 (en) * 2016-05-26 2017-07-04 Beihang University Method for disturbance compensation based on sliding mode disturbance observer for spacecraft with large flexible appendage
CN108508751A (zh) * 2018-05-09 2018-09-07 南京理工大学 一种输入饱和自适应姿态协同跟踪控制方法
CN108628330A (zh) * 2018-05-09 2018-10-09 南京理工大学 一种航天器限幅自适应姿态协同容错控制方法
CN110687915A (zh) * 2019-10-17 2020-01-14 哈尔滨工业大学 一种基于无向通信拓扑的航天器编队姿态协同控制方法

Cited By (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112363535A (zh) * 2020-11-23 2021-02-12 南京邮电大学 一种领导-跟随型多飞行器的分布式协同控制方法
CN112363535B (zh) * 2020-11-23 2022-11-08 南京邮电大学 一种领导-跟随型多飞行器的分布式协同控制方法
CN113625744A (zh) * 2021-06-29 2021-11-09 南京理工大学 攻击高机动目标的抗饱和固定时间协同制导律
CN113625744B (zh) * 2021-06-29 2023-02-24 南京理工大学 攻击高机动目标的抗饱和固定时间协同制导律的设计方法
CN115079715A (zh) * 2021-07-06 2022-09-20 天津大学 角速度及输入约束下分布式航天器编队姿态同步控制方法
CN115079715B (zh) * 2021-07-06 2024-05-14 天津大学 角速度及输入约束下分布式航天器编队姿态同步控制方法
CN114861435A (zh) * 2022-04-29 2022-08-05 南京航空航天大学 有限时间观测器下的多智能体系统一致性滑模控制算法
CN114861435B (zh) * 2022-04-29 2024-06-11 南京航空航天大学 有限时间观测器下的多智能体系统一致性滑模控制算法
CN117193356A (zh) * 2023-09-05 2023-12-08 哈尔滨工业大学 基于分布式状态观测器的航天器编队预设时间预设精度的姿态协同控制方法及其控制系统
CN117184452A (zh) * 2023-10-07 2023-12-08 四川大学 一种分布式无模型预设时间预设性能姿态跟踪控制方法
CN117184452B (zh) * 2023-10-07 2024-06-11 四川大学 一种分布式无模型预设时间预设性能姿态跟踪控制方法
CN117311375A (zh) * 2023-10-16 2023-12-29 哈尔滨工业大学(深圳)(哈尔滨工业大学深圳科技创新研究院) 有向通信多航天器分布式容错姿态协同控制方法

Also Published As

Publication number Publication date
CN111752292B (zh) 2022-09-02

Similar Documents

Publication Publication Date Title
CN111752292B (zh) 一种分布式航天器的姿态协同跟踪控制方法
CN111857181B (zh) 分布式航天器编队自适应有限时间姿态协同跟踪控制方法
Liu et al. Robust distributed formation controller design for a group of unmanned underwater vehicles
CN109459931A (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
CN112357119A (zh) 一种输入受限的有限时间姿态协同跟踪容错控制方法
CN106773679B (zh) 一种基于角速度观测器的航天器容错控制方法
CN107450588B (zh) 一种挠性航天器姿态控制系统的强抗扰控制方法
Mahmood et al. Decentrailized formation flight control of quadcopters using robust feedback linearization
Cong et al. Distributed attitude synchronization of formation flying via consensus-based virtual structure
Yang et al. Attitude tracking control for spacecraft formation with time-varying delays and switching topology
CN112000117A (zh) 无角速度反馈的航天器姿态协同跟踪控制方法
Xia et al. Disturbance observer based fault-tolerant control for cooperative spacecraft rendezvous and docking with input saturation
Lee Geometric controls for a tethered quadrotor UAV
Zhang et al. Fully distributed time-varying formation tracking control for multiple quadrotor vehicles via finite-time convergent extended state observer
CN108628330A (zh) 一种航天器限幅自适应姿态协同容错控制方法
CN114326760B (zh) 一种针对干扰与无角速度反馈的姿态协同跟踪控制方法
CN108508751A (zh) 一种输入饱和自适应姿态协同跟踪控制方法
Min et al. Distributed six degree-of-freedom spacecraft formation control with possible switching topology
Chen et al. Shape control of spacecraft formation using a virtual spring-damper mesh
CN113220007B (zh) 执行机构故障的挠性航天器有限时间姿态协同控制方法
CN117311375B (zh) 有向通信多航天器分布式容错姿态协同控制方法
Azadmanesh et al. Synchronization of angular velocities of chaotic leader-follower satellites using a novel integral terminal sliding mode controller
CN111474950A (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