CN105786013A - 面向输入饱和的迹向欠驱动航天器编队重构控制方法 - Google Patents
面向输入饱和的迹向欠驱动航天器编队重构控制方法 Download PDFInfo
- Publication number
- CN105786013A CN105786013A CN201610186011.2A CN201610186011A CN105786013A CN 105786013 A CN105786013 A CN 105786013A CN 201610186011 A CN201610186011 A CN 201610186011A CN 105786013 A CN105786013 A CN 105786013A
- Authority
- CN
- China
- Prior art keywords
- centerdot
- spacecraft
- control
- eta
- trace
- 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
- 230000015572 biosynthetic process Effects 0.000 title claims abstract description 93
- 238000000034 method Methods 0.000 title claims abstract description 48
- 230000001133 acceleration Effects 0.000 claims description 50
- 239000011159 matrix material Substances 0.000 claims description 38
- 239000013598 vector Substances 0.000 claims description 33
- 238000004364 calculation method Methods 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 4
- 238000010276 construction Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 5
- 230000009471 action Effects 0.000 description 3
- 238000004458 analytical method Methods 0.000 description 3
- 230000007246 mechanism Effects 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 230000006698 induction Effects 0.000 description 2
- 230000008901 benefit Effects 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000000354 decomposition reaction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 208000011580 syndromic disease Diseases 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
- 238000000844 transformation 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, 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
- G05D1/104—Simultaneous 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)
- Navigation (AREA)
Abstract
本发明提供一种面向输入饱和的迹向欠驱动航天器编队重构控制方法,该方法针对存在输入饱和作用的圆轨道迹向欠驱动航天器编队构型重构控制问题,建立了其动力学模型。基于该动力学模型,分析了缺失迹向控制情况下的***能控性以及编队重构可行性。以此模型为受控对象,构建了辅助***以解决输入饱和问题,同时采用反步控制方法构建了迹向欠驱动情况下的闭环控制律。该方法能够完成存在输入饱和的圆轨道迹向欠驱动航天器编队构型重构控制,且闭环***一致最终有界稳定,对外部摄动及模型误差具有良好的鲁棒性和动态性能。
Description
技术领域
本发明涉及自动控制技术领域,具体的涉及一种面向输入饱和的迹向欠驱动航天器编队重构控制方法。
背景技术
航天器编队是未来空间任务应用的一项关键技术,航天器编队通过将传统单个航天器的不同功能部件地分布给航天器编队中的其他各小型航天器,从而使得航天器编队之间能实现相互协调统一完成任务。因而,与单个航天器相比,航天器编队具有更高的任务灵活性与可靠性,同时降低了成本与风险。航天器编队的任务灵活性体现在其可通过轨道机动的方式变换成不同的队列构型,实现编队重构,以适应不同空间任务的需要。因而,编队重构是航天器编队中的关键。现有的航天器编队重构控制方法多基于全驱动动力学***假设(***的控制输入维数为受控***的自由度相等),即假设航天器编队中的主航天器与从航天器的径向、迹向、法向相对轨道运动的控制通道上均存在独立的控制器。若航天器某一方向的控制器发生故障,航天器编队相对轨道动力学***变为欠驱动***,则已有的全驱动控制方法则不再适用,导致航天器的重构任务失败。此外,采用更少数量的推力器有助于进一步降低航天器的质量与成本。
因而,有必要构建面向欠驱动航天器的编队重构控制方法以解决上述问题。
虽然目前已有研究工作提出欠驱动航天器编队重构控制方法,但现有这些控制方法均未考虑控制器输入饱和的问题。然而,现实中的控制器实际上均存在输入饱和问题,即控制器可提供的控制加速度存在上限。若在控制器构建过程中不考虑该实际的物理问题,则有可能导致控制***的不稳定,从而无法完成航天器重构的任务。
发明内容
本发明的目的在于提供一种面向输入饱和的迹向欠驱动航天器编队重构控制方法,该发明解决了现有迹向欠驱动航天器编队重构控制方法中,均未考虑的输入饱和问题。
本发明提供一种面向输入饱和的迹向欠驱动航天器编队重构控制方法,包括以下步骤:
步骤S100:给定待重构的名义构型:根据待重构的名义构型,计算对应的名义相对运动状态X2d,其中,X2d的下标2代表缺失迹向控制加速度的欠驱动情况;
步骤S200:误差量计算:对当前构型计算实际相对运动状态X2,由此计算当前构型与名义相对运动状态之间的误差量e2,e2按公式(1)计算:
步骤S300:控制律构建:采用反步控制方法构建迹向欠驱动航天器编队重构控制律,计算实际控制量U2;
其中,实际相对运动状态X2,式中x、y和z分别为径向、迹向和法向的实际相对位置,和分别为径向、迹向和法向的实际相对速度;
名义相对运动状态X2d,式中xd、yd和zd分别为径向、迹向和法向的名义相对位置,和分别为径向、迹向和法向的名义相对速度;
实际控制量U2=[UxUz]T,其中Ux和Uz分别为径向和法向控制加速度;
步骤S400:计算得到具体问题的控制量U2,将所得U2代入公式(12)中,判断所得各项性能参数是否满足预设的性能指标,如果判断为满足则结束控制;如果判断为不满足则调整U2中的各控制参数直至判断结果为满足性能指标时停止
其中,步骤S100包括以下步骤:建立迹向欠驱动航天器编队动力学模型:
航天器包括主航天器和从航天器,欠驱动航天器编队动力学模型的坐标系定义:OEXIYIZI为地心惯性坐标系,其中OE为地心,OCxyz为相对运动坐标系,其中OC为主航天器质心,x轴沿主航天器径向,z轴与主航天器轨道面法向重合,y轴与x、z轴构成右手笛卡尔直角坐标系,OD为从航天器质心,RC和RD分别为主航天器与从航天器的地心距矢量,X2为缺失迹向控制加速度欠驱动情况下的相对运动状态,迹向欠驱动航天器编队动力学模型在相对运动坐标系中的描述为
其中:
F2=[01×3fyfxfz]T(3)
B=[02×4I2×2]T(5)
U2=[UxUz]T(6)
其中,uC为主航天器的纬度幅角,和分别为主航天器轨道角速度和轨道角加速度,且其中,μ=3.986×1014m3/s2为地球引力常数,RC和RD=[(RC+x)2+y2+z2]1/2分别为主航天器和从航天器的地心距;0m×n和Im×n分别表示维数为m×n的零矩阵或单位矩阵,U2为缺失迹向控制加速度情况下的实际控制量,其中,Ux和Uz分别为径向和法向控制加速度;
步骤S300包括以下步骤:建立误差动力学模型与构建控制律,得到缺失迹向控制加速度时,考虑外部摄动及模型线性化误差的欠驱动编队动力学模型中的可控部分为
其中
式中,且d2u=[dy00]T和d2a=[dxdz]T为不确定扰动矢量,sat(U2)的表达式为sat(U2)=[sat(Ux)sat(Uz)]T,其中sat(·)为符号函数,即
式中,Ujm(j=x,z)为j方向可提供的最大控制加速度,sgn(·)为符号函数,其定义式为
构建的控制律为
其中
式中,和均为正定对角参数矩阵,的定义式为其中P21为定常参数矩阵,其表达式为
式中,p21<0为控制器参数,P22=P21A21,E21=diag(ε211,ε212)为正定增益矩阵,其中ε211>ξ21m且ε212>ξ21m,ξ21m为矢量ξ21=P21d2u的上界,即||ξ21||≤ξ21m=||P21||dm,其中||P21||为矩阵P21的诱导范数,同理,E22=diag(ε221,ε222)为正定增益矩阵,其中ε221>ξ22m且ε222>ξ22m,ξ22m为矢量ξ22=d2a+(K21P21+P22)d2u的上界,即ξ22m=(1+||K21||||P21||+||P22||)dm,其中||K21||和||P22||分别为矩阵K21和P22的诱导范数,sat(η22,δ21,δ22)=[sat(η221,δ21)sat(η222,δ22)]T,其中
式中,δ21>0和δ22>0为边界层的厚度。
λ21和λ22的值由如下辅助***积分得到,即
式中,ΔU2=sat(U2)-U2。
进一步地,迹向欠驱动编队动力学***中,可控状态矢量为不可控状态矢量为所处理为圆轨道条件下的航天器编队重构。
本发明的技术效果:
本发明提供面向输入饱和的迹向欠驱动航天器编队重构控制方法,能够在缺失迹向控制加速度的欠驱动情况下,建立任一待重构的圆轨道编队构型,该方法考虑控制器输入饱和作用,符合物理实际,实现了存在输入饱和作用的圆轨道迹向欠驱动航天器编队构型重构。
本发明提供面向输入饱和的迹向欠驱动航天器编队重构控制方法,采用反步控制方法构建闭环控制律,使得闭环控制***对外部摄动及模型线性化误差具有良好的鲁棒性。该方法在应用过程中可以根据实际编队重构任务要求给定待重构的编队构型,并将由该方法得到的控制量传输至执行机构实现迹向欠驱动编队重构控制功能。
具体请参考根据本发明的面向输入饱和的迹向欠驱动航天器编队重构控制方法提出的各种实施例的如下描述,将使得本发明的上述和其他方面显而易见。
附图说明
图1为本发明优选实施例中迹向欠驱动航天器编队重构控制方法步骤流程示意图;
图2为本发明优选实施例中迹向欠驱动航天器编队动力学模型坐标系定义示意图;
图3为本发明优选实施例中缺失迹向加速度条件下编队重构轨迹示意图;
图4为本发明优选实施例中缺失迹向加速度条件下相对位置误差变化曲线示意图;
图5为本发明优选实施例中缺失迹向加速度条件下相对速度误差变化曲线示意图;
图6为本发明优选实施例中缺失迹向加速度条件下控制量变化曲线示意图;
文中符号说明如下:
OD为从航天器质心;
OEXIYIZI为地心惯性坐标系(OE为地心);
OCxyz为相对运动坐标系(OC为主航天器质心);
RC为主航天器地心距矢量;
RD为从航天器地心距矢量;
Ux为径向控制加速度;
Uz为法向控制加速度;
uC为主航天器纬度幅角;
x为径向;
y为迹向;
z为法向;
ρ为主航天器与从航天器相对位置矢量。
具体实施方式
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。
本发明提出了一种考虑控制器饱和作用的反步控制方法。该方法针对圆轨道迹向欠驱动航天器编队重构控制问题,建立其动力学模型。基于该动力学模型,分析了缺失迹向控制情况下的***能控性以及编队重构任务的可行性。以此动力学模型为受控对象,构建了辅助***以解决在输入饱和情况下的航天器编队重构问题,并采用反步控制法构建了迹向欠驱动情况下的闭环控制律。该欠驱动控制器能够实现缺失迹向控制加速度情况下的圆轨道航天器编队构型重构,且闭环***对外部摄动及模型误差具有良好的鲁棒性和动态性能,为迹向欠驱动航天器编队构型重构的工程实现提供了有效方案,解决了存在输入饱和作用的迹向欠驱动航天器编队重构控制问题。
本发明提供的面向输入饱和的迹向欠驱动航天器编队重构控制方法,充分考虑了输入饱和情况下的航天器编队重构,首先给定待重构的名义构型,基于此计算对应的名义相对运动状态,然后由当前构型计算实际相对运动状态,并计算实际相对运动状态与名义相对运动状态的误差量,最后采用反步控制方法构建控制律,计算实际控制量。
实际应用中,主航天器与从航天器实时相对运动状态由从航天器星上相对导航***测量得到,并通过本发明提供的方法计算得到控制量,将该控制量传输至执行机构中即可实现迹向欠驱动航天器编队重构控制。
参见图1,本发明提供的考虑输入饱和的迹向欠驱动航天器编队重构控制方法,其具体步骤如下:
步骤S100:给定待重构的名义构型:根据待重构的名义构型,计算对应的名义相对运动状态X2d,其中,X2d的下标2代表缺失迹向控制加速度的欠驱动情况;
步骤S200:误差量计算:对当前构型计算实际相对运动状态X2,由此计算当前构型与名义相对运动状态之间的误差量e2,e2按公式(1)计算:
步骤S300:控制律构建:采用反步控制方法构建迹向欠驱动航天器编队重构控制律,计算实际控制量U2;
其中,实际相对运动状态X2,式中x、y和z分别为径向、迹向和法向的实际相对位置,和分别为径向、迹向和法向的实际相对速度;
名义相对运动状态X2d,式中xd、yd和zd分别为径向、迹向和法向的名义相对位置,和分别为径向、迹向和法向的名义相对速度;
实际控制量U2=[UxUz]T,其中Ux和Uz分别为径向和法向控制加速度。此处待重构的名义构型就是重构后的构型;此处的当前构型指的是重构前的构型。
步骤S400:计算得到具体问题的控制量U2,将所得U2代入公式(12)中,判断所得各项性能参数是否满足预设的性能指标,如果判断为满足则结束控制;如果判断为不满足则调整U2中的各控制参数直至判断结果为满足性能指标时停止;
其中,步骤S100包括以下步骤:建立迹向欠驱动航天器编队动力学模型:
航天器包括主航天器和从航天器。欠驱动航天器编队动力学模型的坐标系定义:OEXIYIZI为地心惯性坐标系,其中OE为地心,OCxyz为相对运动坐标系,其中OC为主航天器质心,x轴沿主航天器径向,z轴与主航天器轨道面法向重合,y轴与x、z轴构成右手笛卡尔直角坐标系,OD为从航天器质心。RC和RD分别为主航天器与从航天器的地心距矢量,X2为缺失迹向控制加速度欠驱动情况下的相对运动状态,迹向欠驱动航天器编队动力学模型在相对运动坐标系中的描述为
其中:
F2=[01×3fyfxfz]T(3)
B=[02×4I2×2]T(5)
U2=[UxUz]T(6)
其中,uC为主航天器的纬度幅角,和分别为主航天器轨道角速度和轨道角加速度,且其中,μ=3.986×1014m3/s2为地球引力常数,RC和RD=[(RC+x)2+y2+z2]1/2分别为主航天器和从航天器的地心距;0m×n和Im×n分别表示维数为m×n的零矩阵或单位矩阵,U2为缺失迹向控制加速度情况下的实际控制量,其中,Ux和Uz分别为径向和法向控制加速度;
步骤S300包括以下步骤:建立误差动力学模型与构建控制律,得到缺失迹向控制加速度时,考虑外部摄动及模型线性化误差的欠驱动编队动力学模型中的可控部分为
其中
式中,d2u=[dy00]T和d2a=[dxdz]T为不确定扰动矢量,sat(U2)的表达式为sat(U2)=[sat(Ux)sat(Uz)]T,其中sat(·)为符号函数,即
式中,Ujm(j=x,z)为j方向可提供的最大控制加速度,sgn(·)为符号函数,其定义式为
构建的控制律为
其中
式中,和均为正定对角参数矩阵,的定义式为其中P21为定常参数矩阵,其表达式为
式中,p21<0为控制器参数,P22=P21A21,E21=diag(ε211,ε212)为正定增益矩阵,其中ε211>ξ21m且ε212>ξ21m,ξ21m为矢量ξ21=P21d2u的上界,即||ξ21||≤ξ21m=||P21||dm,其中||P21||为矩阵P21的诱导范数,同理,E22=diag(ε221,ε222)为正定增益矩阵,其中ε221>ξ22m且ε222>ξ22m,ξ22m为矢量ξ22=d2a+(K21P21+P22)d2u的上界,即ξ22m=(1+||K21||||P21||+||P22||)dm,其中||K21||和||P22||分别为矩阵K21和P22的诱导范数,sat(η22,δ21,δ22)=[sat(η221,δ21)sat(η222,δ22)]T,其中
式中,δ21>0和δ22>0为边界层的厚度。
λ21和λ22的值由如下辅助***积分得到,即
式中,ΔU2=sat(U2)-U2。
按上述方法进行控制,实现了在考虑输入饱和的情况下,对迹向欠驱动航天器重构编队的有效控制。
本发明提供方法的各项证明和分析如下:
1)建立迹向欠驱动航天器编队动力学模型:
称编队构型中的航天器分别为主航天器和从航天器。描述欠驱动航天器编队动力学模型的坐标系定义如下。如图2所示,OEXIYIZI为地心惯性坐标系,其中OE为地心。OCxyz为相对运动坐标系,其中OC为主航天器质心,x轴沿主航天器径向,z轴与主航天器轨道面法向重合,y轴与x、z轴构成右手笛卡尔直角坐标系。OD为从航天器质心。RC和RD分别为主航天器与从航天器的地心距矢量。如前,定义X2为缺失迹向控制加速度欠驱动情况下的相对运动状态,则迹向欠驱动航天器编队动力学模型在相对运动坐标系中的描述为
其中
F2=[01×3fyfxfz]T(3)
B=[02×4I2×2]T(5)
U2=[UxUz]T(6)
其中,uC为主航天器纬度幅角,和分别为主航天器轨道角速度与轨道角加速度。且其中,μ=3.986×1014m3/s2为地球引力常数,RC和RD=[(RC+x)2+y2+z2]1/2分别为主航天器和从航天器的地心距。0m×n和Im×n分别表示维数为m×n的零矩阵或单位矩阵。U2为缺失迹向控制加速度情况下的实际控制量,其中,Ux和Uz分别为径向和法向控制加速度。
2)迹向欠驱动编队动力学***能控性分析
假设主航天器位于圆轨道(即且)且主从航天器相对距离远小于其地心距,则上述非线性动力学模型可线性化为
式中
当缺失迹向控制加速度时,线性定常***(A2,B)非完全可控,且其可控与不可控子空间可分解为:
其中:
式中,可控状态矢量为不可控状态矢量为
3)迹向欠驱动编队重构可行性分析
常用的圆轨道编队构型有投影圆(ProjectCircularOrbit,PCO)编队、空间圆(GeneralCircularOrbit,GCO)编队等。例如,投影圆的方程为
式中,rp为投影圆半径,t为时间且为初始相位角。
实际上,对于圆轨道编队,无论是投影圆、空间圆或其它构型,主从航天器相对运动状态均满足条件该条件保证了相对运动的周期性。
编队重构是指初始时刻与主航天器构成某一编队构型的从航天器通过轨道机动的方式进行相对轨道转移,从而与主航天器构成另一新的编队构型,即前述待重构的名义构型。对于缺失迹向控制加速度情况,***非完全可控,其不可控状态将保持其初值不变,即一方面,对于编队重构问题,初始时刻主从航天器构成当前编队构型,因而由前述圆轨道编队构型满足的条件得,其相对运动状态满足条件由于该状态的不可控性,易得另一方面,对于圆轨道的任一编队构型,都应满足条件即对于待重构的名义构型,同样要求该条件成立。考虑到则该条件自然成立。因此,虽然在缺失迹向控制加速度的情况下,***非完全可控,但对于圆轨道条件下的航天器编队重构仍可实现。换言之,若初始时刻主从航天器构成某一编队构型,即则该不可控状态在整个控制过程中将保持为零,因而自然满足了待重构的名义构型的约束条件,保证了编队重构的可实现性。
4)建立误差动力学模型与构建控制律
实际空间操作时不可避免地存在外部摄动作用,且实际控制执行机构均存在输入饱和这一物理实际问题,即所能提供的控制加速度存在最大值,考虑外部摄动和输入饱和的动力学方程可写为
其中,为外部摄动矢量。sat(U2)为考虑输入饱和作用后由实际控制执行机构输入的控制加速度。由于缺失迹向控制加速度,则sat(U2)=[sat(Ux)sat(Uz)]T,其中sat(·)表示饱和函数,其表达式为
其中,Ujm(j=x,y,z)为j方向控制器可提供的最大控制加速度。sgn(·)为符号函数,其定义式为
对于圆轨道编队构型,其名义相对运动状态满足
根据前述误差量e2定义式e2=X2-X2d,由式(12)与式(15)作差得到误差动力学模型为
式中,为线性化误差和外部摄动构成的总扰动矢量,满足||D2||≤dm,其中符号||·||表示向量范数,dm>0为矢量D2的上界。D2=[01×3dydxdz]T。
迹向欠驱动反步控制器构建方法:
按照如式(9)所示的结构分解方法,将缺失迹向控制加速度的误差动力学模型(16)中的可控子空间重写为式(17):
其中
式中,且d2u=[dy00]T和d2a=[dxdz]T为不确定扰动矢量。
同理,对矢量进行线性变换其中为定常参数矩阵,即
式中,p21<0为控制器参数。
注意到P21A22=I2×2,则的动力学方程为
式中,P22=P21A21。
为了考虑输入饱和,定义辅助***
式中,ΔU2=sat(U2)-U2。和为正定对角增益矩阵。
定义坐标变换
式中,为虚拟控制量。E21=diag(ε211,ε212)为正定增益矩阵,其中ε211>ξ21m且ε212>ξ21m。ξ21m为矢量ξ21=P21d2u的上界,即||ξ21||≤ξ21m=||P21||dm,其中||P21||为矩阵P21的诱导范数。η21=[η211η212]T且η22=[η221η222]T。
根据上述变量定义,控制律U2构建为
其中
式中,和为正定对角参数矩阵。E22=diag(ε221,ε222)为正定增益矩阵,其中ε221>ξ22m且ε222>ξ22m。ξ22m为矢量ξ22=d2a+(K21P21+P22)d2u的上界,即ξ22m=(1+||K21||||P21||+||P22||)dm,其中||K21||和||P21||分别为矩阵K21和P21的诱导范数。sat(η22,δ21,δ22)=[sat(η221,δ21)sat(η222,δ22)]T为饱和函数,即
式中,δ21>0和δ22>0为边界层的厚度。
以下给出该欠驱动情况下的闭环***一致最终有界稳定性证明。通过以下证明,可见在该控制律的作用下,各误差状态均收敛至平衡点附近,且闭环***一致最终有界稳定。
考虑李亚普诺夫函数或η22≠0。对其求时间导数得:
式中,其中,和分别为矩阵K21和C2的最小特征值,和分别为矩阵W2的最大和最小特征值。
由式(26)得,V2指数收敛,即当t→∞时,η21→0且η22→0。因此,当t→∞时,其范数也满足||η21||→0且||η22||→0。
考虑另一李亚普诺夫函数对其求时间导数得:
式中,为矩阵K22的最小特征值。可见,当时,则即Vλ22继续收敛。因此,λ22的收敛域为
同理,对另一李亚普诺夫函数求时间导数得
类似地,可得到λ21的收敛域为:
注意到且当t→∞时,||η21||→0,则将收敛至
由线性变换得
由于则平面外法向相对位置误差的稳态精度为:
由于则由式(32)得,当t→∞时,的表达式为:
上式可进一步化简为
式中,a21=-2nCp21且因而,ζ2的上界为|ζ2|≤ζ2m=2nCΛ2。
显然,等式(35)左边为一阶线性***。根据线性***理论易得,当a21>0时,***稳定。求解以上不等式得
p21<0(36)
上式与式(19)中给出的参数条件吻合。
将式(35)重写为
或
显然,当或时,迹向相对误差继续收敛。因此,ey和稳态精度为
此外,迹向误差动力学方程为对等式两边进行积分得
式中,且其上界为|θ2|≤θ2m。
对于圆轨道编队重构问题,初始时刻主从航天器构成编队,则其初始相对运动状态满足同理,对于待重构的期望构型,满足两式作差得将该式代入式(40)中得
因此,径向相对位置的稳态误差为
|ex(∞)|≤(2nC)-1(ζ2m+θ2m)=Δ2x(42)
至此,径向、迹向和法向相对位置的稳态误差分别如式(42)、(39)和(33)所示。可见,ΔU2影响最终相对位置精度。当t→∞时,若||ΔU2||→0,即Ux≤Uxm且Uz≤Uzm时,则有式||λ21||→0,||λ22||→0和Λ2→0成立。证毕。
下面结合附图,对本发明的方法作进一步的说明。
本发明提供的考虑输入饱和的迹向欠驱动航天器编队重构控制方法,其具体步骤如下:
步骤一:给定待重构的名义构型
本实例中假设主航天器位于轨道半径为RC=6900km的圆轨道,其初始轨道根数如表1所示。由表1可计算得,
表1初始时刻目标航天器轨道根数
本实例中假设待重构的名义构型为半径为rp=1.0km且初始时刻相位角的投影圆编队,则名义相对运动状态为
步骤二:误差量计算
计算实际相对运动状态与名义相对运动状态的误差量e2,即
式中,为实际相对运动状态,为名义相对运动状态,其中,x、y和z分别为径向、迹向和法向相对位置,和分别为径向、迹向和法向相对速度,均为连续变化值。
本实例中假设初始时刻主从航天器构成半径为r0=0.5km且初始时刻相位角的投影圆编队,则初始时刻主从航天器的实际相对运动状态为
式中,x0、y0和z0分别为初始时刻主从航天器径向、迹向和法向相对位置,和分别为初始时刻主从航天器径向、迹向和法向相对速度。
将数值rp=1.0km、r0=0.5km、与rad/s代入式(43)与(44),得到本实例中初始时刻的误差量,即
e2(0)=[-216.5m-250m-433.0m0.477m/s-0.138m/s-0.275m/s]T(45)
步骤三:控制律构建
缺失迹向控制加速度时,考虑外部摄动及模型线性化误差的欠驱动编队动力学模型中的可控部分为
其中
式中,且d2u=[dy00]T和d2a=[dxdz]T为不确定扰动矢量。sat(U2)的表达式为sat(U2)=[sat(Ux)sat(Uz)]T,其中sat(·)为符号函数,即
式中,Ujm(j=x,z)为j方向可提供的最大控制加速度。sgn(·)为符号函数,其定义式为
构建的控制律为
其中
式中,和均为正定对角参数矩阵。的定义式为其中P21为定常参数矩阵,其表达式为
式中,p21<0为控制器参数。P22=P21A21。E21=diag(ε211,ε212)为正定增益矩阵,其中ε211>ξ21m且ε212>ξ21m。ξ21m为矢量ξ21=P21d2u的上界,即||ξ21||≤ξ21m=||P21||dm,其中||P21||为矩阵P21的诱导范数。同理,E22=diag(ε221,ε222)为正定增益矩阵,其中ε221>ξ22m且ε222>ξ22m。ξ22m为矢量ξ22=d2a+(K21P21+P22)d2u的上界,即ξ22m=(1+||K21||||P21||+||P22||)dm,其中||K21||和||P22||分别为矩阵K21和P22的诱导范数。sat(η22,δ21,δ22)=[sat(η221,δ21)sat(η222,δ22)]T,其中
式中,δ21>0和δ22>0为边界层的厚度。
λ21和λ22的值由如下辅助***积分得到,即
式中,ΔU2=sat(U2)-U2。本实例中λ21与λ22的初值分别取为λ21(0)=02×1和λ22(0)=02×1。
本实例中的控制器参数列于表2,将控制器参数代入式(23)即可计算实际控制量。
表2控制器参数(缺失迹向控制加速度情况)
参数 | 数值 | 参数 | 数值 |
p21 | -1.5 | W2 | diag(10-5,10-5) |
C2 | diag(4×10-2,5×10-3) | Uxm | 5×10-4 |
Uzm | 5×10-4 | K21 | diag(5×10-3,3×10-3) |
K22 | diag(3×10-3,3×10-3) | E21 | diag(10-4,10-5) |
E22 | diag(10-6,10-5) | δ21 | 10-3 |
δ22 | 10-3 |
考虑到J2摄动是低地球轨道的主要摄动力,引入J2摄动作为外部摄动力。缺失迹向控制加速度的欠驱动航天器编队构型重构控制结果如图3至图6所示。图3给出了缺失迹向控制加速度条件下完成编队构型重构的相对转移轨道,可见,从航天器从半径较小的投影圆编队出发,到达半径较大的投影圆编队,完成了构型重构,验证了本发明提出的控制方法的有效性与正确性。图4给出了主从航天器相对位置误差变化曲线,可见,初始相对位置误差大约于3/4轨道周期后收敛至零附近,且其稳态误差为10°m数量级,最大相对位置稳态误差约为主从航天器相对距离的0.18%,考虑到由于缺失迹向控制加速度,控制***为欠驱动控制***,本发明提出的欠驱动控制方法已具有较高的控制精度。图5给出了主从航天器相对速度误差变化曲线,同理,初始相对速度误差约于3/4轨道周期后收敛至零附近,且其稳态误差约为10-3m/s数量级。图6给出了完成该重构任务所需的控制轨迹,可见,径向与法向控制加速度均在某段时间内达到饱和,且均限制在其最大值范围以内,验证了本发明提出的考虑输入饱和的欠驱动控制方法的正确性。此外,由于考虑输入饱和,本控制方法更符合控制器物理实际,可在实际欠驱动编队重构任务中实现。
本领域技术人员将清楚本发明的范围不限制于以上讨论的示例,有可能对其进行若干改变和修改,而不脱离所附权利要求书限定的本发明的范围。尽管己经在附图和说明书中详细图示和描述了本发明,但这样的说明和描述仅是说明或示意性的,而非限制性的。本发明并不限于所公开的实施例。
通过对附图,说明书和权利要求书的研究,在实施本发明时本领域技术人员可以理解和实现所公开的实施例的变形。在权利要求书中,术语“包括”不排除其他步骤或元素,而不定冠词“一个”或“一种”不排除多个。在彼此不同的从属权利要求中引用的某些措施的事实不意味着这些措施的组合不能被有利地使用。权利要求书中的任何参考标记不构成对本发明的范围的限制。
Claims (2)
1.一种面向输入饱和的迹向欠驱动航天器编队重构控制方法,其特征在于,包括以下步骤:
步骤S100:给定待重构的名义构型:根据待重构的名义构型,计算对应的名义相对运动状态X2d,其中,X2d的下标2代表缺失迹向控制加速度的欠驱动情况;
步骤S200:误差量计算:对当前构型计算实际相对运动状态X2,由此计算当前构型与所述名义相对运动状态之间的误差量e2,e2按公式(1)计算:
步骤S300:控制律构建:采用反步控制方法构建迹向欠驱动航天器编队重构控制律,计算实际控制量U2;
其中,实际相对运动状态X2,式中x、y和z分别为径向、迹向和法向的实际相对位置,和分别为径向、迹向和法向的实际相对速度;
名义相对运动状态X2d,式中xd、yd和zd分别为径向、迹向和法向的名义相对位置,和分别为径向、迹向和法向的名义相对速度;
实际控制量U2=[UxUz]T,其中Ux和Uz分别为径向和法向控制加速度;
步骤S400:计算得到具体问题的控制量U2,将所得U2代入公式(12)中,判断所得各项性能参数是否满足预设的性能指标,如果判断为满足则结束控制;如果判断为不满足则调整U2中的各控制参数直至判断结果为满足所述性能指标时停止;
其中,步骤S100包括以下步骤:建立迹向欠驱动航天器编队动力学模型:
所述航天器包括主航天器和从航天器,所述欠驱动航天器编队动力学模型的坐标系定义:OEXIYIZI为地心惯性坐标系,其中OE为地心,OCxyz为相对运动坐标系,其中OC为主航天器质心,x轴沿主航天器径向,z轴与主航天器轨道面法向重合,y轴与x、z轴构成右手笛卡尔直角坐标系,OD为从航天器质心,RC和RD分别为所述主航天器与所述从航天器的地心距矢量,X2为缺失迹向控制加速度欠驱动情况下的相对运动状态,所述迹向欠驱动航天器编队动力学模型在相对运动坐标系中的描述为
其中:
F2=[01×3fyfxfz]T(3)
B=[02×4I2×2]T(5)
U2=[UxUz]T(6)
其中,uC为所述主航天器的纬度幅角,和分别为所述主航天器轨道角速度和轨道角加速度,且其中,μ=3.986×1014m3/s2为地球引力常数,RC和RD=[(RC+x)2+y2+z2]1/2分别为主航天器和从航天器的地心距;0m×n和Im×n分别表示维数为m×n的零矩阵或单位矩阵,U2为缺失迹向控制加速度情况下的实际控制量,其中,Ux和Uz分别为径向和法向控制加速度;
所述步骤S300包括以下步骤:建立误差动力学模型与构建控制律,得到缺失迹向控制加速度时,考虑外部摄动及模型线性化误差的欠驱动编队动力学模型中的可控部分为
其中
式中,且d2u=[dy00]T和d2a=[dxdz]T为不确定扰动矢量,sat(U2)的表达式为sat(U2)=[sat(Ux)sat(Uz)]T,其中sat(·)为符号函数,即
式中,Ujm(j=x,z)为j方向可提供的最大控制加速度,sgn(·)为符号函数,其定义式为
构建的控制律为
其中
式中,和均为正定对角参数矩阵,的定义式为其中P21为定常参数矩阵,其表达式为
式中,p21<0为控制器参数,P22=P21A21,E21=diag(ε211,ε212)为正定增益矩阵,其中ε211>ξ21m且ε212>ξ21m,ξ21m为矢量ξ21=P21d2u的上界,即||ξ21||≤ξ21m=||P21||dm,其中||P21||为矩阵P21的诱导范数,同理,E22=diag(ε221,ε222)为正定增益矩阵,其中ε221>ξ22m且ε222>ξ22m,ξ22m为矢量ξ22=d2a+(K21P21+P22)d2u的上界,即ξ22m=(1+||K21||||P21||+||P22||)dm,其中||K21||和||P22||分别为矩阵K21和P22的诱导范数,sat(η22,δ21,δ22)=[sat(η221,δ21)sat(η222,δ22)]T,其中
式中,δ21>0和δ22>0为边界层的厚度。
λ21和λ22的值由如下辅助***积分得到,即
式中,ΔU2=sat(U2)-U2。
2.根据权利要求1所述的面向输入饱和的迹向欠驱动航天器编队重构控制方法,其特征在于,
所述迹向欠驱动编队动力学***中,可控状态矢量为不可控状态矢量为
所处理为圆轨道条件下的航天器编队重构。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610186011.2A CN105786013B (zh) | 2016-03-29 | 2016-03-29 | 面向输入饱和的迹向欠驱动航天器编队重构控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610186011.2A CN105786013B (zh) | 2016-03-29 | 2016-03-29 | 面向输入饱和的迹向欠驱动航天器编队重构控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105786013A true CN105786013A (zh) | 2016-07-20 |
CN105786013B CN105786013B (zh) | 2018-05-15 |
Family
ID=56391224
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610186011.2A Active CN105786013B (zh) | 2016-03-29 | 2016-03-29 | 面向输入饱和的迹向欠驱动航天器编队重构控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105786013B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109582039A (zh) * | 2019-01-09 | 2019-04-05 | 北京空间飞行器总体设计部 | 一种采用相对导航信息的j2摄动下最优队形重构方法 |
CN109709893A (zh) * | 2018-12-25 | 2019-05-03 | 中国人民解放军空军工程大学 | 幅值受限控制***的有界补偿方法 |
CN109828594A (zh) * | 2019-01-28 | 2019-05-31 | 中国人民解放军国防科技大学 | 一种燃料消耗低与过程稳定的电磁航天器构型重构方法 |
CN115390587A (zh) * | 2022-08-23 | 2022-11-25 | 中国空间技术研究院 | 一种非预设参数的欠迹向驱动多航天器编队重构控制方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103076808A (zh) * | 2012-12-27 | 2013-05-01 | 清华大学 | 一种自主协同的航天器集群体系及运行方法 |
US8437892B1 (en) * | 2010-01-20 | 2013-05-07 | The United States Of America, As Represented By The Secretary Of The Navy | Method and system for establishment and maintenance of a global formation of directionally-fixed spacecraft without the use of expendable mass |
CN103676955A (zh) * | 2013-12-19 | 2014-03-26 | 北京航空航天大学 | 一种实现分布式编队飞行的卫星自主轨道控制*** |
CN104460679A (zh) * | 2014-11-28 | 2015-03-25 | 南京航空航天大学 | 一种基于切换控制方法的挠性航天器欠驱动控制***及其姿态控制方法 |
CN104794281A (zh) * | 2015-04-22 | 2015-07-22 | 大连理工大学 | 一种基于自适应代理模型的平动点航天器编队重构方法 |
CN105159304A (zh) * | 2015-06-26 | 2015-12-16 | 哈尔滨工业大学 | 接近并跟踪空间非合作目标的有限时间容错控制方法 |
-
2016
- 2016-03-29 CN CN201610186011.2A patent/CN105786013B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8437892B1 (en) * | 2010-01-20 | 2013-05-07 | The United States Of America, As Represented By The Secretary Of The Navy | Method and system for establishment and maintenance of a global formation of directionally-fixed spacecraft without the use of expendable mass |
CN103076808A (zh) * | 2012-12-27 | 2013-05-01 | 清华大学 | 一种自主协同的航天器集群体系及运行方法 |
CN103676955A (zh) * | 2013-12-19 | 2014-03-26 | 北京航空航天大学 | 一种实现分布式编队飞行的卫星自主轨道控制*** |
CN104460679A (zh) * | 2014-11-28 | 2015-03-25 | 南京航空航天大学 | 一种基于切换控制方法的挠性航天器欠驱动控制***及其姿态控制方法 |
CN104794281A (zh) * | 2015-04-22 | 2015-07-22 | 大连理工大学 | 一种基于自适应代理模型的平动点航天器编队重构方法 |
CN105159304A (zh) * | 2015-06-26 | 2015-12-16 | 哈尔滨工业大学 | 接近并跟踪空间非合作目标的有限时间容错控制方法 |
Non-Patent Citations (3)
Title |
---|
XU HUANG 等: "Sliding mode control for Lorentz一augmented spacecraft hovering around elliptic orbits", 《ACTA ASTRONAUTICA》 * |
刘猛 等: "基于冲量法实现航天器编队重构控制仿真的研究", 《火力与指挥控制》 * |
刘鲁华 等: "《航天器相对运动轨道动力学与控制》", 31 January 2013, 中国宇航出版社 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109709893A (zh) * | 2018-12-25 | 2019-05-03 | 中国人民解放军空军工程大学 | 幅值受限控制***的有界补偿方法 |
CN109582039A (zh) * | 2019-01-09 | 2019-04-05 | 北京空间飞行器总体设计部 | 一种采用相对导航信息的j2摄动下最优队形重构方法 |
CN109828594A (zh) * | 2019-01-28 | 2019-05-31 | 中国人民解放军国防科技大学 | 一种燃料消耗低与过程稳定的电磁航天器构型重构方法 |
CN109828594B (zh) * | 2019-01-28 | 2021-07-27 | 中国人民解放军国防科技大学 | 一种燃料消耗低与过程稳定的电磁航天器构型重构方法 |
CN115390587A (zh) * | 2022-08-23 | 2022-11-25 | 中国空间技术研究院 | 一种非预设参数的欠迹向驱动多航天器编队重构控制方法 |
CN115390587B (zh) * | 2022-08-23 | 2023-12-15 | 中国空间技术研究院 | 一种非预设参数的欠迹向驱动多航天器编队重构控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105786013B (zh) | 2018-05-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Ashrafiuon et al. | Trajectory tracking control of planar underactuated vehicles | |
Zheng et al. | Path following of a surface vessel with prescribed performance in the presence of input saturation and external disturbances | |
Li et al. | Adaptive RBFNNs/integral sliding mode control for a quadrotor aircraft | |
Liang et al. | A novel energy-coupling-based hierarchical control approach for unmanned quadrotor transportation systems | |
Labbadi et al. | Robust integral terminal sliding mode control for quadrotor UAV with external disturbances | |
Sun et al. | Adaptive backstepping control of spacecraft rendezvous and proximity operations with input saturation and full-state constraint | |
Islam et al. | Robust control of four-rotor unmanned aerial vehicle with disturbance uncertainty | |
Luis et al. | Design of a trajectory tracking controller for a nanoquadcopter | |
Wu et al. | Robust $ L_ {\bm\infty} $-Gain fuzzy disturbance observer-based control design with adaptive bounding for a hypersonic vehicle | |
Skjetne | The maneuvering problem | |
Liu et al. | Robust formation tracking control for multiple quadrotors subject to switching topologies | |
CN104793629B (zh) | 一种飞艇三维航迹跟踪的反步神经网络控制方法 | |
Huang et al. | Postcapture robust nonlinear control for tethered space robot with constraints on actuator and velocity of space tether | |
CN105786013B (zh) | 面向输入饱和的迹向欠驱动航天器编队重构控制方法 | |
Lee et al. | Robust translational force control of multi-rotor UAV for precise acceleration tracking | |
Zheng et al. | Convergence and robustness analysis of novel adaptive multilayer neural dynamics-based controllers of multirotor UAVs | |
Rao et al. | A sliding mode controller for aircraft simulated entry into spin | |
Malekzadeh et al. | Attitude control of spacecraft simulator without angular velocity measurement | |
Chwa | Fuzzy adaptive output feedback tracking control of VTOL aircraft with uncertain input coupling and input-dependent disturbances | |
Chen et al. | An adaptive backstepping design for formation tracking motion in an unknown Eulerian specification flowfield | |
Wang et al. | Adaptive vector field guidance without a priori knowledge of course dynamics and wind | |
Santhakumar et al. | Robust adaptive tracking control of autonomous underwater vehicle-manipulator systems | |
Prach et al. | Development of a state dependent riccati equation based tracking flight controller for an unmanned aircraft | |
Kim et al. | Adaptive sliding mode control using slack variables for affine underactuated systems | |
Wan et al. | Adaptive sliding mode tracking control for unmanned autonomous helicopters based on neural networks |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |