CN108427281A - 一种航天器六自由度固定时间交会对接控制方法 - Google Patents
一种航天器六自由度固定时间交会对接控制方法 Download PDFInfo
- Publication number
- CN108427281A CN108427281A CN201810281838.0A CN201810281838A CN108427281A CN 108427281 A CN108427281 A CN 108427281A CN 201810281838 A CN201810281838 A CN 201810281838A CN 108427281 A CN108427281 A CN 108427281A
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- coordinate system
- propeller
- service
- matrix
- 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 28
- 238000009434 installation Methods 0.000 claims abstract description 52
- 230000003044 adaptive effect Effects 0.000 claims abstract description 11
- 239000011159 matrix material Substances 0.000 claims description 56
- 238000005096 rolling process Methods 0.000 claims description 46
- 239000013598 vector Substances 0.000 claims description 43
- 238000003032 molecular docking Methods 0.000 claims description 32
- 230000007704 transition Effects 0.000 claims description 12
- 210000001503 joint Anatomy 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 10
- 230000008878 coupling Effects 0.000 claims description 6
- 238000010168 coupling process Methods 0.000 claims description 6
- 238000005859 coupling reaction Methods 0.000 claims description 6
- 238000011217 control strategy Methods 0.000 claims description 5
- 238000012545 processing Methods 0.000 claims description 5
- 230000002457 bidirectional effect Effects 0.000 claims description 4
- 238000006243 chemical reaction Methods 0.000 claims description 3
- 238000013461 design Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000000630 rising effect Effects 0.000 claims description 3
- 241000272522 Anas Species 0.000 claims description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000007792 addition Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Software Systems (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)已有的处理服务航天器推进器安装偏差所采用的自适应 控制策略,容易出现参数过估计或者保守性较强的情况,会导致参数估计值与实际值出现较大偏差。
发明内容
本发明的目的在于克服现有技术的不足,提供一种航天器六自由度固定时间交会对接控制方 法,由于服务航天器的推进器在实际中会有安装偏差,并且服务航天器与翻滚目标航天器的交会对 接过程具有时间约束,所以为了实现针对两个问题的服务航天器高精度控制,具有固定时间特性的 滑模控制方法,设计的新型固定时间滑模面实现相关运动跟踪误差变量在固定时间内收敛,此外构 建的参数自适应规律用来估计推进器安装偏差角,防止出现参数过估计的现象,避免了参数估计值 与实际值的较大偏差,从而实现了具有鲁棒性的服务航天器六自由度交会对接控制。
本发明提供一种航天器六自由度固定时间交会对接控制方法,考虑了推进器安装偏差,包括 以下步骤:
(1)考虑服务航天器存在推进器安装偏差的情况下,构建其与翻滚目标航天器的六自由度交 会对接运动模型,该模型包括两个航天器之间的相对位置和相对姿态运动描述;
(2)基于步骤(1)建立的考虑推进器安装偏差的交会对接运动模型,利用相关运动变量, 设计一种固定时间滑模面;
(3)基于步骤(2)的滑模面设计固定时间交会对接控制器,并构建新的自适应律来估计推 进器安装偏差角。
其中,步骤(1)中考虑服务航天器存在推进器安装偏差的情况下,构建其与翻滚目标航天器的 六自由度交会对接运动模型,建模的具体过程为:
分别建立服务航天器和翻滚目标航天器的相关坐标系,为固连在目标航天 器质心的体坐标系,为固连在服务航天器质心的体坐标系,为固连在翻滚目标航天器质心的轨道坐标系,为固连在地 球中心的惯性坐标系:
首先,得到服务航天器与翻滚目标航天之间相对位置运动模型:
其中,ρ=[ρx,ρy,ρz]T为坐标系中服务航天器与翻滚目标航天器之间相对位置向量, Mt=mpI3,mp为服务航天器质量,I3为单位矩阵,式中×为3维向量对应的3×3阶叉 乘矩阵,三维向量X=[X1,X2,X3]T,其对应的叉乘矩阵为X×=[0,-X3,X2;X3,0,-X1;-X2,X1,0]T, μ为地球引力 系数,v为服务航天器真近角,服务航天器质心与地球中心的距离为翻 滚目标航天器质心与地球中心之间的距离为rt,nt=mpn2,代表 服务航天器在坐标系内的控制力向量,代表在坐标系内服务航天器受到的各类干扰 力向量。此外v的一阶导数和二阶导数满足:
其中,为目标航天器的平动角速度,a为翻滚目标航天器的轨道半长轴,e为翻 滚目标航天器的轨道偏心率;
其次,考虑服务航天器与翻滚目标航天器之间相对姿态运动模型:
其中,为服务航天器与翻滚目标航天器姿态误差四元数, 为四元数的乘法运算,为qt的共轭四元数,为向量 qpv的叉乘矩阵,为向量qev的叉乘矩阵,为在坐标系中服务航天器与翻滚目 标航天器角速度偏差,且为坐标系和坐标系之间的转换 矩阵,和分别表示服务航天器在坐标系中的姿 态四元数和角速度;表示服务航天器的惯性矩阵,为服务航天器在坐标系中 的控制力矩,为服务航天器在坐标系中所受的外界干扰力矩;和分别为翻滚目标航天器在坐标系中的姿态四元数和角速度;
获取更紧凑的服务航天器与翻滚目标航天器相对姿态运动模型:
其中,P=Q-1,Mr=PTJpP, 为向量的 叉乘矩阵,为向量的叉乘矩阵,为向量的叉乘矩阵,为向量ωe的叉 乘矩阵;
对于交会对接过程相对位置运动模型,考虑到相对姿态耦合因素,得到更加实际的模型为:
其中,ρe=ρ-ρd,ρd=Cltrd,rd=[rd,0,0]T为服务航天器在坐标系中的期望位置向量, 为坐标系和坐标系之间的转换矩阵,为坐标系和坐标系之间 的转换矩阵,为坐标系和坐标系之间的转换矩阵,为向 量qtv的叉乘矩阵,坐标系和坐标系的转换矩阵为ω,Ω,i分别为翻滚目标航天器 轨道的近点角幅角,升交点赤经,倾角。
得到服务航天器与翻滚目标航天器交会对接过程中相对运动的六自由度姿态轨道耦合模型:
其中,G=[(ClpH1)T,(PTH2)T]T,
其中,服务航天器装备的推进器系统为其调整轨道和姿态提供控制输入u,考虑安装6个双向 推进器的推进器构型,每个推进器提供双向推力,其中L1,L2,L3对应航天器的外形尺寸,推进器 的期望安装方向为与坐标系的各个坐标轴线平行,考虑安装容许偏差,每个推进器均与期望安 装方向存在安装偏差角Δαi,Δβi,(i=1,2,...,6),推进器的实际输出推力与控制器给推进器的控制指 令存在一个幅值偏差,因此得到服务航天器的推进器控制指令与推进器系统实际生成的控制力和 控制力矩对应关系为
其中,Fu=[F1,F2,...,F6]T为推进器实际输出的控制力,FC=[FC1,FC2,...,FC6]T为控制器设计的 推进器输出控制力,为待设计控制策略;为推进器的推力输出指令和推力实际 输出值之间的幅值偏差,且是第i个推进器的推力输出指令和推力实 际输出值之间的幅值偏差,D为服务航天器的推进器构型矩阵,D0为服务航天器的推进器标称构 型矩阵,DΔ为服务航天器的推进器偏差构型矩阵。为简化处理,与推进器安装偏差角相关变量为 sΔαi=sinΔαi,cΔαi=cosΔαi,sΔβi=sinΔβi,cΔβi=cosΔβi,(i=1,2,...,6),同时考虑到安装偏差角 均为小值,因此认为sΔαi≈Δαi,cΔαi≈1,sΔβi≈Δβi,cΔβi≈1,Δαi·Δβi≈0,进而得到D和DΔ 的近似表达式:
其中,步骤(2)中的固定时间滑模面具体为:
其中,S为滑模面,K1=diag{K11,K12,...,K16}为待设计参数,Sau=[Sau1,Sau2,...,Sau6]T,且
其中, ε>0为待设计参数,0<p1<1 为待设计两个正奇数之比。
其中,步骤(3)中固定时间交会对接控制器以及新的推进器安装偏差角自适应律为:
首先假设服务航天器所受外界干扰d和推进器输出幅值偏差有界,则存在未知正常数dup满足范数假设推进器安装偏差角相关向量Θ=[Δα1,Δα2,Δα3,Δα4,Δα5,Δα6]T未 知,但其范数因为安装精度要求存在一个已知上界MΘ>0,也即满足||Θ||≤MΘ;
服务航天器固定时间交会对接控制器为:
其中K2=diag{K21,K22,...,K26}为待设计参数, 为DΔ的估计,为的伪逆,其中为dup的估计,Υ>0为待设计参数;
参数的自适应律为:
推进器安装偏差角Θ的估计值的自适应律为:
其中,涉及的自适应相关参数如下,c1=σ1(2θ1-1)/(2θ1),c2=σ2(2θ2-1)/(2θ2),σ1>0,σ2>0,θ1>0.5,θ2>0.5,具有如下形式:
其中,为待设计参数,为的获取提供了条件,因为满足
H=[FC1,-FC2,0,0,0,0;0,0,FC3,-FC4,0,0;0,0,0,0,-FC5,FC6;0,0,-L3FC3
/2,-L3FC4/2,0,0;0,0,0,0,L1FC5/2,L1FC6/2;-L2FC1/2,-L2FC2/2,0,0,0,0]。
本发明与现有技术相比的优点在于:
(1)与基于滑模控制的六自由度航天器交会对接控制器相比,设计的新型固定时间滑模面具 有较少的参数,即可以实现服务航天器在固定时间内完成交会对接任务,并且该固定时间上界不因 为系统初始状态的不同而发生变化,更符合任务需求。
(2)与以往关于航天器推进器安装偏差的进行自适应处理方法不同,本发明直接对推进器主 要安装偏差角进行估计,并且避免了参数过估计的问题,降低了之前自适应律的保守性,更适合在 工程中应用。
附图说明
图1为考虑推进器安装偏差的航天器六自由度固定时间交会对接控制方法流程框图;
图2为全部坐标系建立示意图;
图3为服务航天器期望推进器安装构型;
图4为服务航天器推进器安装偏差示意图。
具体实施方式
下面详细说明本发明的具体实施,有必要在此指出的是,以下实施只是用于本发明的进一步说 明,不能理解为对本发明保护范围的限制,该领域技术熟练人员根据上述本发明内容对本发明做出 的一些非本质的改进和调整,仍然属于本发明的保护范围。
本发明提供了一种航天器六自由度固定时间交会对接控制方法,考虑了推进器安装偏差,如图 1所示,具体步骤为:
首先基于考虑推进器安装偏差的服务航天器对一个自由翻滚的目标航天器相对运动规律,构建 相应的六自由度交会对接模型;然后利用相关运动变量,设计一种新型固定时间滑模面;最后设计 出固定时间交会对接控制器,并且构建了新的自适应规律来估计推进器安装偏差角。
具体实施步骤如下:
第一步,考虑推进器安装偏差的服务航天器对一个自由翻滚的目标航天器相对运动规律,构 建相应的六自由度交会对接模型:
分别建立服务航天器和翻滚目标航天器的相关坐标系,如图2所示,为固连 在目标航天器质心的体坐标系,为固连在服务航天器质心的体坐标系, 为固连在翻滚目标航天器质心的轨道坐标系,为固连在地球中 心的惯性坐标系。
首先,得到服务航天器与翻滚目标航天之间相对位置运动模型:
其中,ρ=[ρx,ρy,ρz]T为坐标系中服务航天器与翻滚目标航天器之间相对位置向量,Mt=mpI3, mp为服务航天器质量,I3为单位矩阵,为向量n1的叉乘矩阵,式中×为3维向量对 应的3×3阶叉乘矩阵,例如,一个三维向量X=[X1,X2,X3]T,其对应的叉乘矩阵为 X×=[0,-X3,X2;X3,0,-X1;-X2,X1,0]T, μ为地球引力系数,v为服务航天器真近角,服 务航天器质心与地球中心的距离为翻滚目标航天器质心与地球中心之间的距离为rt,nt=mpn2,代表服务航天器在坐标系内的控制力向量,代表在坐标系内表示的服务航天器受到的各类干扰力向量。此外v的一阶导 数和二阶导数满足:
其中,为目标航天器的平动角速度,a为翻滚目标航天器的轨道半长轴,e为翻滚目标 航天器的轨道偏心率。
其次,考虑服务航天器与翻滚目标航天器之间相对姿态运动模型:
其中,为服务航天器与翻滚目标航天器姿态误差四元数, 为四元数的乘法运算,为qt的共轭四元数,为向量 qpv的叉乘矩阵,为向量qev的叉乘矩阵,为在坐标系中服务航天器与翻滚目 标航天器角速度偏差,为坐标系和坐标系之间的转换矩 阵,和分别表示服务航天器在坐标系中的姿态 四元数和角速度;表示服务航天器的惯性矩阵,为服务航天器在坐标系中的 控制力矩,为服务航天器在坐标系中所受的外界干扰力矩;和分别为翻滚目标航天器在坐标系中的姿态四元数和角速度。
根据(3)和(4)得到更紧凑的服务航天器与翻滚目标航天器相对姿态运动模型:
其中,P=Q-1,Mr=PTJpP, 为向量的 叉乘矩阵,为向量的叉乘矩阵,为向量的叉乘矩阵,为向量ωe的叉 乘矩阵。
对于交会对接过程相对位置运动模型,考虑到相对姿态耦合因素,得到比(1)更加实际的模 型为:
其中,ρe=ρ-ρd,ρd=Cltrd,rd=[rd,0,0]T为服务航天器在坐标系中的期望位置向量,为坐标系和坐标系之间的转换矩阵,为坐标系和坐标系之间的转换矩 阵,为坐标系和坐标系之间的转换矩阵,为向量qtv的叉 乘矩阵,坐标系和坐标系的转换矩阵为ω,Ω,i分别为翻滚目标航天器 轨道的近点角幅角,升交点赤经,倾角。
结合(5)以及(6)得到服务航天器与翻滚目标航天器交会对接过程中相对运动的六自由度 姿态轨道耦合模型:
其中,G=[(ClpH1)T,(PTH2)T]T,
服务航天器装备的推进器系统为其调整轨道和姿态提供控制输入u。考虑一种安装6个双向推 进器(每个推进器可提供双向推力)的推进器构型,如图3所示,其中L1,L2,L3对应航天器的外形 尺寸,推进器的期望安装方向为与坐标系的各个坐标轴线平行。但是考虑安装容许偏差,每个 推进器均与期望安装方向存在安装偏差角Δαi,Δβi,(i=1,2,...,6),如图4所示;而且推进器的实际输 出推力与控制器给推进器的控制指令存在一个幅值偏差。因此得到服务航天器的推进器控制指令 与推进器系统实际生成的控制力和控制力矩对应关系为
其中,Fu=[F1,F2,...,F6]T为推进器实际输出的控制力,FC=[FC1,FC2,...,FC6]T为控制器设计的推进 器输出控制力,为待设计控制策略;为推进器的推力输出指令和推力实际输出 值之间的幅值偏差,且是第i个推进器的推力输出指令和推力实际输 出值之间的幅值偏差,D为服务航天器的推进器构型矩阵,D0为服务航天器的推进器标称构型矩 阵,DΔ为服务航天器的推进器偏差构型矩阵。为简化处理,与推进器安装偏差角相关变量为 sΔαi=sinΔαi,cΔαi=cosΔαi,sΔβi=sinΔβi,cΔβi=cosΔβi,(i=1,2,...,6),同时考虑到安装偏差角 均为小值,因此认为sΔαi≈Δαi,cΔαi≈1,sΔβi≈Δβi,cΔβi≈1,Δαi·Δβi≈0,进而得到D和DΔ 的近似表达式:
第二步,基于第一步考虑推进器安装偏差的服务航天器与翻滚目标航天器的六自由度交会对 接模型,设计一种新型固定时间滑模面:
其中,S为滑模面,K1=diag{K11,K12,...,K16}为待设计参数,Sau=[Sau1,Sau2,...,Sau6]T,且
其中, ε>0为待设计参数,0<p1<1 为待设计两个正奇数之比。
第三步,基于第二步的新型固定时间滑模面设计出固定时间交会对接控制器,并且构建了新 的自适应规律来估计推进器安装偏差角:
首先假设服务航天器所受外界干扰d和推进器输出幅值偏差有界,则存在未知正常数dup满足范数假设推进器安装偏差角相关向量Θ=[Δα1,Δα2,Δα3,Δα4,Δα5,Δα6]T未 知,但其范数因为安装精度要求存在一个已知上界MΘ>0,也即满足||Θ||≤MΘ。
服务航天器固定时间交会对接控制器为:
其中K2=diag{K21,K22,...,K26}为待设计参数, 为DΔ的估计,为的伪逆,其中为dup的估计,Υ>0为待设计参数。
参数的自适应律为:
推进器安装偏差角Θ的估计值的自适应律为:
其中,(11)和(12)涉及的自适应相关参数如下,c1=σ1(2θ1-1)/(2θ1),c2=σ2(2θ2-1)/(2θ2), σ1>0,σ2>0,θ1>0.5,θ2>0.5,具有如下形式:
其中,为待设计参数,
这里为的获取提供了条件,因为满足H=[FC1,-FC2,0,0,0,0; 0,0,FC3,-FC4,0,0;0,0,0,0,-FC5,FC6;0,0,-L3FC3/2,-L3FC4/2,0,0;0,0,0,0,L1FC5/2,L1FC6/2;-L2FC1/2,-L2FC2/ 2,0,0,0,0]。
尽管为了说明的目的,已描述了本发明的示例性实施方式,但是本领域的技术人员将理解,不 脱离所附权利要求中公开的发明的范围和精神的情况下,可以在形式和细节上进行各种修改、添加 和替换等的改变,而所有这些改变都应属于本发明所附权利要求的保护范围,并且本发明要求保护 的产品各个部门和方法中的各个步骤,可以以任意组合的形式组合在一起。因此,对本发明中所公 开的实施方式的描述并非为了限制本发明的范围,而是用于描述本发明。相应地,本发明的范围不 受以上实施方式的限制,而是由权利要求或其等同物进行限定。
Claims (5)
1.一种航天器六自由度固定时间交会对接控制方法,考虑了推进器安装偏差,其特征在于,包括以下步骤:(1)考虑服务航天器存在推进器安装偏差的情况下,构建其与翻滚目标航天器的六自由度交会对接运动模型,该模型包括两个航天器之间的相对位置和相对姿态运动描述;
(2)基于步骤(1)建立的考虑推进器安装偏差的交会对接运动模型,利用相关运动变量,设计一种固定时间滑模面;
(3)基于步骤(2)的滑模面设计固定时间交会对接控制器,并构建新的自适应律来估计推进器安装偏差角。
2.根据权利要求1所述的方法,其特征在于:步骤(1)中考虑服务航天器存在推进器安装偏差的情况下,构建其与翻滚目标航天器的六自由度交会对接运动模型,建模的具体过程为:
分别建立服务航天器和翻滚目标航天器的相关坐标系,为固连在目标航天器质心的体坐标系,为固连在服务航天器质心的体坐标系,为固连在翻滚目标航天器质心的轨道坐标系,为固连在地球中心的惯性坐标系:
首先,得到服务航天器与翻滚目标航天之间相对位置运动模型:
其中,ρ=[ρx,ρy,ρz]T为坐标系中服务航天器与翻滚目标航天器之间相对位置向量,Mt=mpI3,mp为服务航天器质量,I3为单位矩阵,式中×为3维向量对应的3×3阶叉乘矩阵,三维向量X=[X1,X2,X3]T,其对应的叉乘矩阵为X×=[0,-X3,X2;X3,0,-X1;-X2,X1,0]T, μ为地球引力系数,v为服务航天器真近角,服务航天器质心与地球中心的距离为翻滚目标航天器质心与地球中心之间的距离为rt,nt=mpn2, 代表服务航天器在坐标系内的控制力向量,代表在坐标系内服务航天器受到的各类干扰力向量,此外v的一阶导数和二阶导数满足:
其中,为目标航天器的平动角速度,a为翻滚目标航天器的轨道半长轴,e为翻滚目标航天器的轨道偏心率;
其次,考虑服务航天器与翻滚目标航天器之间相对姿态运动模型:
其中,为服务航天器与翻滚目标航天器姿态误差四元数, 为四元数的乘法运算,为qt的共轭四元数,为向量qpv的叉乘矩阵,为向量qev的叉乘矩阵,为在坐标系中服务航天器与翻滚目标航天器角速度偏差,且为坐标系和坐标系之间的转换矩阵,和分别表示服务航天器在坐标系中的姿态四元数和角速度;表示服务航天器的惯性矩阵,为服务航天器在坐标系中的控制力矩,为服务航天器在坐标系中所受的外界干扰力矩;和分别为翻滚目标航天器在坐标系中的姿态四元数和角速度;
获取更紧凑的服务航天器与翻滚目标航天器相对姿态运动模型:
其中,P=Q-1,Mr=PTJpP, 为向量的叉乘矩阵,为向量的叉乘矩阵,为向量的叉乘矩阵,为向量ωe的叉乘矩阵;
对于交会对接过程相对位置运动模型,考虑到相对姿态耦合因素,得到更加实际的模型为:
其中,ρe=ρ-ρd,ρd=Cltrd,rd=[rd,0,0]T为服务航天器在坐标系中的期望位置向量,为坐标系和坐标系之间的转换矩阵,为坐标系和坐标系之间的转换矩阵,为坐标系和坐标系之间的转换矩阵,为向量qtv的叉乘矩阵,坐标系和坐标系的转换矩阵为ω,Ω,i分别为翻滚目标航天器轨道的近点角幅角,升交点赤经,倾角;
得到服务航天器与翻滚目标航天器交会对接过程中相对运动的六自由度姿态轨道耦合模型:
其中,G=[(ClpH1)T,(PTH2)T]T,
3.根据权利要求2所述的方法,其特征在于:服务航天器装备的推进器系统为其调整轨道和姿态提供控制输入u,考虑安装6个双向推进器的推进器构型,每个推进器提供双向推力,其中L1,L2,L3对应航天器的外形尺寸,推进器的期望安装方向为与坐标系的各个坐标轴线平行,考虑安装容许偏差,每个推进器均与期望安装方向存在安装偏差角Δαi,Δβi,(i=1,2,...,6),推进器的实际输出推力与控制器给推进器的控制指令存在一个幅值偏差,因此得到服务航天器的推进器控制指令与推进器系统实际生成的控制力和控制力矩对应关系为:
其中,Fu=[F1,F2,...,F6]T为推进器实际输出的控制力,FC=[FC1,FC2,...,FC6]T为控制器设计的推进器输出控制力,为待设计控制策略;为推进器的推力输出指令和推力实际输出值之间的幅值偏差,且 是第i个推进器的推力输出指令和推力实际输出值之间的幅值偏差,D为服务航天器的推进器构型矩阵,D0为服务航天器的推进器标称构型矩阵,DΔ为服务航天器的推进器偏差构型矩阵,为简化处理,与推进器安装偏差角相关变量为sΔαi=sinΔαi,cΔαi=cosΔαi,sΔβi=sinΔβi,cΔβi=cosΔβi,(i=1,2,...,6)同时考虑到安装偏差角均为小值,因此认为sΔαi≈Δαi,cΔαi≈1,sΔβi≈Δβi,cΔβi≈1,Δαi·Δβi≈0进而得到D和DΔ的近似表达式:
4.根据权利要求1所述的方法,其特征在于:步骤(2)中的固定时间滑模面具体为:
其中,S为滑模面,K1=diag{K11,K12,...,K16}为待设计参数,Sau=[Sau1,Sau2,...,Sau6]T,且
其中, ε>0为待设计参数,0<p1<1为待设计两个正奇数之比。
5.根据权利要求1所述的方法,其特征在于:步骤(3)中固定时间交会对接控制器以及新的推进器安装偏差角自适应律为:
首先假设服务航天器所受外界干扰d和推进器输出幅值偏差有界,则存在未知正常数dup满足范数假设推进器安装偏差角相关向量Θ=[Δα1,Δα2,Δα3,Δα4,Δα5,Δα6]T未知,但其范数因为安装精度要求存在一个已知上界MΘ>0,也即满足||Θ||≤MΘ;
服务航天器固定时间交会对接控制器为:
其中,K2=diag{K21,K22,...,K26}为待设计参数,W(e)=diag{W1,W2,...,W6}, 为DΔ的估计,为的伪逆,其中为dup的估计,Υ>0为待设计参数;
参数的自适应律为:
推进器安装偏差角Θ的估计值的自适应律为:
其中,涉及的自适应相关参数如下,c1=σ1(2θ1-1)/(2θ1),c2=σ2(2θ2-1)/(2θ2),σ1>0,σ2>0,θ1>0.5,θ2>0.5,具有如下形式:
其中,为待设计参数,为的获取提供了条件,因为满足
H=[FC1,-FC2,0,0,0,0;0,0,FC3,-FC4,0,0;0,0,0,0,-FC5,FC6;0,0,-L3FC3
/2,-L3FC4/2,0,0;0,0,0,0,L1FC5/2,L1FC6/2;-L2FC1/2,-L2FC2/2,0,0,0,0]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810281838.0A CN108427281B (zh) | 2018-04-02 | 2018-04-02 | 一种航天器六自由度固定时间交会对接控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810281838.0A CN108427281B (zh) | 2018-04-02 | 2018-04-02 | 一种航天器六自由度固定时间交会对接控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108427281A true CN108427281A (zh) | 2018-08-21 |
CN108427281B CN108427281B (zh) | 2020-04-21 |
Family
ID=63159798
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810281838.0A Active CN108427281B (zh) | 2018-04-02 | 2018-04-02 | 一种航天器六自由度固定时间交会对接控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108427281B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109245518A (zh) * | 2018-09-13 | 2019-01-18 | 浙江工业大学 | 一种降压型直流变换器固定时间滑模控制方法 |
CN110502028A (zh) * | 2019-09-18 | 2019-11-26 | 中国人民解放军军事科学院国防科技创新研究院 | 一种空间翻滚目标位姿同步跟踪控制方法 |
CN112046794A (zh) * | 2020-07-16 | 2020-12-08 | 中国人民解放军军事科学院国防科技创新研究院 | 基于混合高斯模型的固定时间约束的航天器集群控制方法 |
CN116804853A (zh) * | 2023-08-25 | 2023-09-26 | 季华实验室 | 挠性航天器姿态控制方法、装置、电子设备及存储介质 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090132105A1 (en) * | 2007-08-17 | 2009-05-21 | Princeton Satellite Systems, Inc. | Proximity Spacecraft Maneuvering |
CN102354217A (zh) * | 2011-06-24 | 2012-02-15 | 哈尔滨工业大学 | 一种脉冲推力作用下的航天器自主交会控制方法 |
CN103576689A (zh) * | 2013-10-08 | 2014-02-12 | 北京控制工程研究所 | 一种交会对接六自由度相对控制方法 |
CN104071357A (zh) * | 2014-07-08 | 2014-10-01 | 上海新跃仪表厂 | 一种空间交会对接装置 |
CN104181928A (zh) * | 2014-09-15 | 2014-12-03 | 大连大学 | 航天器双环滑模变结构姿态控制参数优化方法 |
-
2018
- 2018-04-02 CN CN201810281838.0A patent/CN108427281B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20090132105A1 (en) * | 2007-08-17 | 2009-05-21 | Princeton Satellite Systems, Inc. | Proximity Spacecraft Maneuvering |
CN102354217A (zh) * | 2011-06-24 | 2012-02-15 | 哈尔滨工业大学 | 一种脉冲推力作用下的航天器自主交会控制方法 |
CN103576689A (zh) * | 2013-10-08 | 2014-02-12 | 北京控制工程研究所 | 一种交会对接六自由度相对控制方法 |
CN104071357A (zh) * | 2014-07-08 | 2014-10-01 | 上海新跃仪表厂 | 一种空间交会对接装置 |
CN104181928A (zh) * | 2014-09-15 | 2014-12-03 | 大连大学 | 航天器双环滑模变结构姿态控制参数优化方法 |
Non-Patent Citations (7)
Title |
---|
BOYAN JIANG 等: "Fixed一Ti me Rendezvous Control of Spacecraft With a Tumbling Target Under Loss of Actuator Effectiveness", 《IEEE TRANSACTIONS ON AEROSPACE AND ELECTRONIC SYSTEMS》 * |
JINGWEI DONG 等: "Fixed-Time Nonsingular Terminal Sliding Mode Control for Spacecraft Rendezvous", 《2017 29TH CHINESE CONTROL AND DECISION CONFERENCE (CCDC)》 * |
姜博严 等: "与自由翻滚目标近距离段交会对接的相对姿轨祸合控制", 《宇航学报》 * |
石忠 等: "考虑推力器安装偏差的航天器饱和控制器设计", 《HTTP://WWW.WANFANGDATA.COM.CN/DETAILS/DETAIL.DO?_TYPE=CONFERENCE&ID=WFHYXW562270》 * |
胡庆雷 等: "考虑推力器安装偏差的航天器姿态机动有限时间控制", 《控制理论与应用》 * |
郭永 等: "非合作交会对接的姿态和轨道祸合控制", 《控制理论与应用》 * |
霍星 等: "执行器安装存在偏差的航天器姿态有限时间控制", 《PROCEEDINGS OF THE 32ND CHINESE CONTROL CONFERENCE》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109245518A (zh) * | 2018-09-13 | 2019-01-18 | 浙江工业大学 | 一种降压型直流变换器固定时间滑模控制方法 |
CN110502028A (zh) * | 2019-09-18 | 2019-11-26 | 中国人民解放军军事科学院国防科技创新研究院 | 一种空间翻滚目标位姿同步跟踪控制方法 |
CN110502028B (zh) * | 2019-09-18 | 2020-10-13 | 中国人民解放军军事科学院国防科技创新研究院 | 一种空间翻滚目标位姿同步跟踪控制方法 |
CN112046794A (zh) * | 2020-07-16 | 2020-12-08 | 中国人民解放军军事科学院国防科技创新研究院 | 基于混合高斯模型的固定时间约束的航天器集群控制方法 |
CN112046794B (zh) * | 2020-07-16 | 2022-02-25 | 中国人民解放军军事科学院国防科技创新研究院 | 基于混合高斯模型的固定时间约束的航天器集群控制方法 |
CN116804853A (zh) * | 2023-08-25 | 2023-09-26 | 季华实验室 | 挠性航天器姿态控制方法、装置、电子设备及存储介质 |
CN116804853B (zh) * | 2023-08-25 | 2023-11-07 | 季华实验室 | 挠性航天器姿态控制方法、装置、电子设备及存储介质 |
Also Published As
Publication number | Publication date |
---|---|
CN108427281B (zh) | 2020-04-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108427281B (zh) | 一种航天器六自由度固定时间交会对接控制方法 | |
CN109189085B (zh) | 基于事件触发的航天器网络化系统姿态控制方法 | |
CN108803649B (zh) | 一种垂直起降重复使用运载器自抗扰滑模控制方法 | |
CN106814746B (zh) | 一种航天器姿轨一体化反步跟踪控制方法 | |
CN105353763B (zh) | 一种非合作目标航天器相对轨道姿态有限时间控制方法 | |
Wang et al. | Integrated relative position and attitude control for spacecraft rendezvous with ISS and finite-time convergence | |
CN105843244A (zh) | 一种基于输出反馈的挠性航天器精细姿态控制方法 | |
CN109911249B (zh) | 低推重比飞行器的星际转移有限推力入轨迭代制导方法 | |
CN106970530B (zh) | 空间非合作目标自主视线交会的无模型预设性能控制方法 | |
CN106054884B (zh) | 基于神经网络的l1自适应船舶动力定位双环控制系统 | |
CN108375904B (zh) | 一种非合作目标航天器交会对接最终段饱和控制方法 | |
CN107703742A (zh) | 一种柔性航天器传感器故障调节方法 | |
CN106774360B (zh) | 一种拖曳变轨中利用系绳与连杆的目标星姿态稳定方法 | |
CN109885075A (zh) | 一种基于t-s模糊建模的卫星姿态抗干扰容错控制方法 | |
CN105867382A (zh) | 一种基于等效干扰补偿的船舶动力定位控制系统 | |
Zhang et al. | Output-feedback super-twisting control for line-of-sight angles tracking of non-cooperative target spacecraft | |
CN114779799B (zh) | 基于扩张干扰观测器的柔性航天器姿轨跟踪控制方法 | |
CN109677637A (zh) | 基于光学测角相机的空间非合作目标跟踪指向方法 | |
CN111506095A (zh) | 一种双刚体特征点间饱和固定时间相对位姿跟踪控制方法 | |
CN109018442B (zh) | 新型低成本卫星三轴姿态分时解耦高复用喷气控制方法 | |
CN113485395B (zh) | 一种误差约束下固定时间相对姿轨跟踪控制方法 | |
Löbl et al. | Cooperative docking guidance and control with application to civil autonomous aerial refueling | |
CN110502028A (zh) | 一种空间翻滚目标位姿同步跟踪控制方法 | |
CN113485396A (zh) | 一种航天器交会对接最后逼近段相对轨道与姿态跟踪控制方法 | |
Dong et al. | Fixed-time nonsingular terminal sliding mode control for spacecraft rendezvous |
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 |