CN105912012A - 一种部分执行机构故障下航天器混沌姿态控制方法 - Google Patents
一种部分执行机构故障下航天器混沌姿态控制方法 Download PDFInfo
- Publication number
- CN105912012A CN105912012A CN201610494493.8A CN201610494493A CN105912012A CN 105912012 A CN105912012 A CN 105912012A CN 201610494493 A CN201610494493 A CN 201610494493A CN 105912012 A CN105912012 A CN 105912012A
- Authority
- CN
- China
- Prior art keywords
- omega
- spacecraft
- centerdot
- attitude
- angular velocity
- 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
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
- G05D1/0816—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
- G05D1/0825—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- General Physics & Mathematics (AREA)
- Pure & Applied Mathematics (AREA)
- Mathematical Optimization (AREA)
- Mathematical Physics (AREA)
- Mathematical Analysis (AREA)
- Algebra (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
一种部分执行机构故障下航天器混沌姿态控制方法,本发明涉及部分执行机构故障下航天器混沌姿态控制方法。本发明的目的是为了解决现有航天器执行机构部分故障或失效的情况下,不能使航天器快速消除混沌运动状态,达到稳定状态,并且达到稳定的时间也不能确定的问题。一、得到三控制输入混沌姿态动力学非线性方程形式;二、得到双输入混沌姿态动力学非线性方程形式;三、获得姿态角速度误差;四、设计积分滑模面,保证姿态角速度误差系统状态能在滑模面上滑动到平衡状态;五、设计滑模控制律,保证姿态角速度误差系统状态能从任意初始位置到达滑模面;六、将五代入二,使航天器角速度最终达到平衡状态。本发明用于航天器领域。
Description
技术领域
本发明涉及部分执行机构故障下航天器混沌姿态控制方法。
背景技术
航天器广泛应用于通信、遥感、侦查以及一些科学研究,其姿态控制精度与稳定度严重影响航天器的性能,外界干扰力矩如气动力矩、重力梯度力矩、磁力矩、甚至是非合作目标航天器故意施加的干扰力矩都会严重影响航天器的正常运行。当敌方辨识出我方航天器的角速度和转动惯量时,通过施加相应的干扰力矩,意图使我方航天器处于混沌运动,导致我方航天器失效。
在航天器姿态控制系统中,从控制器发出的控制信号不能直接作用于系统,需要执行机构将控制信号转化成力矩的合适的启动信号以驱动系统,执行机构因此成为了系统的控制受动器,系统中执行机构发生部分故障会使航天器控制性能降低甚至引起严重后果。
现有技术针对航天器混沌运动的控制技术研究尚且不多,尤其是航天器执行机构部分故障或失效的情况下,不能使航天器快速消除混沌运动状态,达到稳定状态,并且达到稳定的时间也不能确定的问题。
发明内容
本发明的目的是为了解决现有航天器执行机构部分故障或失效的情况下,不能使航天器快速消除混沌运动状态,达到稳定状态,并且达到稳定的时间也不能确定的问题,而提出一种部分执行机构故障下航天器混沌姿态控制方法。
一种部分执行机构故障下航天器混沌姿态控制方法包括以下步骤:
步骤一、将外界干扰力矩作用下的刚体航天器混沌姿态动力学方程改写成矩阵向量表示的刚体航天器三控制输入混沌姿态动力学非线性方程形式;
步骤二、针对部分执行机构故障情况下(以安装在滚转轴上的执行机构失效为例)刚体航天器混沌姿态动力学方程,将刚体航天器三控制输入混沌姿态动力学非线性方程转化成刚体航天器双输入混沌姿态动力学非线性方程形式;
步骤三、针对刚体航天器双输入混沌姿态动力学非线性方程,设计姿态角速度参考轨迹及姿态角加速度参考轨迹,获得姿态角速度误差;
步骤四、针对姿态角速度误差,设计积分滑模面,保证姿态角速度误差系统状态能在滑模面上滑动到平衡状态;
步骤五、设计滑模控制律,保证姿态角速度误差系统状态能从任意初始位置到达滑模面;
步骤六、利用线性矩阵不等式方法求解积分滑模面所涉及的未知矩阵,根据所设计的姿态角速度参考轨迹和姿态角加速度参考轨迹最终都为零,将步骤五所设计的滑模控制律代入刚体航天器双输入混沌姿态动力学非线性方程,可使航天器角速度最终达到平衡状态。
本发明的有益效果为:
与现有技术相比,本发明的有益效果是在航天器执行机构部分故障或失效的情况下,能够使航天器消除混沌运动状态,最终达到稳定状态,而达到稳定的时间可以通过提前设计参考轨迹时间来设定。设计特征时间点t3=60s,可以看出航天器能够在60s的时候达到稳定状态,此时滚转轴的控制输入力矩Tc1=0,即滚转轴上的执行机构失效,航天器的混沌运动状态消除。并且,俯仰轴和偏航轴上的控制输入力矩不超过所设定的控制力矩边界最大值0.88Nm。
本发明设计合理可行的控制策略,一旦发生混沌运动情况,使我方有能力将航天器从混沌运动快速达到稳定状态,满足任务需求。
附图说明
图1为本发明一种部分执行机构故障下航天器混沌姿态控制方法的流程图;
图2为本发明中无控条件下航天器滚转角速度-俯仰角速度平面图,ω1表示无控条件下航天器姿态角速度在本体坐标系的第一个分量,ω2表示无控条件下航天器姿态角速度在本体坐标系的第二个分量,rad/s表示角速度单位为弧度每秒;
图3为本发明中无控条件下航天器俯仰角速度-偏航角速度平面图,ω3表示无控条件下航天器姿态角速度在本体坐标系的第三个分量;
图4为本发明中无控条件下航天器滚转角速度-偏航角速度平面图;
图5为本发明中航天器参考角速度的变化曲线图,[ωdr1 ωdr2 ωdr3]表示航天器的角速度在本体坐标系的三个分量,°/s表示角速度单位为度每秒,s表示时间单位秒;
图6为本发明中航天器参考角加速度的变化曲线图,[dωdr1 dωdr2 dωdr3]表示航天器的角加速度在本体坐标系的三个分量,°/s2表示角加速度单位为度每秒的平方;
图7为本发明中航天器角速度的变化曲线图,[ω1 ω2 ω3]表示控制器作用下航天器的角速度在本体坐标系的三个分量;
图8为本发明中航天器角速度误差的变化曲线图,[e1 e2 e3]表示航天器的角速度误差在本体坐标系的三个分量;
图9为本发明中航天器所受控制力矩的变化曲线图,[Tc1 Tc2 Tc3]表示航天器所受的控制输入力矩在本体坐标系的三个分量,Nm表示控制力矩单位为牛米。
具体实施方式
具体实施方式一:结合图1说明本实施方式,本实施方式的一种部分执行机构(如反作用飞轮、磁力矩器或控制力矩陀螺等)故障下航天器混沌姿态控制方法,其特征在于,一种部分执行机构故障下航天器混沌姿态控制方法包括以下步骤:
步骤一、将外界干扰力矩(如气动力矩、重力梯度力矩、磁力矩、甚至是非合作目标航天器故意施加的干扰力矩)作用下的刚体航天器混沌姿态动力学方程改写成矩阵向量表示的刚体航天器三控制输入混沌姿态动力学非线性方程形式;
步骤二、针对部分执行机构故障情况下(以安装在滚转轴上的执行机构失效为例)刚体航天器混沌姿态动力学方程,将刚体航天器三控制输入混沌姿态动力学非线性方程转化成刚体航天器双输入混沌姿态动力学非线性方程形式;
步骤三、针对刚体航天器双输入混沌姿态动力学非线性方程,设计姿态角速度参考轨迹及姿态角加速度参考轨迹,获得姿态角速度误差;
步骤四、针对姿态角速度误差,设计积分滑模面,保证姿态角速度误差系统状态能在滑模面上滑动到平衡状态;
步骤五、设计滑模控制律,保证姿态角速度误差系统状态能从任意初始位置到达滑模面;
步骤六、利用线性矩阵不等式方法求解积分滑模面所涉及的未知矩阵,根据所设计的姿态角速度参考轨迹和姿态角加速度参考轨迹最终都为零,将步骤五所设计的滑模控制律代入刚体航天器双输入混沌姿态动力学非线性方程,可使航天器角速度最终达到平衡状态。
具体实施方式二:本实施方式与具体实施方式一不同的是:所述步骤一中将外界干扰力矩(如气动力矩、重力梯度力矩、磁力矩、甚至是非合作目标航天器故意施加的干扰力矩)作用下的刚体航天器混沌姿态动力学方程改写成矩阵向量表示的刚体航天器三控制输入混沌姿态动力学非线性方程形式;具体过称为:
外界干扰力矩(如气动力矩、重力梯度力矩、磁力矩、甚至是非合作目标航天器故意施加的干扰力矩)作用下的刚体航天器混沌姿态动力学方程为
其中,ω=[ω1 ω2 ω3]T表示航天器姿态角速度;为ω的一阶导数,表示航天器姿态角加速度;I表示航天器转动惯量,T为转置矩阵,Tc表示作用在航天器上的控制力矩,Td表示外界干扰力矩,Td一般具有如下形式
Td=Dω+M
其中,D=[dij]3×3∈R3×3为常数矩阵或随航天器角速度变化的矩阵,M=[mi]3×1∈R3×1为常数矩阵或随航天器角速度变化的矩阵,[mi]3×1为3×1的向量,mi表示M的第i个分量,[dij]3×3为3×3的矩阵,dij表示D的第i行第j列个分量,i=1,2,3,j=1,2,3,R为实数集,R3×1为3×1的实数集,R3×3为3×3的实数集;
取航天器的三个惯性主轴为航天器体坐标系的三个轴,则I=diag(I1,I2,I3);采用三维勒维奇维塔符号(是一种表示向量叉乘的符号)表示向量叉乘,记为εkij,定义为
对任意两个向量p=[pi]3×1和q=[qj]3×1,p表示向量叉乘计算的第一个向量,q表示向量叉乘计算的第二个向量,有
其中,()k表示向量叉乘的第k个分量,[pi]3×1为用p的分量形式表示的向量叉乘计算的第一个3×1的向量,pi表示p的第i个分量,[qj]3×1为用q的分量形式表示的向量叉乘计算的第二个3×1的向量,qj表示q的第j个分量,k=1,2,3,i=1,2,3,j=1,2,3;
将刚体航天器混沌姿态动力学方程写成用标量表示的分量形式可得
式中,I1为航天器转动惯量在本体坐标系第一个轴上的分量,I2为航天器转动惯量在本体坐标系第二个轴上的分量,I3为航天器转动惯量在本体坐标系第三个轴上的分量,ω1表示航天器姿态角速度在本体坐标系的第一个分量,ω2表示航天器姿态角速度在本体坐标系的第二个分量,ω3表示航天器姿态角速度在本体坐标系的第三个分量,为ω1的一阶导数,表示航天器姿态角加速度在本体坐标系的第一个分量;为ω2的一阶导数,表示航天器姿态角加速度在本体坐标系的第二个分量;为ω3的一阶导数,表示航天器姿态角加速度在本体坐标系的第三个分量;Tc1表示航天器所受的控制输入力矩在本体坐标系的第一个分量,Tc2表示航天器所受的控制输入力矩在本体坐标系的第二个分量,Tc3表示航天器所受的控制输入力矩在本体坐标系的第三个分量,d11、d21、d31、d12、d22、d32、d13、d23和d33为D的自上而下自左而右的9个分量,m1为M的第1个分量,m2为M的第2个分量,m3为M的第3个分量;
即
令
式中,A为由航天器转动惯量确定的对角矩阵,B为由航天器转动惯量及D确定的3×3的矩阵,W为由航天器转动惯量及M确定的3×1的矩阵,f(ω)为由航天器角速度、航天器转动惯量及M确定的3×1的矩阵,u为由航天器转动惯量及控制输入力矩确定的3×1的控制输入矩阵;
则刚体航天器三控制输入混沌姿态动力学非线性方程化为
在无控状态下(u=0),若航天器转动惯量及所受到的控制力矩满足
I1=2I2=2I3
则姿态动力学方程变为Chen系统形式
当a=35,b=3,c=28时,该系统为混沌系统。
其它步骤及参数与具体实施方式一相同。
具体实施方式三:本实施方式与具体实施方式一或二不同的是:所述步骤二中针对部分执行机构故障情况下(以安装在滚转轴上的执行机构失效为例)刚体航天器混沌姿态动力学方程,将刚体航天器三控制输入混沌姿态动力学非线性方程转化成刚体航天器双输入混沌姿态动力学非线性方程形式;具体过称为:
以安装在滚转轴上的执行机构故障失效为例,即Tc1=0。
部分执行机构故障失效,此时,Tc1=0,令u=[0 u*T]T,此时刚体航天器三控制输入混沌姿态动力学非线性方程转化为刚体航天器双输入混沌姿态动力学方程,具体过称为:
其中,
式中,u*为由俯仰轴的控制输入和偏航轴的控制输入所组成的2×1的向量,u2为俯仰轴的控制输入,u3为偏航轴的控制输入。
其它步骤及参数与具体实施方式一或二相同。
具体实施方式四:本实施方式与具体实施方式一至三之一不同的是:所述步骤三中针对刚体航天器双输入混沌姿态动力学非线性方程,设计姿态角速度参考轨迹及姿态角加速度参考轨迹,获得姿态角速度误差;具体过称为:
为满足一定的任务要求,需要对航天器的角加速度进行一定限制,
假设将航天器偏航轴的角加速度最大值限制为可以设计偏航轴的姿态角加速度参考轨迹,其数学表达式为
式中,为偏航轴的姿态角加速度参考轨迹,t为时间,t1、t2、t3为特征时间点;
积分得到姿态角速度参考轨迹的减小量数学表达式为
则偏航轴的姿态角速度参考轨迹的数学表达式为
式中,ωdr(t)为偏航轴的姿态角速度参考轨迹,ωd0为偏航轴的参考姿态角速度初始值;
其中,航天器偏航轴的姿态角加速度最大值限制为受特征时间点ti,i=1,2,3及参考姿态角速度初始值ωd0制约,假设航天器参考姿态角加速度为其中,为三个轴的参考姿态角加速度组成的3×1的向量,为航天器参考姿态角加速度在本体坐标系的第二个分量,为航天器参考姿态角加速度在本体坐标系的第三个分量;
则求得
姿态角速度误差设为e=ω-ωd,则姿态角加速度误差的变化率为
其它步骤及参数与具体实施方式一至三之一相同。
具体实施方式五:本实施方式与具体实施方式一至四之一不同的是:所述步骤四中针对姿态角速度误差e,设计积分滑模面,保证姿态角速度误差系统状态能在滑模面上滑动到平衡状态;
滑模控制律由等效控制ueq和切换控制usw构成,通过取得到滑模控制律的等效项ueq,然后令u=ueq+usw,通过分析并将u代入,使成立,从而得到滑模控制律的切换控制usw;等效控制保证系统的状态在滑模面上,切换控制保证系统的状态不离开滑模面。
设计积分滑模面
其中,
C为未知矩阵,c1为C的第一列第一个分量,c2为C的第一列第二个分量,K为积分系数矩阵;
令得到滑模控制律的等效项ueq为
从而得
又
故上式可以化成
又limωd=0,若要保证lime=0,必须满足矩阵B-FCB-FK是Hurwitz稳定的,Hurwitz为赫尔维茨判据。
其它步骤及参数与具体实施方式一至四之一相同。
具体实施方式六:本实施方式与具体实施方式一至五之一不同的是:所述步骤五中设计滑模控制律,保证姿态角速度误差系统状态能从任意初始位置到达滑模面;具体过称为:
采用趋近律
式中,ε、α、k为给定的已知正常数;
则姿态角速度误差系统状态到达滑模面的时间为
设计滑模控制律为
该控制律能够保证姿态角速度误差系统状态在有限时间内到达滑模面,并在滑模面上渐进稳定在平衡点,保证lime=0,即limω=0。
为保证控制输入受限,可以通过选取合适的边界最大值来保证,判断是否合适的标准是该边界值是否影响系统的稳定性。
其它步骤及参数与具体实施方式一至五之一相同。
具体实施方式七:本实施方式与具体实施方式一至六之一不同的是:所述步骤六中利用线性矩阵不等式方法求解积分滑模面所涉及的未知矩阵,根据所设计的姿态角速度参考轨迹和姿态角加速度参考轨迹最终都为零,将步骤五所设计的滑模控制律代入刚体航天器双输入混沌姿态动力学非线性方程,可使航天器角速度最终达到平衡状态;具体过称为:
通过选取合适的对称正定矩阵P,若
P(B-FCB-FK)+(B-FCB-FK)TP<0
则满足Hurwitz稳定条件,并能够保证lime=0,即limω=0;
通过求解线性矩阵不等式的可行解,得到滑模控制律中的未知矩阵C和未知矩阵K。
其它步骤及参数与具体实施方式一至六之一相同。
采用以下实施例验证本发明的有益效果:
实施例一:
本实施例一种部分执行机构故障下航天器混沌姿态控制方法具体是按照以下步骤制
备的:
步骤一、将外界干扰作用下的刚体航天器混沌姿态动力学方程改写成矩阵向量表示的三控制输入非线性方程形式;
刚体航天器的姿态动力学方程为
其中,ω=[ω1 ω2 ω3]T表示航天器姿态角速度,I表示航天器转动惯量,Tc表示作用在航天器上的控制力矩,Td表示外界干扰力矩,一般具有如下形式
Td=Dω+M
其中,D=[dij]3×3∈R3×3(i,j=1,2,3)和M=[mi]3×1∈R3×1(i=1,2,3)为常数矩阵或随航天器角速度变化的矩阵。
取航天器的三个惯性主轴为其体坐标系的三个轴,可知I=diag(I1,I2,I3)。采用三维勒维奇维塔符号表示向量叉乘,记为εkij,定义为:
对任意两个向量p=[pi]3×1(i=1,2,3)和q=[qj]3×1(j=1,2,3),有其中,()k表示向量叉乘的第k个分量。
将姿态动力学方程写成分量形式可得:
即
令
则三输入姿态动力学方程可化为:
在无控状态下(u=0),若航天器转动惯量及所受到的控制力矩满足
I1=2I2=2I3
则姿态动力学方程变为Chen系统形式
当a=35,b=3,c=28时,该系统为混沌系统。
步骤二、针对部分执行机构故障情况下(以安装在滚转轴上的执行机构失效为例)航天器混沌姿态动力学方程,将三控制输入非线性方程转化成双输入非线性方程形式;
以安装在滚转轴上的执行机构故障失效为例,即Tc1=0。令u=[0 u*T]T,此时三输入姿态动力学方程转化为双输入姿态动力学方程:
其中,
步骤三、针对刚体航天器双输入混沌姿态动力学方程,设计姿态角速度及姿态角加速度参考轨迹,获得姿态角速度误差;
为满足一定的任务要求,需要对航天器的角加速度进行一定限制,假设将航天器偏航轴的角加速度最大值限制为可以设计偏航轴角加速度参考轨迹,其数学表达式为:
积分可得到参考角速度的减小量数学表达式为:
从而可知,参考角速度的数学表达式为:
其中,角加速度最大值受特征时间点ti,i=1,2,3及参考角速度初始值制约,假设航天器参考角加速度为
可求得:
误差角速度设为e,则角加速度误差的变化率为
步骤四、针对姿态角速度误差,设计积分滑模面,保证姿态角速度误差状态能在滑模面上滑动到平衡状态;
滑模控制律可由等效控制ueq和切换控制usw构成,通过取可以得到滑模控制律的等效项ueq,然后令u=ueq+usw,通过分析并将u代入,使成立,从而可得到滑模控制律的切换控制usw。等效控制保证系统的状态在滑模面上,切换控制保证系统的状态不离开滑模面。
设计滑模面
其中,
令可得到等效控制为:
从而可得:
又
故上式可以化成
又limωd=0,若要保证lime=0,必须满足矩阵B-FCB-FK是Hurwitz稳定的。
步骤五、设计滑模控制器,保证姿态角速度误差状态能从任意初始位置到达滑模面;
采用趋近律
则系统状态到达滑模面的时间为
设计滑模控制律为
该控制律能够保证系统状态在有限时间内到达滑模面,并在滑模面上渐进稳定在平衡点,保证lime=0,即limω=0。
为保证控制输入受限,可以通过选取合适的边界最大值来保证,判断是否合适的标准是该边界值是否影响系统的稳定性。
步骤六、利用线性矩阵不等式方法求解滑模面所涉及的未知矩阵,由于所设计的姿态角速度参考轨迹和姿态角加速度参考轨迹最终都为零,将所设计的滑模控制器代入刚体航天器双输入混沌姿态动力学方程,可使航天器角速度最终达到平衡状态。
通过选取合适的对称正定矩阵P,若
P(B-FCB-FK)+(B-FCB-FK)TP<0
则满足Hurwitz稳定条件,并能够保证lime=0,即limω=0。
通过求解线性矩阵不等式的可行解,可以得到控制器中的未知矩阵C和K。
以下通过数值仿真对本实施例的一种部分执行机构故障下航天器混沌姿态控制方法进行验证:
航天器转动惯量:I1=2kg·m2,I1=I3=1kg·m2
角速度初始值:ω0=[1.7189 2.2918 1.4324]T°/s
参考角速度:ωd=[0.5ωdr 0.6ωdr ωdr]T
参考角加速度:
特征时间点:t1=15s,t2=40s,t3=60s
偏航角速度初始值:ωdr0=1.7189°/s
选取对称正定矩阵:P=diag(0.01,0.02,0.03)
控制器相关参数:k=0.04,ε=0.01,α=0.4。
控制力矩边界最大值:um=0.88Nm
可以计算
利用YALMIP工具箱求解线性矩阵不等式可得
在无控条件下,图2至图4为相应的仿真结果,可以看出航天器处于混沌运动状态;将所得控制器代入步骤三获得的误差姿态动力学方程,图5至图9为相应的仿真结果,其中,图5为航天器参考角速度的变化曲线图,图6为航天器参考角加速度的变化曲线图,图7为在步骤五所设计的控制器的控制作用下航天器的角速度变化曲线图,图8为相应的航天器的角速度误差变化曲线图,图9为航天器所受控制力矩的变化曲线图。观察易见,航天器在步骤五所设计的控制器的控制作用下,能够在所设计的参考轨迹时间内,脱离混沌运动而达到稳定状态,且控制输入力矩在受限范围内。
可见,本发明的一种部分执行机构故障下航天器混沌姿态控制方法能够在执行机构故障情况下成功使航天器从混沌运动状态在有限时间内达到稳定状态。
本发明还可有其它多种实施例,在不背离本发明精神及其实质的情况下,本领域技术人员当可根据本发明作出各种相应的改变和变形,但这些相应的改变和变形都应属于本发明所附的权利要求的保护范围。
Claims (7)
1.一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:一种部分执行机构故障下航天器混沌姿态控制方法具体是按照以下步骤进行的:
步骤一、将外界干扰力矩作用下的刚体航天器混沌姿态动力学方程改写成矩阵向量表示的刚体航天器三控制输入混沌姿态动力学非线性方程形式;
步骤二、针对部分执行机构故障情况下刚体航天器混沌姿态动力学方程,将刚体航天器三控制输入混沌姿态动力学非线性方程转化成刚体航天器双输入混沌姿态动力学非线性方程形式;
步骤三、针对刚体航天器双输入混沌姿态动力学非线性方程,设计姿态角速度参考轨迹及姿态角加速度参考轨迹,获得姿态角速度误差;
步骤四、针对姿态角速度误差,设计积分滑模面,保证姿态角速度误差系统状态能在滑模面上滑动到平衡状态;
步骤五、设计滑模控制律,保证姿态角速度误差系统状态能从任意初始位置到达滑模面;
步骤六、利用线性矩阵不等式方法求解积分滑模面所涉及的未知矩阵,根据所设计的姿态角速度参考轨迹和姿态角加速度参考轨迹最终都为零,将步骤五所设计的滑模控制律代入刚体航天器双输入混沌姿态动力学非线性方程,可使航天器角速度最终达到平衡状态。
2.根据权利要求1所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤一中将外界干扰力矩作用下的刚体航天器混沌姿态动力学方程改写成矩阵向量表示的刚体航天器三控制输入混沌姿态动力学非线性方程形式;具体过称为:
外界干扰力矩作用下的刚体航天器混沌姿态动力学方程为
其中,ω=[ω1 ω2 ω3]T表示航天器姿态角速度;为ω的一阶导数,表示航天器姿态角加速度;I表示航天器转动惯量,T为转置矩阵,Tc表示作用在航天器上的控制力矩,Td表示外界干扰力矩,Td具有如下形式
Td=Dω+M
其中,D=[dij]3×3∈R3×3为常数矩阵或随航天器角速度变化的矩阵,M=[mi]3×1∈R3×1为常数矩阵或随航天器角速度变化的矩阵,[mi]3×1为3×1的向量,mi表示M的第i个分量,[dij]3×3为3×3的矩阵,dij表示D的第i行第j列个分量,i=1,2,3,j=1,2,3,R为实数集,R3×1为3×1的实数集,R3×3为3×3的实数集;
取航天器的三个惯性主轴为航天器体坐标系的三个轴,则I=diag(I1,I2,I3);采用三维勒维奇维塔符号表示向量叉乘,记为εkij,定义为
对任意两个向量p=[pi]3×1和q=[qj]3×1,p表示向量叉乘计算的第一个向量,q表示向量叉乘计算的第二个向量,有
其中,()k表示向量叉乘的第k个分量,[pi]3×1为用p的分量形式表示的向量叉乘计算的第一个3×1的向量,pi表示p的第i个分量,[qj]3×1为用q的分量形式表示的向量叉乘计算的第二个3×1的向量,qj表示q的第j个分量,k=1,2,3,i=1,2,3,j=1,2,3;
将刚体航天器混沌姿态动力学方程写成用标量表示的标量形式可得
式中,I1为航天器转动惯量在本体坐标系第一个轴上的分量,I2为航天器转动惯量在本体坐标系第二个轴上的分量,I3为航天器转动惯量在本体坐标系第三个轴上的分量,ω1表示航天器姿态角速度在本体坐标系的第一个分量,ω2表示航天器姿态角速度在本体坐标系的第二个分量,ω3表示航天器姿态角速度在本体坐标系的第三个分量,为ω1的一阶导数,表示航天器姿态角加速度在本体坐标系的第一个分量;为ω2的一阶导数,表示航天器姿态角加速度在本体坐标系的第二个分量;为ω3的一阶导数,表示航天器姿态角加速度在本体坐标系的第三个分量;Tc1表示航天器所受的控制输入力矩在本体坐标系的第一个分量,Tc2表示航天器所受的控制输入力矩在本体坐标系的第二个分量,Tc3表示航天器所受的控制输入力矩在本体坐标系的第三个分量,d11、d21、d31、d12、d22、d32、d13、d23和d33为D的自上而下自左而右的9个分量,m1为M的第1个分量,m2为M的第2个分量,m3为M的第3个分量;
即
令
式中,A为由航天器转动惯量确定的对角矩阵,B为由航天器转动惯量及D确定的3×3的矩阵,W为由航天器转动惯量及M确定的3×1的矩阵,f(ω)为由航天器角速度、航天器转动惯量及M确定的3×1的矩阵,u为由航天器转动惯量及控制输入力矩确定的3×1的控制输入矩阵;
则刚体航天器三控制输入混沌姿态动力学非线性方程化为
3.根据权利要求2所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤二中针对部分执行机构故障情况下(以安装在滚转轴上的执行机构失效为例)刚体航天器混沌姿态动力学方程,将刚体航天器三控制输入混沌姿态动力学非线性方程转化成刚体航天器双输入混沌姿态动力学非线性方程形式;具体过称为:
部分执行机构故障失效,Tc1=0,令u=[0 u*T]T,此时刚体航天器三控制输入混沌姿态动力学非线性方程转化为刚体航天器双输入混沌姿态动力学方程,具体过称为:
其中,
式中,u*为由俯仰轴的控制输入和偏航轴的控制输入所组成的2×1的向量,u2为俯仰轴的控制输入,u3为偏航轴的控制输入。
4.根据权利要求3所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤三中针对刚体航天器双输入混沌姿态动力学非线性方程,设计姿态角速度参考轨迹及姿态角加速度参考轨迹,获得姿态角速度误差;具体过称为:
假设将航天器偏航轴的角加速度最大值限制为设计偏航轴的姿态角加速度参考轨迹,其数学表达式为
式中,为偏航轴的姿态角加速度参考轨迹,t为时间,t1、t2、t3为特征时间点;
积分得到姿态角速度参考轨迹的减小量数学表达式为
则偏航轴的姿态角速度参考轨迹的数学表达式为
式中,ωdr(t)为偏航轴的姿态角速度参考轨迹,ωd0为偏航轴的参考姿态角速度初始值;
其中,航天器偏航轴的姿态角加速度最大值限制为受特征时间点ti,i=1,2,3及参考姿态角速度初始值ωd0制约,假设航天器参考姿态角加速度为其中,为三个轴的参考姿态角加速度组成的3×1的向量,为航天器参考姿态角加速度在本体坐标系的第二个分量,为航天器参考姿态角加速度在本体坐标系的第三个分量;
则求得
姿态角速度误差设为e=ω-ωd,则姿态角加速度误差的变化率为
5.根据权利要求4所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤四中针对姿态角速度误差e,设计积分滑模面,保证姿态角速度误差系统状态能在滑模面上滑动到平衡状态;
设计积分滑模面
其中,
C为未知矩阵,c1为C的第一列第一个分量,c2为C的第一列第二个分量,K为积分系数矩阵,为未知矩阵;
令得到滑模控制律的等效项ueq为
从而得
又
故上式可以化成
又limωd=0,若要保证lime=0,必须满足矩阵B-FCB-FK是Hurwitz稳定的,Hurwitz为赫尔维茨判据。
6.根据权利要求5所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤五中设计滑模控制律,保证姿态角速度误差系统状态能从任意初始位置到达滑模面;具体过称为:
采用趋近律
式中,ε、α、k为给定的已知正常数;
则姿态角速度误差系统状态到达滑模面的时间为
设计滑模控制律为
该控制律能够保证姿态角速度误差系统状态在有限时间内到达滑模面,并在滑模面上渐进稳定在平衡点,保证lime=0,即limω=0。
7.根据权利要求6所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤六中利用线性矩阵不等式方法求解积分滑模面所涉及的未知矩阵,根据所设计的姿态角速度参考轨迹和姿态角加速度参考轨迹最终都为零,将步骤五所设计的滑模控制律代入刚体航天器双输入混沌姿态动力学非线性方程,可使航天器角速度最终达到平衡状态;具体过称为:
通过选取合适的对称正定矩阵P,若
P(B-FCB-FK)+(B-FCB-FK)TP<0
则满足Hurwitz稳定条件,并能够保证lime=0,即limω=0;
通过求解线性矩阵不等式的可行解,得到滑模控制律中的未知矩阵C和未知矩阵K。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610494493.8A CN105912012B (zh) | 2016-06-29 | 2016-06-29 | 一种部分执行机构故障下航天器混沌姿态控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201610494493.8A CN105912012B (zh) | 2016-06-29 | 2016-06-29 | 一种部分执行机构故障下航天器混沌姿态控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105912012A true CN105912012A (zh) | 2016-08-31 |
CN105912012B CN105912012B (zh) | 2018-09-11 |
Family
ID=56758893
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201610494493.8A Active CN105912012B (zh) | 2016-06-29 | 2016-06-29 | 一种部分执行机构故障下航天器混沌姿态控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105912012B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106774373A (zh) * | 2017-01-12 | 2017-05-31 | 哈尔滨工业大学 | 一种四旋翼无人机有限时间姿态跟踪控制方法 |
CN113859588A (zh) * | 2021-09-30 | 2021-12-31 | 西北工业大学 | 一种航天器姿态/故障/干扰协同观测与容错抗干扰控制方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105353615A (zh) * | 2015-11-10 | 2016-02-24 | 南京航空航天大学 | 一种基于滑模观测器的四旋翼飞行器的主动容错控制方法 |
CN105404304A (zh) * | 2015-08-21 | 2016-03-16 | 北京理工大学 | 基于归一化神经网络的航天器容错姿态协同跟踪控制方法 |
-
2016
- 2016-06-29 CN CN201610494493.8A patent/CN105912012B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105404304A (zh) * | 2015-08-21 | 2016-03-16 | 北京理工大学 | 基于归一化神经网络的航天器容错姿态协同跟踪控制方法 |
CN105353615A (zh) * | 2015-11-10 | 2016-02-24 | 南京航空航天大学 | 一种基于滑模观测器的四旋翼飞行器的主动容错控制方法 |
Non-Patent Citations (2)
Title |
---|
KOK YEW NG.ETC: "New result in robust actuator fault reconstruction with application to an aircraft", 《2007 IEEE INTERNATIONAL CONFERENCE ON CONTROL APPLICATIONS》 * |
闫鑫: "基于滑模的航天器执行机构故障诊断与容错控制研究", 《中国博士学位论文全文数据库》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106774373A (zh) * | 2017-01-12 | 2017-05-31 | 哈尔滨工业大学 | 一种四旋翼无人机有限时间姿态跟踪控制方法 |
CN113859588A (zh) * | 2021-09-30 | 2021-12-31 | 西北工业大学 | 一种航天器姿态/故障/干扰协同观测与容错抗干扰控制方法 |
CN113859588B (zh) * | 2021-09-30 | 2023-07-25 | 西北工业大学 | 一种航天器协同观测与容错抗干扰控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN105912012B (zh) | 2018-09-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106527137B (zh) | 基于观测器的四旋翼无人机容错控制方法 | |
CN108287476B (zh) | 基于高阶滑模控制和扰动观测器的空间翻滚非合作目标自主交会制导方法 | |
CN108803649B (zh) | 一种垂直起降重复使用运载器自抗扰滑模控制方法 | |
CN105867401B (zh) | 单框架控制力矩陀螺群的航天器姿态容错控制方法 | |
CN111099045B (zh) | 双超卫星动力学与控制气浮平台全物理仿真方法 | |
CN105911866A (zh) | 四旋翼无人飞行器的有限时间全阶滑模控制方法 | |
CN106873611A (zh) | 一种多通道线性自抗扰控制器的设计方法 | |
CN106985139A (zh) | 基于扩展状态观测与补偿的空间机器人自抗扰协调控制方法 | |
CN106969783A (zh) | 一种基于光纤陀螺惯性导航的单轴旋转快速标定技术 | |
CN105629732A (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
CN107861386B (zh) | 一种基于角速度观测器的抗干扰姿态控制地面验证系统及其控制方法 | |
CN107270933A (zh) | 一种基于多星协同的空间碎片运动状态联合确定方法 | |
CN114779799B (zh) | 基于扩张干扰观测器的柔性航天器姿轨跟踪控制方法 | |
Jones et al. | Stability and control of a flux-pinned docking interface for spacecraft | |
CN105912012A (zh) | 一种部分执行机构故障下航天器混沌姿态控制方法 | |
Zhang et al. | Design and analysis of a moment control unit for agile satellite with high attitude stability requirement | |
Tan et al. | Fused attitude estimation algorithm based on explicit complementary filter and kalman filter for an indoor quadrotor uav | |
CN107942672B (zh) | 一种基于对称时不变障碍李雅普诺夫函数的四旋翼飞行器输出受限反步控制方法 | |
Guo et al. | Integrated vibration isolation and attitude control for spacecraft with uncertain or unknown payload inertia parameters | |
Wang et al. | Hardware in the loop based 6DoF test platform for multi-rotor UAV | |
CN106649947B (zh) | 基于李群谱算法的卫星姿态数值仿真方法 | |
CN112684697A (zh) | 分体式卫星在轨两舱转动惯量辨识方法及系统 | |
Campa et al. | NLDI guidance control laws for close formation flight | |
CN103885451B (zh) | 一种新型抗干扰姿态控制电路解算系统 | |
CN108871312A (zh) | 一种重力梯度仪及星敏感器的联合定姿方法 |
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 |