一种基于输出反馈的挠性航天器精细姿态控制方法 |
|||||||
申请号 | CN201610389633.5 | 申请日 | 2016-06-02 | 公开(公告)号 | CN105843244A | 公开(公告)日 | 2016-08-10 |
申请人 | 北京航空航天大学; | 发明人 | 郭雷; 乔建忠; 张然; 张培喜; 张大发; | ||||
摘要 | 本 发明 提供了一种基于输出反馈的挠性 航天器 精细 姿态 控制方法,所述控制方法包括如下步骤:a)搭建挠性航天器动 力 学系统Σ1,将挠性航天器动力学系统Σ1变换为挠性航天器动力学系统Σ2,所述挠性航天器动力学系统Σ2引入航天器刚柔耦合动态干扰;b)构造外部系统Σ3,所述刚柔耦合动态干扰通过外部系统Σ3进行描述;c)设计干扰观测器,所述干扰观测器对所述刚柔耦合动态干扰进行估值;d)设计动态输出反馈H∞ 控制器 ;e)将步骤c)中所诉的干扰观测器与步骤d)中所述的动态输出反馈H∞控制器进行复合,得到挠性航天器精细姿态控制系统Σ6;所述挠性航天器精细姿态控制系统Σ6通过估值对刚柔耦合动态干扰进行补偿。 | ||||||
权利要求 | 1.一种基于输出反馈的挠性航天器精细姿态控制方法,其特征在于,所述控制方法包括如下步骤: |
||||||
说明书全文 | 一种基于输出反馈的挠性航天器精细姿态控制方法技术领域[0001] 本发明涉及航空航天技术领域,特别涉及一种基于输出反馈的挠性航天器精细姿态控制方法。 背景技术[0002] 随着航天技术的发展,越来越多的航天器携带有大型的太阳帆板、天线等挠性机构,这些挠性机构使航天器的功能日益强大,但同时也给航天器的姿态控制问题带来了严峻的考验,尤其是当航天器的控制精度要求较高时,如对地观测卫星、太空望远镜等。因此,挠性航天器在天空运行时不仅会受到外部的环境干扰,还会受到刚柔耦合动态带来的严重影响。针对这类复杂问题,许多学者也提出了相应的控制方法,比较常见的有H∞控制、滑模变结构控制等。但是H∞控制为典型的干扰抑制方法,它把所有的干扰等价为单一的范数有界干扰,致使控制精度不高。而滑模变结构控制具有鲁棒性、快速性等优势,但是其控制率一般较为复杂,并且存在抖振现象,不利于实际的工程应用。另外,现阶段大多数姿态控制方法都通过假定系统的全部状态可测来设计控制器。但是,在实际的航天工程中难以满足上述假设,如在部分测量敏感器出现故障的情况下。而且由于角速度测量成本等原因,越来越多的学者在研究无角速度量测的情况下的姿态控制问题,实际上也是一种输出反馈的姿态控制问题。因此,基于输出反馈设计高精度的姿态控制器更具备理论及实用意义。早期的工作也有利用DOBC来估计刚柔耦合带来的干扰,但是前提都是假设系统的状态变量全部可测,并且假设干扰的变化率有界。 [0003] 基于干扰观测器的控制(DOBC)充分利用了干扰的特性,实现了干扰的高精度估计与补偿,并且易于与其它控制方式相结合,因此,可以基于干扰观测器设计精细的复合姿态控制器来同时实现干扰的补偿与抑制,从而提升挠性航天器的姿态控制精度。 [0004] 因此,需要一种能有效地补偿刚柔耦合干扰和抑制外部环境干扰的基于输出反馈的挠性航天器精细姿态控制方法。 发明内容[0005] 本发明的目的在于提供一种基于输出反馈的挠性航天器精细姿态控制方法,所述控制方法包括如下步骤: [0006] a)搭建挠性航天器动力学系统Σ1,将挠性航天器动力学系统Σ1变换为挠性航天器动力学系统Σ2,所述挠性航天器动力学系统Σ2引入航天器刚柔耦合动态干扰; [0007] b)构造外部系统Σ3,所述刚柔耦合动态干扰通过外部系统Σ3进行描述; [0008] c)设计干扰观测器,所述干扰观测器对所述刚柔耦合动态干扰d0进行估值[0009] d)设计动态输出反馈H∞控制器; [0010] e)将步骤c)中所诉的干扰观测器与步骤d)中所述的动态输出反馈H∞控制器进行复合,得到挠性航天器精细姿态控制系统Σ6; [0011] 所述挠性航天器精细姿态控制系统Σ6通过估值 对刚柔耦合动态干扰d0进行补偿。 [0012] 优选地,所述控制方法,所述挠性航天器动力学系统Σ1表述为: [0013] [0014] 其中,θ为航天器姿态角,为航天器姿态角θ的二阶导数,J为航天器转动惯量,F为挠性附件与本体的刚柔耦合矩阵,FT为所述刚柔耦合矩阵的转置矩阵,u为控制输入,d1为环境干扰力矩,η为挠性附件的模态,为挠性附件模态η的导数,为挠性附件模态η的二阶导数,Cd为模态阻尼矩阵,Λ为刚度矩阵。 [0015] 优选地,所述控制方法,所述模态阻尼矩阵Cd表示为Cd=diag{2ζiωi}(i=1,2,...N),其中N为模态阶数,ζi为模态阻尼,ωi为模态频率,所述刚度矩阵Λ表示为[0016] 优选地,所述控制方法,所述的系统Σ2表述为: [0017] [0018] 其中,为航天器姿态角θ的二阶导数,J为航天器转动惯量,F为挠性附件与本体的刚柔耦合矩阵,FT为所述刚柔耦合矩阵的装置矩阵,u为控制输入,d1为环境干扰力矩,η为挠性附件的模态,为挠性附件模态η的导数,Cd为模态阻尼矩阵,Λ为刚度矩阵。 [0019] 优选地,所述控制方法,步骤b)中所述刚柔耦合动态干扰d0表示为其中,F为挠性附件与本体的刚柔耦合矩阵,Cd为模态阻尼矩阵,Λ为刚 度矩阵,η为挠性附件的模态,为挠性附件模态η的导数; [0020] 所述外部系统Σ3对刚柔耦合动态干扰d0描述为: [0021] [0022] 其中, V=[FΛ FCd]w为外部系统Σ3的干扰状态变量,为w的导数,W、H和V为定义的系数矩阵,I为单位矩阵。 [0023] 优选地,所述控制方法,所述系数矩阵W中,矩阵M表示为M=I-FTJ-1F,其中,I为单位矩阵。 [0024] 优选地,所述控制方法,步骤c)中所述干扰观测器的设计步骤如下: [0025] (1)构造航天器姿态角输入矩阵 [0026] (2)将所述系统Σ2转化为状态空间系统Σ4,所述状态空间系统Σ4表述为: [0027] [0028] 其中, A和B为系数矩阵,y为量测输出,C为量测矩阵; [0029] (3)借助量测输出y设计干扰观测器,所述干扰观测器表述为: [0030] [0031] 其中, 是刚柔耦合动态干扰d0的估计值,v为辅助变量,为辅助变量v的导数,y为量测输出,L为干扰观测器增益矩阵; [0032] 所述干扰控制器的观测误差动态Σ5表述为: [0033] [0034] 其中, 为干扰状态变量w的估计值, 为ew的导数。 [0035] 优选地,所述控制方法,步骤d)中所述动态输出反馈H∞控制器表述为: [0036] [0037] 其中,u1为动态输出反馈H∞控制器输入,xk为控制器状态,Ax、Bx、Cx、Dx为待定的控制器参数矩阵,所述动态输出反馈H∞控制器对环境干扰进行抑制。 [0038] 优选地,所述控制方法,步骤e)中所述的挠性航天器精细姿态控制系统Σ6表述为: [0039] [0040] 其中,u为控制输入,为所述干扰观测器对所述刚柔耦合动态干扰d0的估计值; [0041] 所述精细姿态控制系统Σ6通过估计值 对刚柔耦合动态干扰d0进行补偿。 [0043] 联立系统Σ4、Σ5和Σ6,得到: [0044] [0045] 求解如下凸优化问题: [0046] [0047] 其中, [0048] [0049] [0050] Φ22=Q1W+YCBV+(Q1W+YCBV)T,Φ23=(YCB+Q1H), [0051] 得到未知参数: [0052] [0053] 本发明提供的一种基于输出反馈的挠性航天器精细姿态控制方法,针对刚柔耦合动态建立了干扰的模型,充分利用了干扰的信息,采用输出反馈来进行控制器及干扰观测器的设计,相比于状态反馈的控制方法,更具备工程价值。 [0055] 参考随附的附图,本发明更多的目的、功能和优点将通过本发明实施方式的如下描述得以阐明,其中: [0056] 图1示意性示出本发明一种基于输出反馈的挠性航天器精细姿态控制方法的设计流程图; 具体实施方式[0058] 通过参考示范性实施例,本发明的目的和功能以及用于实现这些目的和功能的方法将得以阐明。然而,本发明并不受限于以下所公开的示范性实施例;可以通过不同形式来对其加以实现。说明书的实质仅仅是帮助相关领域技术人员综合理解本发明的具体细节。 [0059] 在下文中,将参考附图描述本发明的实施例。在附图中,相同的附图标记代表相同或类似的部件,或者相同或类似的步骤。 [0060] 本发明提供了一种基于输出反馈的挠性航天器精细姿态控制方法,如图1所示本发明基于输出反馈的挠性航天器精细姿态控制方法的设计流程图,本实施例中航天器精细姿态控制方法100,通过将航天器刚柔耦合动态干扰引入到挠性航天器动力学系统,借组外部系统对航天器刚柔耦合动态干扰进行描述。设计干扰观测器对刚柔耦合动态干扰进行估值,设计动态输出反馈H∞控制器对环境干扰进行抑制,并将干扰观测器和动态输出反馈H∞控制器进行复合通过刚柔耦合动态干扰的估计值对刚柔耦合动态干扰进行补偿。 [0061] 出于说明性的目的,本发明所提供的基于输出反馈的挠性航天器精细姿态控制方法通过不同模块实现,如图2所示本发明实施例中挠性航天器精细姿态控制的模块框图200,具体地,所述的模块包括但不限于:那外部系统模块201、干扰观测模块202、动态输出反馈模203块和精细姿态控制模块204。 [0062] 所述外部系统模块201中,外部系统对航天器刚柔耦合动态干扰进行描述。 [0063] 所述干扰观测模块202中,干扰观测器对航天器刚柔耦合动态干扰进行估值。 [0064] 所述动态输出反馈模块203中,动态输出反馈H∞控制器对环境干扰进行抑制。 [0065] 所述精细姿态控制模块204中,精细姿态控系统通过航天器刚柔耦合动态干扰的估计值完成对航天器刚柔耦合动态干扰进行补偿。 [0066] 下面结合图1具体描述本实施例中航天器姿态控制方法: [0067] 步骤S101:将航天器刚柔耦合干扰引入到挠性航天器动力学系统: [0068] 搭建挠性航天器动力学系统Σ1,所述系统Σ1表述为: [0069] 其中,θ为航天器姿态角,为航天器姿态角θ的二阶导数,J为航天器转动惯量,F为挠性附件与本体的刚柔耦合矩阵,FT为所述刚柔耦合矩阵的转置矩阵,u为控制输入,d1为环境干扰力矩,η为挠性附件的模态,为挠性附件模态η的导数,为挠性附件模态η的二阶导数,Cd为模态阻尼矩阵,Λ为刚度矩阵。模态阻尼矩阵Cd表示为Cd=diag{2ζiωi}(i=1,2,...N),其中N为模态阶数,ζi为模态阻尼,ωi为模态频率;刚度矩阵Λ表示为 [0070] 对挠性航天器动力学系统Σ1通过数学变换转变为系统Σ2,系统Σ2表述为:系统Σ2中 为挠性航天器刚柔耦合动 态干扰。 [0071] 步骤S102:将刚柔耦合动态干扰通过外部系统Σ3进行描述 [0072] 令 用d0表示刚柔耦合动态干扰,利用外部系统Σ3对刚柔耦合动态干扰d0进行描述: [0073] [0074] 其中, V=[FΛ FCd]w为外部系统Σ3的干扰状态变量,为w的导数,W、H和V为定义的系数矩阵,数矩阵W中,矩阵M表示为M=I-FTJ-1F,I为单位矩阵。 [0075] 步骤S103:设计干扰观测器 [0076] 本实施例步骤S101中在航天器动力学系统中引入了刚柔耦合动态干扰,需要对引入的刚柔耦合动态干扰进行估值。本发明采用干扰观测器对刚柔耦合动态干扰进行估值,具体的干扰参测器的设计在下面具体说明。 [0077] 干扰观测器的设计步骤具体如下: [0078] (1)构造航天器姿态角输入矩阵 [0079] (2)将系统Σ2转化为状态空间系统Σ4,所述状态空间系统Σ4表述为: [0080] [0081] 其中, A和B为系数矩阵,y为量测输出,C为量测矩阵; [0082] (3)借助量测输出y设计干扰观测器,干扰观测器具体通过下式表述: [0083] [0084] 其中, 是刚柔耦合动态干扰d0的估计值,v为辅助变量,为辅助变量v的导数,y为量测输出,L为干扰观测器增益矩阵;干扰控制器的观测误差动态Σ5表述为: [0085] [0086] 其中, 为干扰状态变量w的估计值, 为ew的导数。通过式(1)设计的干扰观测器对刚柔耦合动态干扰d0进行估计值 [0087] 步骤S104:设计动态输出反馈H∞控制器: [0088] 动态输出反馈H∞控制器具体通过下式表述: [0089] [0090] 其中,u1为动态输出反馈H∞控制器输入,xk为控制器状态,Ax、Bx、Cx、Dx为待定的控制器参数矩阵,所述动态输出反馈H∞控制器对环境干扰进行抑制。 [0091] 步骤S105:干扰观测器与动态输出反馈H∞控制器进行复合 [0092] 为了清楚的说明航天器的精细姿态控制,在航天器动力学系统中引入的刚柔耦合动态干扰需要通过估计值进行补偿。本发明中采用精细姿态控系统将干扰观测器与动态输出反馈H∞控制器进行复合对刚柔耦合动态干扰的估计值进行补偿。 [0093] 本实施例中,具体地,将干扰观测器的表达式(1)与动态输出反馈H∞控制器的表达式(2)进行复合,得到挠性航天器精细姿态控制系统Σ6,挠性航天器精细姿态控制系统Σ6具体表述为: [0094] [0095] 其中,u为控制输入,为干扰观测器对刚柔耦合动态干扰d0的估计值。 [0096] 上述挠性航天器精细姿态控制系统Σ6中,控制输入u在动态输出反馈H∞控制器输入u1的基础上减掉干扰观测器对刚柔耦合动态干扰d0的估计值 干扰观测器对刚柔耦合动态干扰d0的估计值 近似于刚柔耦合动态干扰d0时,即 实现挠性航天器精细姿态控制系统Σ6对刚柔耦合动态干扰通过刚柔耦合动态干扰d0的估计值 进行补偿。 [0097] 干扰控制器增益矩阵L和所述待定控制器参数矩阵Ax、Bx、Cx、Dx通过凸优化算法求解,求解过程如下: [0098] 联立系统Σ4、Σ5和Σ6,得到: [0099] [0100] 求解如下凸优化问题: [0101] [0102] 其中, [0103] [0104] [0105] Φ22=Q1W+YCBV+(Q1W+YCBV)T,Φ23=(YCB+Q1H), [0106] 得到未知参数: [0107] |