CN114253288B - 多航天器轨道分布式协同跟踪最优控制方法 - Google Patents
多航天器轨道分布式协同跟踪最优控制方法 Download PDFInfo
- Publication number
- CN114253288B CN114253288B CN202111474691.5A CN202111474691A CN114253288B CN 114253288 B CN114253288 B CN 114253288B CN 202111474691 A CN202111474691 A CN 202111474691A CN 114253288 B CN114253288 B CN 114253288B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- reference point
- orbit
- equation
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 58
- 230000000737 periodic effect Effects 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 21
- 238000004891 communication Methods 0.000 claims description 5
- 238000010586 diagram Methods 0.000 claims description 4
- 230000000750 progressive effect 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 8
- 230000005484 gravity Effects 0.000 description 2
- 230000001360 synchronised effect Effects 0.000 description 2
- 239000003795 chemical substances by application Substances 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
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)化作如下所示的状态空间方程:
式中,
定义领航者航天器与第i个跟随者航天器间的跟踪误差变量则可以得到如下全局误差变量:
式中,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;
选取李雅普诺夫函数为则利用李雅普诺夫稳定性理论可以证明,式(17)所设计出的控制器能够保证系统(16)渐进稳定;
选取目标函数其中/>利用最优控制理论可以证明,式(17)所设计出的控制器能够保证系统(16)的如下性能指标最优:
本发明进一步的技术方案:步骤3所述的初值条件计算过程如下:
根据式(12),可以得到领航者航天器与参考点之间的相对轨道模型如下:
对式(20)中的微分方程组进行求解,得到如下结果:
式中,p0x(0)、p0y(0)、p0z(0)表示领航者航天器与参考点之间的三轴相对位置初值,表示领航者航天器与参考点之间的三轴相对速度初值;式(21)中的第二个等式中含有漂移项/>因此,初值条件须满足/>才能够消除漂移项,使航天器进行周期运动;将/>代入到式(21)中可得
式中,
根据式(22)可知,领航者航天器与参考点之间相对运动轨迹为椭圆形;若要使椭圆形的中心位于参考点处,即d0=0,则初值条件须满足
有益效果
本发明提出的一种多航天器轨道分布式协同跟踪最优控制方法,考虑参考点轨道为圆轨道的情况,构建出航天器与参考点之间的相对轨道动力学及运动学模型,并建立轨道跟踪误差系统方程。设计出分布式协同跟踪控制器,利用最优控制理论求解控制器参数,使误差系统的控制性能达到最佳,并计算出能够保证航天器围绕参考点进行周期运动的初值条件。本发明提供的方法能够求解出最优控制器参数,实现最佳控制性能。
采用本发明提出的方法能够以较少的能耗来实现较快的轨道跟踪速度。在文献中提出的方法作用下,航天器的轨道跟踪误差同步收敛时间为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)化作如下所示的状态空间方程:
式中,
定义领航者航天器与第i个跟随者航天器间的跟踪误差变量则可以得到如下全局误差变量:
式中,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。
选取李雅普诺夫函数为则利用李雅普诺夫稳定性理论可以证明,式(17)所设计出的控制器能够保证系统(16)渐进稳定。
选取目标函数其中/>利用最优控制理论可以证明,式(17)所设计出的控制器能够保证系统(16)的如下性能指标最优:
步骤三:针对步骤一中构建的相对轨道动力学及运动学模型,计算出能够保证航天器围绕参考点进行周期运动的初值条件。
根据式(12),可以得到领航者航天器与参考点之间的相对轨道模型如下:
对式(20)中的微分方程组进行求解,可以得到如下结果:
式中,p0x(0)、p0y(0)、p0z(0)表示领航者航天器与参考点之间的三轴相对位置初值,表示领航者航天器与参考点之间的三轴相对速度初值。式(21)中的第二个等式中含有漂移项/>因此,初值条件须满足/>才能够消除漂移项,使航天器进行周期运动。将/>代入到式(21)中可得
式中,
根据式(22)可知,领航者航天器与参考点之间相对运动轨迹为椭圆形。若要使椭圆形的中心位于参考点处,即d0=0,则初值条件须满足
采用以下实施例验证本发明的有益效果:
假设多航天器系统中有1个领航者航天器和4个跟随者航天器,描述航天器之间通讯网络的邻接矩阵和拉普拉斯矩阵如下:
选取参考点与地心之间的距离r0=20000km,选取R=5×103I3和Q=10I6,根据式(18),可以计算出控制器参数矩阵如下:
此外,采用文献中的方法,设计如下控制器:
其中,控制器参数矩阵/>为下列线性矩阵不等式组的解:
式中,为矩阵变量,/>为标量,v是矩阵/>的最小特征值,η是矩阵/>的最大特征值,α=1×107用于描述状态初值,δ=1×109用于描述性能指标的上界。可以求解出控制器参数为
选取航天器的状态初值如下:
其中,领航者航天器的初值x0(0)根据步骤三中的初值选取条件选取。
利用以上各参数,可以得到在本发明设计的控制器和文献中设计的控制器作用下,航天器的状态跟踪误差范数曲线||x1-x0||、||x2-x0||、||x3-x0||、||x4-x0||以及全局能耗曲线
通过仿真曲线可知,本发明设计的控制器能够保证4个跟随者航天器在40秒内同步跟踪上领航者航天器;而文献中设计的控制器能够保证4个跟随者航天器在80秒内同步跟踪上领航者航天器;在本发明设计的控制器作用下,航天器在100秒内的全局能耗为2.7×104;而在文献中设计的控制器作用下,航天器在100秒内的全局能耗为4.3×104。因此,相比于文献中设计的控制器,本发明所设计的控制器能够以更少的能耗来实现更快的跟踪速度。
本发明未详细介绍的内容(如代数图论、线性矩阵不等式、矩阵论、李雅普诺夫稳定性理论)属于本领域公共常识。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明公开的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。
Claims (1)
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)化作如下所示的状态空间方程:
式中,
定义领航者航天器与第i个跟随者航天器间的跟踪误差变量则可以得到如下全局误差变量:
式中,1N=[1,1,...,1]T表示元素均为1的N维列向量,I6表示6阶单位矩阵,/>表示克罗内克乘积;此外,/>表示通信拓扑图对应的拉普拉斯矩阵,且有/>和lij=-aij,其中aij表示航天器之间的相对状态保持增益,当第j个航天器能够向第i个航天器传输信息时,aij=1,否则aij=0;对式(4)求导,可以得到如下跟踪误差系统方程:
式中,
步骤2:针对步骤1中建立的误差系统方程,设计出分布式协同跟踪控制器,并利用最优控制理论求解控制器参数,使系统的控制性能达到最佳;
步骤2所述的分布式协同跟踪控制器:
式中,矩阵K表示控制器参数;设计控制器参数K=R-1BTP,其中正定矩阵P为如下代数黎卡提方程的解:
PA+ATP+Q-PBR-1BTP=0, (7)
式中,Q≥0,R>0;
选取李雅普诺夫函数为则利用李雅普诺夫稳定性理论可以证明,式(6)所设计出的控制器能够保证系统(5)渐进稳定;
选取目标函数其中/>利用最优控制理论可以证明,式(6)所设计出的控制器能够保证系统(5)的如下性能指标最优:
步骤3:针对步骤1中构建的相对轨道动力学及运动学模型,计算出能够保证航天器围绕参考点进行周期运动的初值条件;
步骤3所述的初值条件计算过程如下:
根据式(1),可以得到领航者航天器与参考点之间的相对轨道模型如下:
对式(9)中的微分方程组进行求解,得到如下结果:
式中,p0x(0)、p0y(0)、p0z(0)表示领航者航天器与参考点之间的三轴相对位置初值,表示领航者航天器与参考点之间的三轴相对速度初值;式(10)中的第二个等式中含有漂移项/>因此,初值条件须满足/>才能够消除漂移项,使航天器进行周期运动;将/>代入到式(10)中可得
式中,
根据式(11)可知,领航者航天器与参考点之间相对运动轨迹为椭圆形;若要使椭圆形的中心位于参考点处,即d0=0,则初值条件须满足
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 CN114253288A (zh) | 2022-03-29 |
CN114253288B true 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) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116047986B (zh) * | 2023-03-31 | 2023-06-09 | 山东科技大学 | 一种低通信耦合强度下船舶一致性控制方法 |
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 |
---|
多航天器相对轨道与姿态耦合分布式自适应协同控制;张海博;梅杰;马广富;朱志斌;;控制理论与应用(09);全文 * |
考虑输入饱和的多航天器系统姿轨耦合分布式协同跟踪控制;张海博;胡庆雷;马广富;朱志斌;;宇航学报(10);全文 * |
航天器编队姿态与轨道耦合协同控制器设计;张;王彦恺;;新型工业化(08);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN114253288A (zh) | 2022-03-29 |
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 | |
CN114253288B (zh) | 多航天器轨道分布式协同跟踪最优控制方法 | |
Sun et al. | A synchronization approach to trajectory tracking of multiple mobile robots while maintaining time-varying formations | |
CN110850719B (zh) | 一种基于强化学习的空间非合作目标参数自整定追踪方法 | |
Jiang et al. | Integrated guidance for Mars entry and powered descent using reinforcement learning and pseudospectral method | |
CN106054884A (zh) | 基于神经网络的l1自适应船舶动力定位双环控制系统 | |
CN114237041B (zh) | 一种基于预设性能的空-地协同固定时间容错控制方法 | |
CN112550770A (zh) | 一种基于凸优化的火箭软着陆轨迹规划方法 | |
CN112099516B (zh) | 一种基于模糊线性化理论的卫星集群姿态跟踪控制方法 | |
CN113110561A (zh) | 基于随机分布鲁棒优化的卫星编队保持smpc算法 | |
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 | |
Li et al. | Multi-UUV formation coordination control based on combination of virtual structure and leader | |
CN113885570B (zh) | 基于旋转势场的卫星编队重构控制方法 | |
CN116331518A (zh) | 一种基于安全自适应动态规划的星群智能编队避碰控制方法 | |
CN115755598A (zh) | 一种智能航天器集群分布式模型预测路径规划方法 | |
Huang et al. | Distributed flocking control of quad-rotor UAVs with obstacle avoidance under the parallel-triggered scheme | |
Xia et al. | Neuroadaptive saturated control for relative motion based noncooperative spacecraft proximity with prescribed performance | |
Zhang et al. | H∞ consensus tracking of recovery system for multiple unmanned underwater vehicles with switching networks and disturbances | |
CN110032204B (zh) | 输入时延下多空间飞行器姿态协同控制方法 | |
Qi et al. | Three-dimensional formation control based on filter backstepping method for multiple underactuated underwater vehicles | |
CN110174842A (zh) | 空间太阳能发电卫星在轨组装的分布式振动控制器设计方法 | |
CN110488858A (zh) | 一种采用Jordan分解进行编队飞行小推力重构的方法 | |
Yang et al. | Novel decentralised formation control for unmanned vehicles | |
CN108628345A (zh) | 一种电磁航天器编队悬停协同控制方法及系统 | |
Lara et al. | Robust control design techniques using differential evolution algorithms applied to the pvtol |
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 |