首页 / 专利库 / 控制系统 / 正向体偏置 / 一种卫星初态阶段自适应容错姿态控制方法

一种卫星初态阶段自适应容错姿态控制方法

阅读:87发布:2024-02-13

专利汇可以提供一种卫星初态阶段自适应容错姿态控制方法专利检索,专利查询,专利分析的服务。并且一种卫星初态阶段自适应容错 姿态 控制方法,包括基于星箭成功分离后初态控制阶段,建立太阳帆板展开过程卫星 转动惯量 不确定性模型:建立卫星姿态动 力 学模型;利用预设性能函数,建立姿态的非线性映射模型;基于建立太阳帆板展开过程卫星转动惯量不确定性模型,卫星姿态动力学模型和姿态的非线性映射模型,利用反步法设计自适应容错 控制器 ,通过该方法解决了卫星在初态控制阶段转动惯量不确定性、执行器故障且受到外部扰动力矩影响时的姿态稳定问题,保证了姿态控制系统的容错能力和鲁棒性,并且确保了姿态收敛速度、超调和收敛误差满足预先设定的要求。,下面是一种卫星初态阶段自适应容错姿态控制方法专利的具体信息内容。

1.一种卫星初态阶段自适应容错姿态控制方法,其特征在于,包括如下步骤:
(1)基于星箭成功分离后初态控制阶段,建立太阳帆板展开过程卫星转动惯量不确定性模型:
(2)建立卫星姿态动学模型;
(3)利用预设性能函数,建立姿态的非线性映射模型;
(4)基于建立太阳帆板展开过程卫星转动惯量不确定性模型,卫星姿态动力学模型和姿态的非线性映射模型,利用反步法设计自适应容错控制器
所述步骤(2)中建立卫星姿态动力学模型具体为:
Q(q)=q0I3+qv×
其中, 为卫星的姿态单位四元数,表示卫星在本体坐标系下相对于惯
性坐标系的旋转姿态,q0为四元数的标量部分,qv为矢量部分,且满足 ω=
[ω1,ω2,ω3]T为卫星在本体坐标系下相对于惯性坐标系的姿态速度;J为整个卫星系统的转动惯量矩阵;D∈R3×n表示执行器的安装矩阵,满足秩rank(D)=3,n≥3;
表示执行器实际输出的控制力矩, 为
执行器失效矩阵,0≤ei(t)≤1表示每个执行器的失效情况,当ei(t)=1表示执行器正常工作,当0<ei(t)<1表示执行器出现部分失效情况,当ei(t)=0表示执行器处于完全失效;
表示执行器实际产生的控制力矩; 表示偏置
力矩带来的附加故障,假定其有界; 表示卫星受到的空间环境中的干扰力矩,假定其有界,满足 表示单位矩阵 ; 表示关于任意向 量
的斜对称矩阵,其形式如下:
2.如权利要求1所述的一种卫星初态阶段自适应容错姿态控制方法,其特征在于:所述步骤(1)中卫星转动惯量不确定性模型为:
J=Jm-Jnψ(t)
其中, 是整星的转动惯量矩阵,为正定的对称矩阵; 是转动惯量中刚性
部分,为未知不变的对称矩阵; 是转动惯量中非刚性部分,为时变的,
是非刚性部分的增益,为未知的定常数矩阵, 是已知时变的,反映太阳帆板展开过程中帆板质心的移动。
3.如权利要求2所述的一种卫星初态阶段自适应容错姿态控制方法,其特征在于:整星转动惯量J对时间的一阶微分可写为以下形式:
4.如权利要求1所述的一种卫星初态阶段自适应容错姿态控制方法,其特征在于:所述步骤(3)具体为:
利用预设性能函数,对姿态进行非线性映射,定义函数:
其中,ε=[ε1,ε2,ε3]T为经过非线性映射后的变量; 表示所选
的预设性能函数,是严格非负且递减的,ρ0=[ρ10,ρ20,ρ30]T为性能函数的初始值,且ρi0>0,ρi∞=[ρ1∞,ρ2∞,ρ3∞]T表示性能函数的稳态值,且ρi∞>0;l=[l1,l2,l3]T决定性能函数的收敛速度;qvi(0)为姿态四元数矢量的初始值;qvi(t)与ρi(t)的关系满足以下条件:
δ=[δ1,δ2,δ3]T为预设性能参数,通过其值的改变,反映qvi收敛暂态过程中超调量的大小,当δi=0,姿态四元数矢量部分收敛过程无超调;通过预设性能函数保证qvi收敛的暂态和稳态性能;
通过求解S(ε)的逆函数T,得到非线性映射后的变量εi有如下形式:
选取T的形式如下:
对时间的一阶微分如下:
其中,
5.如权利要求4所述的一种卫星初态阶段自适应容错姿态控制方法,其特征在于:通过对姿态进行非线性映射,变量ε收敛,使qv按照预设的暂态和稳态性能进行收敛,满足稳态误差、收敛速度、超调方面的要求。
6.如权利要求1所述的一种卫星初态阶段自适应容错姿态控制方法,其特征在于:所述步骤(4)具体为
引入两个新的变量z1=ε,z2=ω-α,分别求得时间的一阶导数如下:
利用反步法,可得虚拟控制器:
其中,c1>0,γ>0为虚拟控制器的增益;
利用非线性回归矩阵进行转化模型得:
其中 为关于Jm的线性回归量, 为关于的Jn
线性回归量;W1,W2,W3为与转动惯量线性回归变量相对应的矩阵,满足以下形式:
基于虚拟控制器,设计容错控制器为:
自适应更新律为:
其中,b=[||θ||,||σ||,dm]T;Φ=[||W1||,||W2+W3||,1]T;c2>0,c3>0,c4>0为与控制器相关的增益参数;参数选择满足条件1/(2γc2)<λmin(DEDT)。

说明书全文

一种卫星初态阶段自适应容错姿态控制方法

技术领域

[0001] 本发明涉及航天器控制技术领域,具体涉及一种卫星初态阶段自适应容错姿态控制方法。

背景技术

[0002] 航天技术逐渐影响着人们的日常生活,其中人造卫星在通信、导航、气象等方面发挥着越来越重要的作用。星箭分离后,卫星进入初态控制阶段。在初态控制阶段,安装在卫星上的太阳帆板会慢慢展开。太阳帆板展开必定会使整个卫星的转动惯量发生变化,这将给卫星的姿态稳定控制带来一定的挑战。初态控制阶段时间相对整个卫星寿命来说虽然较短,但由于初态控制是卫星稳态控制的基础,它的失败将造成整个卫星姿态的失常,使卫星无法完成后续的在轨期间的任务,因此,卫星初态阶段姿态稳定控制尤为重要。同时,卫星的姿态控制系统本身就是一个结构复杂的系统,并且在恶劣的太空环境中工作,这增加了卫星执行器发生故障的可能性。而且,卫星在空间中还会受到来自外部环境等多种干扰矩的影响,这就要求姿态控制系统具有一定的抗干扰能力和容错能力。此外,卫星初态稳定控制中保证姿态的暂态和稳态性能,避免出现大的超调和稳态误差,尽快实现姿态稳定是确保卫星姿态控制系统精确性和稳定性的关键。因此,保证初态控制阶段卫星姿态控制系统能够实现在转动惯量不确定性、执行器故障和外部干扰作用下的容错控制,并且保证姿态能够按照预设的暂态和稳态性能要求收敛是卫星初态阶段姿态稳定控制的重要任务。
[0003] 针对航天器转动惯量不确定性问题,专利CN201610369411首先建立多源干扰环境下组合体航天器运动学和动力学模型,然后,设计干扰观测器对转动惯量不确定性和未建模动态干扰进行估计,最后,结合干扰观测器,设计抗饱和姿态稳定控制器,实现航天器复合分层抗干扰姿态稳定,但是其中忽略了执行器发生故障的影响,并且未涉及保证姿态控制中的暂态和稳态性能问题;专利CN201611012008通过建立采用自适应阈值技术的故障检测观测器和基于自适应技术的故障估计观测器,对航天器的执行器失效故障和偏差故障实现在线实时监测和估计,然后设计backsteeping滑模容错控制器实现姿态稳定,然而在线实时监测和估计将给星载计算机带来巨大的计算量,对星载计算机的计算能力和存储空间提出了更高的要求,增加了姿态控制系统的复杂性;专利CN201610217207针对执行器故障、外部扰动和控制力矩幅值受限问题,设计积分滑模容错控制器有效提高在轨航天器执行器故障时的姿态控制系统稳定性和对外部扰动的鲁棒性,但是未考虑转动惯量不确定性对姿态控制系统的影响;专利CN201611208106在惯量矩阵未知、包含外部扰动的条件下,设计预设性能指标,对姿态跟踪制模型进行非线性映射,最后进行无模型鲁棒控制器设计,实现航天器姿态稳定跟踪,但是未考虑执行器发生故障问题。因此,设计容错控制器,补偿执行器故障,对卫星转动惯量不确定性和外部扰动具有鲁棒性,并且能够使卫星姿态的暂态和稳态性能得到先验设计和保证,是确保卫星空间任务安全、高效进行的核心问题。

发明内容

[0004] 本发明的目的在于克服现有技术的不足,提供一种卫星初态阶段自适应容错姿态控制方法,针对卫星在初态控制阶段,太阳帆板展开造成的整星转动惯量不确定性,同时存在执行器故障和多种外部干扰力矩的问题,提出一种基于反步法的自适应容错控制方法,它是一种无需具体执行器故障信息和干扰信息且能够保证姿态预设性能的容错控制方法,解决了卫星在初态控制阶段转动惯量不确定性、执行器故障且受到外部扰动力矩影响时的姿态稳定问题,保证了姿态控制系统的容错能力和鲁棒性,并且确保了姿态收敛速度、超调和收敛误差满足预先设定的要求。
[0005] 本发明提供了一种卫星初态阶段自适应容错姿态控制方法,包括如下步骤:
[0006] (1)基于星箭成功分离后初态控制阶段,建立太阳帆板展开过程卫星转动惯量不确定性模型:
[0007] (2)建立卫星姿态动力学模型;
[0008] (3)利用预设性能函数,建立姿态的非线性映射模型;
[0009] (4)基于建立太阳帆板展开过程卫星转动惯量不确定性模型,卫星姿态动力学模型和姿态的非线性映射模型,利用反步法设计自适应容错控制器。
[0010] 进一步地,所述步骤(1)中卫星转动惯量不确定性模型为
[0011] J=Jm-Jnψ(t)
[0012] 其中, 是整星的转动惯量矩阵,为正定的对称矩阵; 是转动惯量中刚性部分,为未知不变的对称矩阵; 是转动惯量中非刚性部分,为时变的,
是非刚性部分的增益,为未知的定常数矩阵, 是已知时变的,反映太阳
帆板展开过程中帆板质心的移动。
[0013] 进一步地,整星转动惯量J对时间的一阶微分可写为以下形式:
[0014]
[0015] 进一步地,所述步骤(2)中建立卫星姿态动力学模型具体为:
[0016]
[0017]
[0018]
[0019] 其中, 为卫星的姿态单位四元数,表示卫星在本体坐标系下相对于惯性坐标系的旋转姿态,q0为四元数的标量部分,qv为矢量部分,且满足 ω
=[ω1,ω2,ω3]T为卫星在本体坐标系下相对于惯性坐标系的姿态速度;J为整星的转动惯量矩阵;D∈R3×n表示执行器的安装矩阵,满足秩rank(D)=3,n≥3; 表示
执行器实际输出的控制力矩, 为执行器失效矩阵,0≤
ei(t)≤1表示每个执行器的失效情况,当ei(t)=1表示执行器正常工作,当0<ei(t)<1表示执行器出现部分失效情况,当ei (t)=0表示执行器处于完全失效;
表示执行器实际产生的控制力矩; 表示偏
置力矩带来的附加故障,假定其有界; 表示卫星受到的空间环境中的干扰力矩,假定其有界,满足 表示单位矩阵; 表示关于任意向量
的斜对称矩阵,其形式如下:
[0020]
[0021] 进一步地,所述步骤(3)具体为:
[0022] 利用预设性能函数,对姿态进行非线性映射,定义函数:
[0023]
[0024] 其中,ε=[ε1,ε2,ε3]T为经过非线性映射后的变量; 表示所选的预设性能函数,是严格非负且递减的,ρ0=[ρ10,ρ20,ρ30]T为性能函数的初始值,且ρi0>0,ρi∞=[ρ1∞,ρ2∞,ρ3∞]T表示性能函数的稳态值,且ρi∞>0;l=[l1,l2,l3]T决定性能函数的收敛速度;qvi(0)为姿态四元数矢量的初始值;qvi(t)与ρi(t)的关系满足以下条件:
[0025]
[0026] δ=[δ1,δ2,δ3]T为预设性能参数,通过其值的改变,反映qvi收敛暂态过程中超调量的大小,当δi=0,姿态四元数矢量部分收敛过程无超调;通过预设性能函数保证qvi收敛的暂态和稳态性能;
[0027] 通过求解S(ε)的逆函数T,得到非线性映射后的变量εi有如下形式:
[0028]
[0029] 选取T的形式如下:
[0030]
[0031] 对时间的一阶微分如下:
[0032]
[0033] 其中,
[0034] 进一步地,通过对姿态进行非线性映射,变量ε收敛,使qv按照预设的暂态和稳态性能进行收敛,满足稳态误差、收敛速度、超调方面的要求。
[0035] 进一步地,所述步骤(4)具体为
[0036] 引入两个新的变量z1=ε,z2=ω-α,分别求得时间的一阶导数如下:
[0037]
[0038]
[0039] 利用反步法,可得虚拟控制器:
[0040]
[0041] 其中c1>0,γ>0为虚拟控制器的增益;
[0042] 利用非线性回归矩阵进行转化模型得:
[0043]
[0044] 其中 为关于Jm的线性回归量, 为关于的Jn线性回归量;W1,W2,W3为与转动惯量线性回归变量相对应的矩阵,满足以下形式:
[0045]
[0046]
[0047]
[0048] 基于虚拟控制器,设计容错控制器为:
[0049]
[0050] 自适应更新律为:
[0051]
[0052] 其中,b=[||θ||,||σ||,dm]T;Φ=[||W1||,||W2+W3||,1]T;c2>0,c3>0,c4>0为与控制器相关的增益参数;参数选择满足条件1/(2γc2)<λmin(DEDT)。
[0053] 本发明设计的考虑转动惯量不确定性、执行器故障和外界扰动的卫星初态控制阶段姿态容错控制方法与现有技术相比的优点:
[0054] (1)本发明的一种卫星初态阶段自适应容错姿态控制方法所针对的对象是卫星的初态控制阶段的太阳帆板展开过程,这期间转动惯量会发生较大的不确定性,具有很强的工程意义;
[0055] (2)本发明考虑姿态收敛过程的暂态和稳态性能,利用预设的性能函数对其进行约束,避免产生较大的超调,减小收敛误差,使姿态不超过预设收敛速度收敛,从而保证空间任务安全、高效地进行;
[0056] (3)本发明在保证姿态预设性能的基础上,考虑实际中执行器失效故障和偏差故障,利用自适应的方法处理,无需确切知道故障和干扰的具体信息,使姿态控制系统对转动惯量不确定性、执行器故障和干扰具有较强的鲁棒性和容错能力。附图说明
[0057] 图1为本发明一种卫星初态阶段自适应容错姿态控制方法的流程框图
[0058] 图2为预设性能示意图;
[0059] 图3为对称安装两太阳帆板的卫星初态控制阶段转动惯量变化示意图。

具体实施方式

[0060] 下面详细说明本发明的具体实施,有必要在此指出的是,以下实施只是用于本发明的进一步说明,不能理解为对本发明保护范围的限制,该领域技术熟练人员根据上述本发明内容对本发明做出的一些非本质的改进和调整,仍然属于本发明的保护范围。
[0061] 如图1所示,本发明的一种卫星初态阶段自适应容错姿态控制方法步骤为:首先建立卫星初态控制过程中太阳帆板展开时转动惯量不确定性模型;然后基于转动惯量不确定性模型,建立含有执行器故障及外部干扰的卫星姿态动力学模型;接着,利用预设性能函数建立姿态的非线性映射模型;最后,采用反步法设计自适应容错控制器,整个系统的原理框图如图1所示,具体实施步骤如下(以下以两块太阳帆板和六个推力器对称安装的卫星初态控制阶段姿态容错控制为例来说明方法的具体实现):
[0062] 第一步,如图3所示,建立卫星初态控制阶段,太阳帆板展开过程中卫星转动惯量变化模型为:
[0063] J=Jm-Jnψ(t)
[0064] 其中 是整星的转动惯量矩阵,为正定的对称矩阵; 是转动惯量中刚性部分,为未知不变的对称矩阵; 是转动惯量中非刚性部分,为时变的,
是非刚性部分的增益,为未知不变的常矩阵, 是已知时变的,反映太阳
帆板展开过程中帆板质心的移动。整星转动惯量J对时间的一阶微分可写为以下形式:
[0065]
[0066] 根据实际卫星设计参数,取Jm=[950 10 5;10 600 30;5 30 360]Tkg·m2,考虑卫星两侧对称安装着两块质量相同的太阳帆板,质量为m1=m2=100kg,并且在太阳帆板展开过程中,已知两块太阳帆板的质心随时间的变化规律分别为:e={ex,ey,ez}是与卫星本体坐标系相关的单位基坐标,当时间
小于等于10s时,κ=1,当时间大于10s时,κ=10/t,表示太阳帆板展开时间为10s,转动惯量中非刚性部分可表示为 即转动惯量非
刚性部分增益Jn=-[100I3,100I3],帆板质心移动规律
[0067] 第二步,建立初态控制阶段卫星姿态控制系统姿态动力学模型如下:
[0068]
[0069]
[0070]
[0071] 其中, 为卫星的姿态单位四元数,表示卫星在本体坐标系下相对于惯性坐标系的旋转姿态,q0为标量,qv为矢量,满足 初始姿态取为q(0)=
T T
[0.2,-0.15,-0.25,0.9354];ω=[ω1,ω2,ω3] 为卫星在本体坐标系下相对于惯性坐标系的姿态角速度,初始角速度取为ω(0)=[0.05,-0.05,0.01]Trad/s;J为整星的转动惯量,取值如上一步所示;D∈R3×6为推力器的安装矩阵,且满足秩rank(D)=3,取为表示执行器实际输出的控制力
矩, 为执行器失效矩阵,0≤ei(t)≤1表示每个执行器
的失效情况,当ei(t)=1表示执行器处于正常工作状态,当0<ei(t)<1表示执行器出现部分失效情况,当ei(t)=0表示执行器处于完全失效状态,取值为:
[0072]
[0073]
[0074]
[0075] 表示推力器实际产生的控制力矩,即为所需设计的容错控制器; 表示偏置力矩带来的附加故障,取值为:
[0076]
[0077] 表示卫星受到的来自空间环境中的干扰力矩,满足 dm为附加故障与外界干扰的最大值,取为 表示单位矩阵;
表示关于任意向量 的斜对称矩阵,其形式如下:
[0078]
[0079] 第三步,利用预设性能函数,对姿态进行非线性映射,建立模型如下:
[0080]
[0081] 其中,ε=[ε1,ε2,ε3]T为转换后的变量; 为预设性能函数,是严格非负且递减的,性能函数初始值取为ρ0=[0.4,0.35,0.45]T,性能函数稳态值取T T
为ρ∞=[0.0001,0.0001,0.0001],l=[0.1,0.1,0.1]决定性能函数收敛速度;qvi(0)为姿态四元数矢量的初始值,如上一步所示,取为qv(0)=[0.2,-0.15,-0.25]T;qvi(t)与ρi(t)的关系满足以下形式:
[0082]
[0083] δ=[δ1,δ2,δ3]T为预设性能参数,通过其值的改变,反映qvi收敛过程中超调的大小,将该值取为δ=[0,0,0]T,表示姿态q收敛过程无超调。
[0084] 根据非线性映射模型,选取T的形式如下:
[0085]
[0086] 对时间的一阶微分如下:
[0087]
[0088] 其中,
[0089] 通过对姿态进行非线性映射,变量ε收敛即可使qv按照预设的暂态和稳态性能进行收敛,满足稳态误差、收敛速度、超调等方面的要求。
[0090] 第四步,考虑转动惯量不确定性、推力器故障及外部干扰的自适应反步容错控制方法,利用反步法设计自适应控制器:
[0091] 首先引入两个新的变量z1=ε,z2=ω-α,分别求得时间的一阶导数如下:
[0092]
[0093]
[0094] 基于反步法,可得虚拟控制器:
[0095]
[0096] 其中,c1>0,γ>0为虚拟控制器的增益,分别选定c1=0.2,γ=0.01。
[0097] 利用非线性回归矩阵进行转化模型得:
[0098]
[0099] 其中 为关于Jm的线性回归量, 为关于的Jn线性回归量;W1,W2,W3为与转动惯量线性回归变量相对应的矩阵,满足以下形式:
[0100]
[0101]
[0102]
[0103] 基于虚拟控制器,设计容错控制器和自适应更新律分别为:
[0104]
[0105]
[0106] 其中,b=[||θ||,||σ||,dm]T;Φ=[||W1||,||W2+W3||,1]T;c2>0,c3>0,c4>0为与控制器相关的增益参数,由设计者选择,选定为c2=270,c3=0.001,c4=10;安装矩阵和失效矩阵乘积的最小特征值λmin(DEDT)=0.3920,并且可计算出1/(2γc2)=0.1852,所以满T足条件1/(2γc2)<λmin(DED)。
[0107] 通过Matlab仿真,可以得到卫星初态阶段自适应容错姿态控制方法,可以实现在初态控制阶段,考虑由于太阳帆板展开造成的转动惯量不确定性、以及推力器故障和外界干扰作用下,卫星姿态按照预设的暂态和稳态性能收敛,本方法具有较强的鲁棒性和容错能力,且能够满足姿态稳态误差足够小,收敛速率尽可能快,无超调等性能要求。
[0108] 尽管为了说明的目的,已描述了本发明的示例性实施方式,但是本领域的技术人员将理解,不脱离所附权利要求中公开的发明的范围和精神的情况下,可以在形式和细节上进行各种修改、添加和替换等的改变,而所有这些改变都应属于本发明所附权利要求的保护范围,并且本发明要求保护的产品各个部和方法中的各个步骤,可以以任意组合的形式组合在一起。因此,对本发明中所公开的实施方式的描述并非为了限制本发明的范围,而是用于描述本发明。相应地,本发明的范围不受以上实施方式的限制,而是由权利要求或其等同物进行限定。
高效检索全球专利

专利汇是专利免费检索,专利查询,专利分析-国家发明专利查询检索分析平台,是提供专利分析,专利查询,专利检索等数据服务功能的知识产权数据服务商。

我们的产品包含105个国家的1.26亿组数据,免费查、免费专利分析。

申请试用

分析报告

专利汇分析报告产品可以对行业情报数据进行梳理分析,涉及维度包括行业专利基本状况分析、地域分析、技术分析、发明人分析、申请人分析、专利权人分析、失效分析、核心专利分析、法律分析、研发重点分析、企业专利处境分析、技术处境分析、专利寿命分析、企业定位分析、引证分析等超过60个分析角度,系统通过AI智能系统对图表进行解读,只需1分钟,一键生成行业专利分析报告。

申请试用

QQ群二维码
意见反馈