法律状态公告日
法律状态信息
法律状态
2018-07-06
授权
授权
2016-05-04
实质审查的生效 IPC(主分类):G05D1/08 申请日:20151202
实质审查的生效
2016-04-06
公开
公开
技术领域
本发明涉及基于干扰观测器的挠性卫星轨迹线性化姿态控制方法。
背景技术
随着时代的发展和社会的进步,人类对外太空的探索已经上升到一个新的高度。 中国已经跨入了空间大国的行列。航天技术对于国民经济、国防建设、文化教育和科学研究 起到至关重要的作用,是国家综合实力的集中体现。
航天技术是将航天学的理论应用于航天器和运载器的研究、设计、制造、试验、发 射、飞行、返回、控制、管理等工航天工程实践而形成的一门综合性工程技术。卫星系统包括 七部分:位置与姿态控制系统、天线系统、转发器系统、遥测指令系统、电源系统、温控系统 以及入轨和推进系统。其中姿态控制系统决定了卫星的跟踪性能,是卫星顺利完成太空任 务的重要保障。
由于太空探索的领域不断拓宽,探索任务难度不断加大,航天器的结构也呈现复 杂化的趋势,不可避免地受到各种干扰力矩以及参数不确定性的影响。外部及自身的干扰 很大程度上影响了航天器的工作性能,加大了姿态控制的难度。并且干扰的数学模型不易 清晰描述。因此挠性航天器的干扰抑制问题是航天领域的研究热点,直接决定了卫星的控 制精度。
针对航天器的干扰抑制问题,国内外学者进行了深入研究,提出了很多控制算法, 现将部分控制算法介绍如下:
HuaLiu等人[1](LiuH,GuoL,ZhangY.Ananti-disturbancePDcontrol schemeforattitudecontrolandstabilizationofflexiblespacecrafts[J] .NonlinearDynamics,2012,67(3):2081-2088)针对挠性航天器的干扰问题设计了干扰观 测器和PD控制器,抑制了两种不同的干扰,提高了航天器的控制精度和姿态稳定性。虽然基 于PID的控制算法对于线性系统的控制性能良好,但是对于复杂非线性系统和复杂信号追 踪具有很大的局限性,在对干扰的抑制方面鲁棒性不强,必须结合其他算法才能达到控制 要求。
钱勇等人[2](钱勇,满顺强.基于变结构控制减小扫描镜运动对卫星姿态的影响 分析[J].上海航天,2013,29(6):7-10)利用解耦变结构控制器对静止轨道卫星进行控制, 考虑了星上载荷的扫描镜和卫星本体间的耦合,对四元数四个分量分别设计滑动模态,避 免了奇异问题态的影响。由仿真结果可看出,采用变结构控制可以提高姿态角的跟踪精度 和稳定性,很大程度减小了扫描镜运动对卫星产生的干扰。但是由于变结构控制相当于起 到开关作用,控制不连续,很容易导致抖振,而抖振易激发系统的未建模特性,从而影响了 系统的控制性能。
朱亮等人[3](ShaoX,WangH.ANovelMethodofRobustTrajectory LinearizationControlBasedonDisturbanceRejection[J].MathematicalProblems inEngineering,2014,2014)利用轨迹线性化控制(TLC)方法和神经网络技术设计了直接 自适应TLC控制方案,通过仿真可以看出,通过神经网络的作用提高了系统的性能,弥补了 之前TLC的不足。但是很多基于轨迹线性化的控制算法未考虑外界干扰及自身参数不确定 性影响,导致系统的鲁棒性较差。
ZhengZhu等人[4](周军.航天器控制原理.西北工业大学出版社,2001)设计了扩 张状态观测器来实现对刚体航天器干扰的观测。由于星体存在燃料消耗,质量时变,星体的 转动惯量无法确定,同时,外部干扰不可忽略。ZhengZhu等人设计滑模控制器保证了参考 姿态状态的收敛性。从仿真结果可以看出,此控制方法具有良好的控制性能,姿态跟踪精度 较高。但是,该文献是针对刚体卫星进行设计,未考虑挠性部件的影响。
方案一:
文献[6](ZhuZ,XiaY,FuM,etal.Attitudetrackingofrigidspacecraft basedonextendedstateobserver[C].SystemsandControlinAeronauticsand Astronautics(ISSCAA),20103rdInternationalSymposiumon.IEEE,2010:621-626)提 出了一种基于扩张状态观测器的卫星姿态控制方法。首先用四元数建立卫星动力学方程, 基于该模型设计滑模控制算法。针对转动惯量不确定性和外部干扰设计状态观测器,将干 扰的估计值带入之前设计的控制律中,实现了对卫星的跟踪控制。方案具体内容如下:
(1)卫星动力学模型:
用四元数表示卫星动力学模型,减少了奇异点的影响。引入误差四元数,将控制目 标转换为在有限时间内误差四元数收敛到0。定义
x=ω+Kev(71)
其中ev代表误差四元数向量部分。通过式(71),将控制目标变为在有限时间内使 变量x收敛到0。考虑到卫星转动惯量的不确定性,将转动惯量J表示为J=J0+△J,其中J0表 示常量部分,△J表示不确定部分。采用等效误差的思想,将外部误差和转动惯量不确定部 分合并,用表示。则卫星动力学模型可以简化为
(2)设计滑模控制律
选择滑模面S=C2x,其中,S=[S1,S2,S3]T∈R3,C2∈R3×3。选择趋近律
保证了滑模到达条件。由于
求得控制律
(3)设计观测器
由于等效干扰是未知的,所以需要观测器对其进行估计。引入新的变量x2代表系 统总的干扰则式(37)可以写成如下形式:
其中g(t)代表总干扰的微分,仍然是未知的。二阶扩张状态观测器设计如下:
式中E1代表观测器的估计误差,Z1和Z2是观测器的输出向量,β01和β02是观测器的 增益,函数fal(·)定义如下
其中
式中0<α1<1,δ>0。
选取合适的参数,可以保证状态观测器的输出Z1等于状态x,输出Z2等于
因此,将控制律式(75)进一步完善得到
uESO(t)=(C2B0)-1(-τS-σsgn(S)-C2F-C2Z2)(80)
系统在此控制律作用下有较强的抗干扰能力和鲁棒性,可以很好的实现姿态跟 踪。
方案的缺点描述如下:
根据系统的动力学模型可知,系统未考虑卫星帆板的挠性振动的影响,没有模态 方程,把卫星作为刚体进行控制律设计。但是实际卫星挠性部件对系统影响很大,破坏系统 的动态性能,甚至导致系统不稳定。
方案二:
文献[7](ZhiW,Bao-huaL.Compoundcontrolsystemdesignbasedon backsteppingtechniquesandneuralnetworkslidingmodeforflexible satellite[C].ComputerDesignandApplications(ICCDA),2010International Conferenceon.IEEE,2010,2:V2-418-V2-422)针对有挠性部件的航天器设计变结构控制 律,利用三级滑模控制,有效抑制了外部干扰,使航天器跟踪误差为0。同时,利用神经网络 对不确定性因素进行估计,很好地减弱了由于不连续控制产生的抖动。方案具体内容如下:
(1)卫星运动学和动力学建模
考虑卫星天线、太阳帆板等挠性附件,采用三正交飞轮作为执行元件,分别对卫星 整体、天线、太阳帆板动力学建模,同时考虑太阳帆板和天线的振动模态。为便于控制器设 计,将挠性附件的振动视为作用在卫星上的外部干扰,简化卫星动力学模型。
(2)滑模控制律设计
基于反步控制技术,采用三层滑模控制,反推出控制输入变量。
首先设计第一层滑模面,目标是快速准确地跟踪目标四元数,定义角速度虚拟控 制并给出其具体形式,构造第一层的V函数;然后设计第二层滑模面,目标是快速准确跟 踪定义力矩虚拟控制选择合适的指数趋近律,推导出的具体形式,构造第二层的V 函数;最后设计第三层滑模面,利用伺服系统的动力学模型来获得更高的控制精度。其跟踪 指令为控制输入为飞轮角速度ωc,选择合适的指数趋近律,确定出ωc的具体表达式。
通过分析可得,控制输入ωc可以保证系统跟踪误差为0。
(3)控制律的完善
为了防止“微分爆炸”现象的发生,采用低通滤波器分别对和进行滤波。同时, 为了抑制由于参数不确定性引起的系统振动,采用RBF神经网络对不确定参数进行估计。
通过仿真结果可以看出,系统在较短时间内实现姿态的跟踪,在外界干扰和参数 扰动条件下跟踪精度依然很高。但是系统的控制器过于复杂,控制算法的实现只能在计算 速度足够快的计算机上完成,很难在工程上应用。除此之外,此方案未考虑航天器转动惯量 的不确定性,忽略了其对于控制精度的影响。
发明内容
本发明是为了解决目前挠性航天器的干扰抑制问题的研究中,单一的轨迹线性化 控制方法对干扰的抑制能力不强、鲁棒性较差,未考虑到外部干扰以及挠性附件影响的问 题,而提出的基于干扰观测器的挠性卫星轨迹线性化姿态控制方法。
一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法按以下步骤实现:
步骤一:挠性航天器动力学建模,得到模型为
其中ω=[ωxωyωz]T∈R3为航天器本体角速度,ωx、ωy、ωz分别为航天器本体 系相对于惯性系角速度在本体坐标系滚动轴、俯仰轴和偏航轴方向投影;ω×为
步骤二:利用步骤一得到的模型,进行航天器名义控制设计;
当被控对象的逆不可求时,通过求状态变量的伪逆,得到跟踪系统的名义控制;
对将等效干扰忽略,求得系统运动学和动力学模型相对于名义状态变量和的逆,得到
其中所述为航天器本体坐标系相对于轨道坐标系的旋转角速度名义 值,为滚动轴方向、俯仰轴方向和偏航轴方向名义控制力矩,Jxx、Jyy、Jzz为航天 器沿滚动轴、俯仰轴和偏航轴的转动惯量;
公式(15)和式(16)可以精确表示出控制变量的逆;
步骤三:利用步骤二求得系统运动学和动力学模型相对于名义状态变量和 的逆,设计跟踪误差的线性时变调节器,求得状态反馈控制律u1和u2;
步骤四:根据步骤三得到的状态反馈控制律u2,设计非线性干扰观测器,将观测器 的输出作为系统控制律的一部分;得到整个系统的控制律
发明效果:
本发明设计了针对挠性航天器的干扰抑制和姿态跟踪的控制算法。用欧拉角描述 航天器姿态,采用等效干扰的思想,建立挠性航天器动力学和运动学方程;忽略等效干扰的 情况下求被控对象的伪逆,设计特定形式的准微分器,得到期望轨迹的名义控制;用比例— 积分控制设计线性时变调节器。考虑等效干扰的影响,设计干扰观测器,保证挠性航天器的 跟踪误差渐近收敛。
与现有技术方案相比,本发明专利具有以下优点:
1、控制算法易于实现,有较强的工程实用性;
2、考虑了转动惯量的不确定性和挠性附件带来的影响,利用非线性干扰观测器抑 制了系统干扰;
3、利用轨迹线性化方法,其特有的伪逆不影响闭环系统的稳定性,适用于非最小 相位系统;
4、利用PD谱特征原理设计的线性时变调节器提高了系统的抗干扰能力,增强了系 统的鲁棒性;
5、采用非线性干扰观测器与轨迹线性化相结合的方法,缩短了系统到达期望姿态 的时间,同时也提高了跟踪精度;
6、控制力矩的稳态幅值和挠性帆板模态振动幅值相对较小。
附图说明
图1为轨迹线性化控制示意图,图中和y分别代表系统输出的期望值和实际值,η 代表线性时变反馈控制律,和u代表系统名义控制和总的控制律。
图2为基于非线性干扰观测器的TLC控制框图,图中r代表系统期望输出,y代表系 统实际输出;e代表系统期望输出和实际输出的误差;u代表线性时变反馈控制律;代表系 统名义控制;代表观测器对干扰的估计值;d代表系统总干扰。
图3为航天器在0~400s内期望和实际欧拉角曲线图;其中上图、中图和下图分别 代表航天器滚转角、俯仰角和偏航角在0~400s内期望值和实际值变化曲线图;图中代表航天器本体坐标系相对于轨道坐标系的欧拉角;代表航天器滚转角、 俯仰角和偏航角的期望值。
图4为航天器在0~10s内期望和实际欧拉角曲线图;其中上图、中图和下图分别代 表航天器滚转角、俯仰角和偏航角在0~10s内期望值和实际值变化曲线;图中代 表航天器本体坐标系相对于轨道坐标系的欧拉角;代表航天器滚转角、俯仰角 和偏航角的期望值。
图5为航天器0~400s内期望和实际角速度曲线图;其中上图、中图和下图分别代 表航天器滚转角速度、俯仰角速度和偏航角速度在0~400s内期望值和实际值变化曲线;图 中ω1,ω2,ω3代表航天器滚转角速度、俯仰角速度和偏航角速度的实际值;ωd1,ωd2,ωd3代表航天器滚转角速度、俯仰角速度和偏航角速度的期望值。
图6为航天器0~10s内期望和实际角速度曲线图;其中上图、中图和下图分别代表 航天器滚转角速度、俯仰角速度和偏航角速度在0~10s内期望值和实际值变化曲线;图中 ω1,ω2,ω3代表航天器滚转角速度、俯仰角速度和偏航角速度的实际值;ωd1,ωd2,ωd3代 表航天器滚转角速度、俯仰角速度和偏航角速度的期望值。
图7为航天器欧拉角误差曲线图;图中分别代表航天器滚转角、俯仰角和 偏航角的误差。
图8为航天器角速度误差曲线图;图中ωe1,ωe2,ωe3分别代表航天器滚转角速度、 俯仰角速度和偏航角速度的误差。
图9为控制力矩曲线图;图中Tc1,Tc2,Tc3分别代表航天器滚动轴、俯仰轴和偏航轴 的控制力矩。
图10为航天器帆板模态振动曲线图;图中η1,η2,η3,η4代表四个模态坐标。
图11为系统实际和估计干扰曲线图;其中上图、中图和下图分别代表滚动轴、俯仰 轴和偏航轴上的实际干扰和估计干扰;图中d1,d2,d3分别代表航天器滚动轴、俯仰轴和偏航 轴上的实际干扰;d1',d2',d3'分别代表航天器滚动轴、俯仰轴和偏航轴上的估计干扰。
图12为航天器干扰估计误差曲线图;图中de1,de2,de3分别代表航天器滚动轴、俯仰 轴和偏航轴上的干扰估计误差。
具体实施方式
具体实施方式一:一种基于干扰观测器的挠性卫星轨迹线性化姿态控制方法包括 以下步骤:
本发明的关键步骤:
1、卫星姿态控制
卫星的姿态控制包括姿态确定、姿态稳定控制和姿态机动控制。姿态确定是研究 空间飞行器相对于某参考基准的方位或方向,进而获取姿态角参数,其精度取决于姿态敏 感器和姿态算法的精度。姿态稳定控制是使飞行器的姿态保持在预期制定方向和指定值 上。姿态机动控制是使飞行器从一个姿态过渡到另一个姿态的再定向过程。本发明专利主 要对挠性卫星受干扰情况下姿态跟踪控制进行深入研究。
姿态控制系统保证卫星以预定的姿态精度在轨道上运行。按姿态稳定方式分为两 种基本类型:被动稳定系统和主动稳定系统。这两种系统的结合又派生出半被动、半主动和 混合稳定系统三种类型。从控制观念上看,被动稳定系统属于开环控制系统,主动稳定系统 属于闭环负反馈控制系统。被动稳定系统是利用自然环境力矩或物理力矩源,如自旋、重力 梯度、地磁场、太阳辐射压力矩和气动力矩,来控制卫星的姿态。主动控制从控制原理上看 就是三自由度的姿态闭环控制系统,不依赖于地面指挥中心的干预,完全由飞行器所载设 备实现姿态控制的过程。按稳定方式主要分为自旋稳定和三轴稳定。本发明主要对三轴稳 定的情况进行研究。
2、轨迹线性化
轨迹线性化控制适用于解决非线性跟踪问题,其本质为解耦控制,将开环的非线 性动态逆和线性时变的反馈线性化控制相结合,保证了系统输出在名义轨迹上的指数稳定 性。轨迹线性化的设计思想是:首先利用非线性动态逆方法将轨迹跟踪问题转化为一个跟 踪误差调节问题,然后利用线性时变系统PD谱理论设计状态反馈控制律,使得系统跟踪误 差收敛到零。控制器结构图如图1所示。
考虑如下形式的多输入多输出非线性系统:
x∈Rn,u∈Rm,y∈Rm,分别为系统的状态,输入和输出;f(x),g(x)和h(x)为适当位 数的光滑有界函数。令分别表示系统标称的状态,输出和控制输入,则相应有:
定义如下的状态跟踪误差:
并构造控制律为
其中,η即为所需设计的线性时变反馈控制率,在后面给出。则对应的非线性跟踪 误差动态系统为
此时,原非线性系统跟踪问题就转化为一个非线性调节问题,控制器包括两部分:
一个开环的被控对象的伪动态逆控制器,根据期望的系统输出值产生一个标称 的控制输入
一个闭环的线性时变反馈调节器η=η(e)用以镇定系统,并使系统具有一定的响 应特性。
考虑到式(4)中的可视为系统的时变参数,因此式(4)可简记为
考虑如下的线性时变系统:
考虑如下的线性时变系统:
式中,
假设1:e=0为式(5)的一个孤立平衡点,并且连续可微,Jacobian矩阵关于t一致有界,在D上满足Lipschitz条件。
假设2:式(6)中的A(t),B(t)完全可控。
由假设2可设计线性时变反馈控制器:
η=K(t)e(7)
使得线性时变系统(6)平衡点e=0为指数稳定,并记
AC=A(t)+B(t)K(t)(8)
由文献[3](ShaoX,WangH.ANovelMethodofRobustTrajectory LinearizationControlBasedonDisturbanceRejection[J].MathematicalProblems inEngineering,2014,2014)可知,线性时变反馈控制律(7)可保证系统(4)在平衡点e=0 指数稳定。
3、非线性干扰观测器
非线性干扰观测器是针对非线性系统模型中外部干扰,对其进行观测,并通过前 馈来抑制干扰的影响。
典型非线性系统描述如下:
其中,x∈Rn,u∈R,d∈R分别代表状态向量,系统输入和外界干扰。
为了估计和抑制外界干扰,需要设计干扰观测器。假设系统干扰来源于线性外源 系统
为了估计未知干扰d,设计观测器如下:
其中,z是观测器内部状态变量,p(x)是待设计的非线性向量函数,观测器增益
根据文献[8](ChenWH.Disturbanceobserverbasedcontrolfornonlinear systems[J].Mechatronics,IEEE/ASMETransactionson,2004,9(4):706-710.)可知,观 测器的估计误差渐近收敛到0。
4、挠性航天器姿态模型
帆板作为航天器主要的挠性部件,其运动和航天器本体姿态运动相互耦合。挠性 附件的运动要用无限自由度的分布参数描述。
采用混合坐标法来描述带挠性附件航天器的运动,即中心刚体使用通常描述刚体 姿态的坐标(如欧拉角),挠性附件使用离散的模态坐标描述。从而建立既能足够准确描述 航天器的运动,又便于航天器控制系统分析和设计的动力学模型。不考虑帆板相对于航天 器本体的转动,挠性航天器的动力学方程如下:
其中,ω=[ωxωyωz]T∈R3为航天器本体角速度,T=[TxTyTz]T∈R3为航天器 滚动轴、俯仰轴和偏航轴的控制力矩,d=[dxdydz]T∈R3为作用在航天器上的干扰力矩,J ∈R3×3为航天器的转动惯量,其形式为,
η∈Rn代表挠性模态坐标,n代表模态阶数,δ∈R3×n代表挠性附件和航天器本体的 耦合系数矩阵,C=diag{2ξiΩi,i=1,2,…n},分别代表挠性附件 振动阻尼系数和频率系数矩阵,ξi,Ωi分别表示挠性附件的第i阶模态阻尼比和模态频率。
为便于分析,采用等效干扰的思想,将刚柔耦合项和干扰d合并为视为系统 的总干扰,简化了系统模型,此时挠性航天器动力学模型为
忽略转动惯量矩阵J∈R3×3中的耦合项,也不必考虑帆板振动方程,系统运动学模 型和动力学模型如下所示:
5、跟踪误差线性时变调节器的设计
调节器设计原则
跟踪误差线性时变调节器采用状态反馈PI控制方法,控制器增益设计方法如下:
(1)对外环欧拉角进行控制,定义新的状态变量和输入变量如下:
其中,θint=∫θdt,ψint=∫ψdt,得到新的非线性状态空间模型
其中
得到线性化跟踪系统
其中
(2)对于内环角速度控制利用同样的方法,定义新的状态变量和输入变量如下:
其中,ωxint=∫ωxdt,ωyint=∫ωydt,ωzint=∫ωzdt,得到新的非线性状态空间模 型
得到线性化跟踪系统
其中
其中
(3)设计状态反馈控制律,使欧拉角跟踪误差渐近稳定,控制输入u1=-K1γaug,
根据设计要求确定闭环系统的期望阻尼和期望带宽ξ1j,ωn1j,j=1,2,3,则闭环系 统的特征方程为
λ2+α1j2λ+α1j1=0,j=1,2,3(57)
其中α1j2=2·ξ1j·ωn1j,
闭环系统矩阵
欧拉角跟踪控制系统增益矩阵K1满足
Acl1=A1-B1K1(59)
K1可由式(48),(49),(50),(58),(59)求得。
(4)同理,为实现对航天器姿态角速度控制,设计状态反馈控制律,u2=-K2ωaug,根 据设计要求确定闭环系统的期望阻尼和期望带宽ξ1j,ωn1j,j=1,2,3,则闭环系统的特征方 程为
λ2+α2j2λ+α2j1=0,j=1,2,3(60)
其中,α2j2=2·ξ2j·ωn2j,
闭环系统矩阵
姿态角速度控制增益矩阵K2满足
Acl2=A2-B2K2(62)
由式(54),(55),(56),(61),(62)可求得控制增益矩阵K2。
误差收敛性证明
定义跟踪误差系统
假设1:e=0是的孤立平衡点,F:[0,∞)×De→Rn连续可微,De={e∈Rn| ||e||<Re},Jacobian矩阵有界且在De上满足Lipschitz条件。
假设2:系统矩阵对(Ai(t),Bi(t))一致完全可控。
由以上假设条件,当系统等效误差时,设计线性时变的状态反馈控制律ui= Ki(t)ei,(ei=γaug,ωaug),根据文献[3]可知,系统的解在原点指数稳定。
为了简化设计,令Acli=Ai+BiKi,Acli是Hurwitz矩阵,其参数可由PD特征谱原理选 取。
6、非线性干扰观测器设计
观测器设计原理
考虑等效干扰对系统的影响,挠性航天器的动力学方程形式如下:
其中,f2(ω)=J-1·(-ω×Jω),g2=J-1。针对未知干扰设计如下的非线性干扰观 测器:
其中,代表对未知等效干扰的估计,z是非线性观测器的内部状态变量,p(ω)是 待设计的非线性向量函数,观测器的增益定义为
估计误差收敛性证明
为简单起见,假设等效干扰是慢时变的,即
令估计误差
则
将式(64)代入中,得到
由于
将式(63),(69)代入式(68)中,得到
设计p(ω),使得式(70)全局稳定。则估计误差趋近于0。
为了抑制航天器跟踪过程中干扰问题,本发明专利采用非线性干扰观测器和轨迹 线性化控制相结合的方法,利用轨迹线性化适合解决非线性跟踪问题的优点,结合非线性 干扰观测器进行干扰抑制,提高了系统的鲁棒性。主要思想是在给定挠性航天器转动惯量、 挠性帆板模态阻尼矩阵、挠性帆板耦合系数、初始姿态和目标姿态的前提下,忽略转动惯量 中的耦合项,采用等效干扰思想,先将等效误差忽略,求得航天器名义控制,然后根据PD特 征谱原理确定线性时变调节器参数,解耦非线性系统,使得系统跟踪误差渐近收敛。最后考 虑等效干扰,设计非线性干扰观测器对干扰进行补偿。系统控制结构图如图2所示,控制律 由三部分组成:
其中分别表示名义控制,时变反馈控制和干扰补偿控制。
步骤一:挠性航天器动力学建模,得到模型为
其中ω=[ωxωyωz]T∈R3为航天器本体角速度,ωx、ωy、ωz分别为航天器本体 系相对于惯性系角速度在本体坐标系滚动轴、俯仰轴和偏航轴方向投影;ω×为
步骤二:利用步骤一得到的模型,进行航天器名义控制设计;
当被控对象的逆不可求时,通过求状态变量的伪逆,得到跟踪系统的名义控制;
对将等效干扰忽略,求得系统运动学和动力学模型相对于名义状态变量和的逆,得到
其中所述为航天器本体坐标系相对于轨道坐标系的旋转角速度名义 值,为滚动轴方向、俯仰轴方向和偏航轴方向名义控制力矩,Jxx、Jyy、Jzz为航天 器沿滚动轴、俯仰轴和偏航轴的转动惯量;
公式(15)和式(16)可以精确表示出控制变量的逆;
步骤三:利用步骤二求得系统运动学和动力学模型相对于名义状态变量和 的逆,设计跟踪误差的线性时变调节器,求得状态反馈控制律u1和u2;
步骤四:根据步骤三得到的状态反馈控制律u2,设计非线性干扰观测器,将观测器 的输出作为系统控制律的一部分;得到整个系统的控制律
ωx,ωy,ωz——航天器本体系相对于惯性系角速度在本体坐标系滚动轴、俯仰轴 和偏航轴方向投影;
ω×——定义为
——航天器本体系相对于惯性系角加速度在本体坐标系滚动轴、俯 仰轴和偏航轴方向投影;
——航天器本体系相对于惯性系角速度在本体坐标系滚动轴、俯 仰轴和偏航轴方向投影的名义状态变量;
——航天器本体系相对于惯性系角加速度在本体坐标系滚动轴、俯 仰轴和偏航轴方向投影的名义状态变量;
——航天器本体坐标系相对于轨道坐标系的欧拉角;
——航天器本体坐标系相对于轨道坐标系的旋转角速度名义值;
Tx,Ty,Tz——滚动轴方向、俯仰轴方向和偏航轴方向控制力矩;
——滚动轴方向、俯仰轴方向和偏航轴方向名义控制力矩;
dx,dy,dz——滚动轴方向、俯仰轴方向和偏航轴方向干扰力矩;
η∈Rn——挠性模态坐标,n为模态阶数;
Jx(Jxx),Jy(Jyy),Jz(Jzz)——航天器沿滚动轴、俯仰轴和偏航轴的转动惯量;
δ∈R3×n——挠性附件和航天器本体的耦合系数矩阵;
ξi——挠性附件的第i阶模态阻尼比;
Ωi——模态频率;
ωn,diff——衰减高频增益的低通滤波器的带宽;
——欧拉角积分变量;
ξ1j——外环闭环系统的期望阻尼;
ωn1j——外环闭环系统的带宽系数;
ei——跟踪误差;
——未知等效干扰的估计;
z——非线性观测器的内部状态变量;
p(ω)——待设计的非线性向量函数;
l(ω)——观测器的增益。
d=[dxdydz]T∈R3为作用在航天器上的干扰力矩;
——名义控制输入,反馈控制输入和观测器干扰补偿。
具体实施方式二:本实施方式与具体实施方式一不同的是:所述步骤一中挠性航 天器动力学建模的具体过程为:
采用混合坐标法来描述带挠性附件航天器的运动,即中心刚体使用通常描述刚体 姿态的坐标(如欧拉角),挠性附件使用离散的模态坐标描述。从而建立既能足够准确描述 航天器的运动,又便于航天器控制系统分析和设计的动力学模型。
不考虑帆板相对于航天器本体的转动,挠性航天器的动力学方程如下:
为便于分析,采用等效干扰的思想,将刚柔耦合项和干扰d合并为视为系统 的总干扰,简化了系统模型,此时挠性航天器动力学模型为
具体实施方式三:本实施方式与具体实施方式一或二不同的是:所述步骤二中名 义控制中出现控制变量的微分形式,需要准微分器以得到名义状态的导数,本发明采用一 阶准微分器,形式为:
其中s为拉普拉斯算子,ωn,diff为低通滤波器的带宽,决定了微分器抑制高频分量 的能力。
具体实施方式四:本实施方式与具体实施方式一至三之一不同的是:所述步骤三 中设计跟踪误差的线性时变调节器,求得状态反馈控制律u1和u2的具体过程为:
步骤一:新的非线性状态空间模型和线性化跟踪系统的获得;
对外环欧拉角进行控制,定义新的状态变量和输入变量如下:
其中θint=∫θdt,ψint=∫ψdt,得到新的非线性状态空间模型
其中
得到线性化跟踪系统为:
其中
步骤二:新的非线性状态空间模型和线性化跟踪系统的获得:
对于内环角速度控制利用同样的方法,定义新的状态变量和输入变量如下:
其中,ωxint=∫ωxdt,ωyint=∫ωydt,ωzint=∫ωzdt,得到新的非线性状态空间模 型
得到线性化跟踪系统为:
其中
其中
步骤三:状态反馈控制律u1的获得;
设计状态反馈控制律,控制输入u1=-K1γaug,
根据设计要求确定闭环系统的期望阻尼和期望带宽ξ1j,ωn1j,j=1,2,3,则闭环系 统的特征方程为:
λ2+α1j2λ+α1j1=0,j=1,2,3(30)
其中α1j2=2·ξ1j·ωn1j,
闭环系统矩阵
欧拉角跟踪控制系统增益矩阵K1满足
Acl1=A1-B1K1(32)
K1可由式(21),(22),(23),(31),(32)求得;
由于u1=-K1γaug,由K1和γaug可求得u1;
步骤四:状态反馈控制律u2的获得;
设计状态反馈控制律,控制输入u2=-K2ωaug,根据设计要求确定闭环系统的期望 阻尼和期望带宽ξ1j,ωn1j,j=1,2,3,则闭环系统的特征方程为:
λ2+α2j2λ+α2j1=0,j=1,2,3(33)
其中,α2j2=2·ξ2j·ωn2j,
闭环系统矩阵为:
姿态角速度控制增益矩阵K2满足
Acl2=A2-B2K2(35)
由式(26),(27),(28),(34),(35)可求得控制增益矩阵K2;
由于u2=-K2ωaug,由K2和ωaug可求得u2。
具体实施方式五:本实施方式与具体实施方式一至四之一不同的是:所述步骤四 中设计非线性干扰观测器的具体过程为:
考虑等效干扰对系统的影响,挠性航天器的动力学方程形式如下:
其中,f2(ω)=J-1·(-ω×Jω),g2=J-1;
针对未知干扰设计非线性干扰观测器为:
其中所述代表对未知等效干扰的估计,z是非线性观测器的内部状态变量,p(ω) 是待设计的非线性向量函数,观测器的增益定义为:
假设等效干扰是慢时变的,即
定义估计误差当假设时,如果p(ω)的选取满足式(39)是全局 稳定的,则ed(t)趋近于0;待设计的非线性向量函数p(ω)满足上述条件;
将观测器的输出作为系统控制律的一部分,用于补偿外界干扰。由文献[9] (朱亮.基于非线性干扰观测器的空天飞行器轨迹线性化控制.[J].南京航空航天大学学 报.2007,39(4):492-494)可知,用观测器的输出来补偿外界干扰可以避免干扰对系统的影 响。
综上,整个系统的控制律根据文献[9]可知,复合闭环系统误差动 态特性局部指数稳定。
实施例一:
1、仿真参数:
本发明专利采用如下仿真参数;
航天器转动惯量:
跟踪目标的角速度为:
外部干扰为:
挠性太阳帆板模态频率矩阵:Ω=diag(0.7681;1.1038;1.8733;2.5490)×2π (rad/s)
挠性太阳帆板模态阻尼矩阵:ξ=diag(0.056;0.0086;0.013;0.025)
挠性太阳帆板耦合系数:
航天器初始姿态为:θ=0.1°,ψ=0.1°,
2、控制器参数:
设计名义控制时,用到了准微分器来估计名义状态的导数,内环和外环一阶准微 分调节器参数,即低通滤波器的带宽分别为:ωn,diff_i=15(rad/s),ωn,diff_o=5(rad/s), 有效衰减了高频增益。
系统的阻尼频率决定了系统的调节时间和超调量,进而决定了系统平稳性。本专 利中内环和外环期望阻尼设计为:ξ1j=0.707,ξ2j=0.707,j=1,2,3
系统的带宽同样影响了闭环系统的动态性能,本专利中内环和外环期望带宽设计 为:
ωn11=0.01(rad/s),ωn12=0.01(rad/s),ωn13=0.01(rad/s)
ωn21=1(rad/s),ωn22=1(rad/s),ωn23=0.5(rad/s)
观测器的增益矩阵可以配置系统的闭环极点,调节稳态性能,本专利中非线性干 扰观测器增益为:l=[101010]T。
3、仿真分析
本发明专利控制目标是使挠性航天器无误差跟踪期望姿态。考虑到实际情况,执 行机构的执行能力有限,所以仿真中对控制力矩进行幅值限制,使其不超过2(N.m)。仿真结 果如图3~10所示:
从仿真结果可以看出,航天器达到预期姿态的时间为4s,欧拉角稳态误差幅值为5 ×10-5rad,角速度稳态误差为2×10-4rad/s,控制力矩稳态幅值为0.1Nm,挠性模态振动最 大幅值为0.018。
综上,只要合理选择误差调节器参数和观测器的增益,基于非线性干扰观测器的 轨迹线性化控制就可以实现航天器姿态跟踪,精度较高,挠性帆板模态振动幅值较小。此 外,利用非线性干扰观测器对不确定性干扰进行了估计和抑制,取得了较理想的效果。
机译: 基于输出反馈的挠性航天器精细姿态控制方法
机译: 基于有限时间摩擦估计的挠性航天器姿态控制方法
机译: 相同方法形成挠性导电轨迹,挠性导电轨迹和挠性电子设备的方法