CN114253288A - 多航天器轨道分布式协同跟踪最优控制方法 - Google Patents
多航天器轨道分布式协同跟踪最优控制方法 Download PDFInfo
- Publication number
- CN114253288A CN114253288A CN202111474691.5A CN202111474691A CN114253288A CN 114253288 A CN114253288 A CN 114253288A CN 202111474691 A CN202111474691 A CN 202111474691A CN 114253288 A CN114253288 A CN 114253288A
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- reference point
- equation
- formula
- controller
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 230000000737 periodic effect Effects 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 23
- 150000001875 compounds Chemical class 0.000 claims description 12
- 238000004891 communication Methods 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 230000014759 maintenance of location Effects 0.000 claims description 3
- 239000013598 vector Substances 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 2
- 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 1
- 238000005265 energy consumption Methods 0.000 description 9
- 241000287196 Asthenes Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 239000003795 chemical substances by application Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 230000001360 synchronised effect Effects 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
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
技术领域
本发明涉及一种多航天器的轨道控制方法,特别是一种可对控制器参数进行最优化的多航天器轨道分布式协同跟踪控制方法。
背景技术
“Improved order-reduction method for cooperative tracking control oftime-delayed multi-spacecraft network,Journal of the Franklin Institute,2018,355(5),2849-2873”公开了一种多航天器轨道控制方法。该方法利用多智能体一致性理论,设计了分布式轨道跟踪控制器,并通过线性矩阵不等式方法求解了控制器参数。
文献中所述的方法存在的主要技术问题在于:所求解出的控制器参数是次优的,致使控制器无法保证系统的性能指标最小化,即未达到最佳控制性能。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种可对控制器参数进行最优化的多航天器轨道分布式协同跟踪控制方法。
技术方案
一种多航天器轨道分布式协同跟踪最优控制方法,其特征在于步骤如下:
步骤1:考虑参考点绕地心飞行轨道为圆轨道的情况,构建出航天器与参考点之间的相对轨道动力学及运动学模型,并建立轨道跟踪误差系统方程;
步骤2:针对步骤1中建立的误差系统方程,设计出分布式协同跟踪控制器,并利用最优控制理论求解控制器参数,使系统的控制性能达到最佳;
步骤3:针对步骤1中构建的相对轨道动力学及运动学模型,计算出能够保证航天器围绕参考点进行周期运动的初值条件。
本发明进一步的技术方案:步骤1所述的相对轨道动力学及运动学模型:
式中,下角标i表示第i个航天器,i=0表示领航者航天器,i=1,...,N表示跟随者航天器;pix、piy、piz表示第i个航天器与参考点之间的相对位置在参考点体坐标系下的三轴分量;为参考点在自身轨道内的角速度,μ0=3.986×105kg/m3表示地球引力系数,r0为参考点与地心之间的距离;uix、uiy、uiz表示控制输入在三轴方向上的分量,假设领航者航天器的控制输入为零,即u0x=u0y=u0z=0;
将式(12)化作如下所示的状态空间方程:
式中,
式中,1N=[1,1,...,1]T表示元素均为1的N维列向量,I6表示6阶单位矩阵,表示克罗内克乘积;此外,表示通信拓扑图对应的拉普拉斯矩阵,且有和lij=-aij,其中aij表示航天器之间的相对状态保持增益,当第j个航天器能够向第i个航天器传输信息时,aij=1,否则aij=0;对式(15)求导,可以得到如下跟踪误差系统方程:
本发明进一步的技术方案:步骤2所述的分布式协同跟踪控制器:
式中,矩阵K表示控制器参数;设计控制器参数K=R-1BTP,其中正定矩阵P为如下代数黎卡提方程的解:
PA+ATP+Q-PBR-1BTP=0, (7)
式中,Q≥0,R>0;
本发明进一步的技术方案:步骤3所述的初值条件计算过程如下:
根据式(12),可以得到领航者航天器与参考点之间的相对轨道模型如下:
对式(20)中的微分方程组进行求解,得到如下结果:
式中,p0x(0)、p0y(0)、p0z(0)表示领航者航天器与参考点之间的三轴相对位置初值,表示领航者航天器与参考点之间的三轴相对速度初值;式(21)中的第二个等式中含有漂移项因此,初值条件须满足才能够消除漂移项,使航天器进行周期运动;将代入到式(21)中可得
式中,
有益效果
本发明提出的一种多航天器轨道分布式协同跟踪最优控制方法,考虑参考点轨道为圆轨道的情况,构建出航天器与参考点之间的相对轨道动力学及运动学模型,并建立轨道跟踪误差系统方程。设计出分布式协同跟踪控制器,利用最优控制理论求解控制器参数,使误差系统的控制性能达到最佳,并计算出能够保证航天器围绕参考点进行周期运动的初值条件。本发明提供的方法能够求解出最优控制器参数,实现最佳控制性能。
采用本发明提出的方法能够以较少的能耗来实现较快的轨道跟踪速度。在文献中提出的方法作用下,航天器的轨道跟踪误差同步收敛时间为80秒,100秒内的全局能耗为4.3×104;而在本发明提出的方法作用下,航天器的轨道跟踪误差同步收敛时间仅为40秒,100秒内的全局能耗只有2.7×104。
附图说明
附图仅用于示出具体实施例的目的,而并不认为是对本发明的限制,在整个附图中,相同的参考符号表示相同的部件。
图1是本发明的示意图;
图2是本发明实施例中,5个航天器之间的通讯网络结构图;
图3是本发明实施例中,在本发明提出的方法下航天器的状态跟踪误差范数曲线;
图4是本发明实施例中,在文献提出的方法下航天器的状态跟踪误差范数曲线;
图5是本发明实施例中,在本发明提出的方法下,航天器的全局能耗曲线;
图6是本发明实施例中,在文献提出的方法下,航天器的全局能耗曲线。
具体实施方式
为了使本发明的目的、技术方案及优点更加清楚明白,以下结合附图和实施例,对本发明进行进一步详细说明。应当理解,此处所描述的具体实施例仅用以解释本发明,并不用于限定本发明。此外,下面描述的本发明各个实施方式中所涉及到的技术特征只要彼此之间未构成冲突就可以相互组合。
一种可对控制器参数进行最优化的多航天器轨道分布式协同跟踪控制方法,包括下述步骤:
步骤一:考虑参考点绕地心飞行轨道为圆轨道的情况,构建出航天器与参考点之间的相对轨道动力学及运动学模型,并建立轨道跟踪误差系统方程;
步骤二:针对步骤一中建立的误差系统方程,设计出分布式协同跟踪控制器,并利用最优控制理论求解控制器参数,使系统的控制性能达到最佳;
步骤三:针对步骤一中构建的相对轨道动力学及运动学模型,计算出能够保证航天器围绕参考点进行周期运动的初值条件。
具体如下:
步骤一:考虑参考点绕地心飞行轨道为圆轨道的情况,构建出航天器与参考点之间的相对轨道动力学及运动学模型,并建立轨道跟踪误差系统方程。首先考虑参考点轨道为圆轨道的情况,给出如下相对轨道动力学及运动学模型:
式中,下角标i表示第i个航天器,i=0表示领航者航天器,i=1,...,N表示跟随者航天器;pix、piy、piz表示第i个航天器与参考点之间的相对位置在参考点体坐标系下的三轴分量;为参考点在自身轨道内的角速度,μ0=3.986×105kg/m3表示地球引力系数,r0为参考点与地心之间的距离;uix、uiy、uiz表示控制输入在三轴方向上的分量,假设领航者航天器的控制输入为零,即u0x=u0y=u0z=0。
将式(12)化作如下所示的状态空间方程:
式中,
式中,1N=[1,1,...,1]T表示元素均为1的N维列向量,I6表示6阶单位矩阵,表示克罗内克乘积。此外,表示通信拓扑图对应的拉普拉斯矩阵,且有和lij=-aij,其中aij表示航天器之间的相对状态保持增益,当第j个航天器能够向第i个航天器传输信息时,aij=1,否则aij=0。对式(15)求导,可以得到如下跟踪误差系统方程:
步骤二:针对步骤一中建立的误差系统方程,设计出分布式协同跟踪控制器,并利用最优控制理论求解控制器参数,使系统的控制性能达到最佳。
设计如下分布式协同控制器
式中,矩阵K表示控制器参数。设计控制器参数K=R-1BTP,其中正定矩阵P为如下代数黎卡提方程的解:
PA+ATP+Q-PBR-1BTP=0, (18)
式中,Q≥0,R>0。
步骤三:针对步骤一中构建的相对轨道动力学及运动学模型,计算出能够保证航天器围绕参考点进行周期运动的初值条件。
根据式(12),可以得到领航者航天器与参考点之间的相对轨道模型如下:
对式(20)中的微分方程组进行求解,可以得到如下结果:
式中,p0x(0)、p0y(0)、p0z(0)表示领航者航天器与参考点之间的三轴相对位置初值,表示领航者航天器与参考点之间的三轴相对速度初值。式(21)中的第二个等式中含有漂移项因此,初值条件须满足才能够消除漂移项,使航天器进行周期运动。将代入到式(21)中可得
式中,
采用以下实施例验证本发明的有益效果:
假设多航天器系统中有1个领航者航天器和4个跟随者航天器,描述航天器之间通讯网络的邻接矩阵和拉普拉斯矩阵如下:
选取参考点与地心之间的距离r0=20000km,选取R=5×103I3和Q=10I6,根据式(18),可以计算出控制器参数矩阵如下:
此外,采用文献中的方法,设计如下控制器:
选取航天器的状态初值如下:
其中,领航者航天器的初值x0(0)根据步骤三中的初值选取条件选取。
通过仿真曲线可知,本发明设计的控制器能够保证4个跟随者航天器在40秒内同步跟踪上领航者航天器;而文献中设计的控制器能够保证4个跟随者航天器在80秒内同步跟踪上领航者航天器;在本发明设计的控制器作用下,航天器在100秒内的全局能耗为2.7×104;而在文献中设计的控制器作用下,航天器在100秒内的全局能耗为4.3×104。因此,相比于文献中设计的控制器,本发明所设计的控制器能够以更少的能耗来实现更快的跟踪速度。
本发明未详细介绍的内容(如代数图论、线性矩阵不等式、矩阵论、李雅普诺夫稳定性理论)属于本领域公共常识。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明公开的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。
Claims (4)
1.一种多航天器轨道分布式协同跟踪最优控制方法,其特征在于步骤如下:
步骤1:考虑参考点绕地心飞行轨道为圆轨道的情况,构建出航天器与参考点之间的相对轨道动力学及运动学模型,并建立轨道跟踪误差系统方程;
步骤2:针对步骤1中建立的误差系统方程,设计出分布式协同跟踪控制器,并利用最优控制理论求解控制器参数,使系统的控制性能达到最佳;
步骤3:针对步骤1中构建的相对轨道动力学及运动学模型,计算出能够保证航天器围绕参考点进行周期运动的初值条件。
2.根据权利要求1所述的一种多航天器轨道分布式协同跟踪最优控制方法,其特征在于步骤1所述的相对轨道动力学及运动学模型:
式中,下角标i表示第i个航天器,i=0表示领航者航天器,i=1,...,N表示跟随者航天器;pix、piy、piz表示第i个航天器与参考点之间的相对位置在参考点体坐标系下的三轴分量;为参考点在自身轨道内的角速度,μ0=3.986×105kg/m3表示地球引力系数,r0为参考点与地心之间的距离;uix、uiy、uiz表示控制输入在三轴方向上的分量,假设领航者航天器的控制输入为零,即u0x=u0y=u0z=0;
将式(1)化作如下所示的状态空间方程:
式中,
式中,1N=[1,1,...,1]T表示元素均为1的N维列向量,I6表示6阶单位矩阵,表示克罗内克乘积;此外,表示通信拓扑图对应的拉普拉斯矩阵,且有和lij=-aij,其中aij表示航天器之间的相对状态保持增益,当第j个航天器能够向第i个航天器传输信息时,aij=1,否则aij=0;对式(4)求导,可以得到如下跟踪误差系统方程:
4.根据权利要求1所述的一种多航天器轨道分布式协同跟踪最优控制方法,其特征在于步骤3所述的初值条件计算过程如下:
根据式(1),可以得到领航者航天器与参考点之间的相对轨道模型如下:
对式(9)中的微分方程组进行求解,得到如下结果:
式中,p0x(0)、p0y(0)、p0z(0)表示领航者航天器与参考点之间的三轴相对位置初值,表示领航者航天器与参考点之间的三轴相对速度初值;式(10)中的第二个等式中含有漂移项因此,初值条件须满足才能够消除漂移项,使航天器进行周期运动;将代入到式(10)中可得
式中,
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111474691.5A CN114253288B (zh) | 2021-12-03 | 2021-12-03 | 多航天器轨道分布式协同跟踪最优控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111474691.5A CN114253288B (zh) | 2021-12-03 | 2021-12-03 | 多航天器轨道分布式协同跟踪最优控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114253288A true CN114253288A (zh) | 2022-03-29 |
CN114253288B CN114253288B (zh) | 2024-02-02 |
Family
ID=80794013
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111474691.5A Active CN114253288B (zh) | 2021-12-03 | 2021-12-03 | 多航天器轨道分布式协同跟踪最优控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114253288B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116047986A (zh) * | 2023-03-31 | 2023-05-02 | 山东科技大学 | 一种低通信耦合强度下船舶一致性控制方法 |
CN117666360A (zh) * | 2023-12-20 | 2024-03-08 | 哈尔滨工业大学 | 高阶多自主体集群系统分布式最优一致性控制方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0949143A2 (en) * | 1998-04-10 | 1999-10-13 | Laser Communications International, L.L.C. | Method and apparatus for improved attitude determination of spacecraft |
CN101373386A (zh) * | 2008-09-03 | 2009-02-25 | 东南大学 | 基于投影的多运动体协同路径跟踪控制方法 |
CN111284732A (zh) * | 2020-03-13 | 2020-06-16 | 北京航空航天大学 | 一种基于事件触发通信的航天器抗干扰姿态协同控制方法 |
CN111474950A (zh) * | 2020-04-07 | 2020-07-31 | 哈尔滨工业大学 | 一种基于有向通信拓扑的多航天器姿态协同控制方法 |
US11029709B1 (en) * | 2017-12-28 | 2021-06-08 | United States Of America As Represented By The Administrator Of Nasa | Adaptive wind estimation, trajectory generation, and flight control for aerial systems using motion data |
-
2021
- 2021-12-03 CN CN202111474691.5A patent/CN114253288B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0949143A2 (en) * | 1998-04-10 | 1999-10-13 | Laser Communications International, L.L.C. | Method and apparatus for improved attitude determination of spacecraft |
CN101373386A (zh) * | 2008-09-03 | 2009-02-25 | 东南大学 | 基于投影的多运动体协同路径跟踪控制方法 |
US11029709B1 (en) * | 2017-12-28 | 2021-06-08 | United States Of America As Represented By The Administrator Of Nasa | Adaptive wind estimation, trajectory generation, and flight control for aerial systems using motion data |
CN111284732A (zh) * | 2020-03-13 | 2020-06-16 | 北京航空航天大学 | 一种基于事件触发通信的航天器抗干扰姿态协同控制方法 |
CN111474950A (zh) * | 2020-04-07 | 2020-07-31 | 哈尔滨工业大学 | 一种基于有向通信拓扑的多航天器姿态协同控制方法 |
Non-Patent Citations (3)
Title |
---|
张;王彦恺;: "航天器编队姿态与轨道耦合协同控制器设计", 新型工业化, no. 08 * |
张海博;梅杰;马广富;朱志斌;: "多航天器相对轨道与姿态耦合分布式自适应协同控制", 控制理论与应用, no. 09 * |
张海博;胡庆雷;马广富;朱志斌;: "考虑输入饱和的多航天器系统姿轨耦合分布式协同跟踪控制", 宇航学报, no. 10 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116047986A (zh) * | 2023-03-31 | 2023-05-02 | 山东科技大学 | 一种低通信耦合强度下船舶一致性控制方法 |
CN117666360A (zh) * | 2023-12-20 | 2024-03-08 | 哈尔滨工业大学 | 高阶多自主体集群系统分布式最优一致性控制方法及系统 |
CN117666360B (zh) * | 2023-12-20 | 2024-05-14 | 哈尔滨工业大学 | 高阶多自主体集群系统分布式最优一致性控制方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN114253288B (zh) | 2024-02-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Gu et al. | Distributed containment maneuvering of uncertain under-actuated unmanned surface vehicles guided by multiple virtual leaders with a formation | |
Cichella et al. | Cooperative path following of multiple multirotors over time-varying networks | |
CN114253288A (zh) | 多航天器轨道分布式协同跟踪最优控制方法 | |
Cong et al. | Distributed attitude synchronization of formation flying via consensus-based virtual structure | |
Zou et al. | Velocity-free leader–follower cooperative attitude tracking of multiple rigid bodies on SO (3) | |
CN115639841B (zh) | 一种基于鲁棒牵制的无人机集群编队控制系统及控制方法 | |
Xia et al. | Disturbance observer based fault-tolerant control for cooperative spacecraft rendezvous and docking with input saturation | |
CN113433955B (zh) | 有向切换拓扑下多auv编队队形一致性控制方法 | |
Jiang et al. | Integrated guidance for Mars entry and powered descent using reinforcement learning and pseudospectral method | |
CN111880567A (zh) | 基于深度强化学习的固定翼无人机编队协调控制方法及装置 | |
CN101650569A (zh) | 三维空间中多运动体的寻迹编队控制方法 | |
CN110687915B (zh) | 一种基于无向通信拓扑的航天器编队姿态协同控制方法 | |
CN115639830B (zh) | 一种空地智能体协同编队控制系统及其编队控制方法 | |
CN114237041A (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 | |
CN111439392B (zh) | 一种航天器编队位置协同控制方法 | |
Xia et al. | Neuroadaptive saturated control for relative motion based noncooperative spacecraft proximity with prescribed performance | |
Chang et al. | Cooperative control with adaptive graph Laplacians for spacecraft formation flying | |
CN110488858A (zh) | 一种采用Jordan分解进行编队飞行小推力重构的方法 | |
CN108459611B (zh) | 一种近空间飞行器的姿态跟踪控制方法 | |
CN110174842A (zh) | 空间太阳能发电卫星在轨组装的分布式振动控制器设计方法 | |
CN110032204A (zh) | 输入时延下多空间飞行器姿态协同控制方法 | |
Yang et al. | Novel decentralised formation control for unmanned vehicles | |
Wang et al. | Distance-based formation stabilization and flocking control for distributed multi-agent systems | |
Xia et al. | Finite-horizon optimal linear control for autonomous soft landing of small-scale helicopter |
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 |