CN105912012B - 一种部分执行机构故障下航天器混沌姿态控制方法 - Google Patents

一种部分执行机构故障下航天器混沌姿态控制方法 Download PDF

Info

Publication number
CN105912012B
CN105912012B CN201610494493.8A CN201610494493A CN105912012B CN 105912012 B CN105912012 B CN 105912012B CN 201610494493 A CN201610494493 A CN 201610494493A CN 105912012 B CN105912012 B CN 105912012B
Authority
CN
China
Prior art keywords
spacecraft
attitude
chaos
component
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.)
Active
Application number
CN201610494493.8A
Other languages
English (en)
Other versions
CN105912012A (zh
Inventor
孙兆伟
刘闯
石珂珂
王雪峰
叶东
张剑桥
邢雷
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Harbin Institute of Technology
Original Assignee
Harbin Institute of Technology
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Harbin Institute of Technology filed Critical Harbin Institute of Technology
Priority to CN201610494493.8A priority Critical patent/CN105912012B/zh
Publication of CN105912012A publication Critical patent/CN105912012A/zh
Application granted granted Critical
Publication of CN105912012B publication Critical patent/CN105912012B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
    • G05D1/08Control of attitude, i.e. control of roll, pitch, or yaw
    • G05D1/0808Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
    • G05D1/0816Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability
    • G05D1/0825Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft to ensure stability using mathematical models

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ωdr1dr2dr3]表示航天器的角加速度在本体坐标系的三个分量,°/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 (4)

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的控制输入矩阵;
则刚体航天器三控制输入混沌姿态动力学非线性方程化为
所述步骤二中针对部分执行机构故障情况下刚体航天器混沌姿态动力学方程,将刚体航天器三控制输入混沌姿态动力学非线性方程转化成刚体航天器双输入混沌姿态动力学非线性方程形式;具体过称为:
部分执行机构故障失效,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,则姿态角加速度误差的变化率为
2.根据权利要求1所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤四中针对姿态角速度误差e,设计积分滑模面,保证姿态角速度误差系统状态能在滑模面上滑动到平衡状态;
设计积分滑模面
其中,
C为未知矩阵,c1为C的第一列第一个分量,c2为C的第一列第二个分量,K为积分系数矩阵,为未知矩阵;
得到滑模控制律的等效项ueq
从而得
故上式可以化成
又limωd=0,若要保证lime=0,必须满足矩阵B-FCB-FK是Hurwitz稳定的,Hurwitz为赫尔维茨判据。
3.根据权利要求2所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤五中设计滑模控制律,保证姿态角速度误差系统状态能从任意初始位置到达滑模面;具体过称为:
采用趋近律
式中,ε、α、k为给定的已知正常数;
则姿态角速度误差系统状态到达滑模面的时间为
设计滑模控制律为
该控制律能够保证姿态角速度误差系统状态在有限时间内到达滑模面,并在滑模面上渐进稳定在平衡点,保证lime=0,即limω=0。
4.根据权利要求3所述一种部分执行机构故障下航天器混沌姿态控制方法,其特征在于:所述步骤六中利用线性矩阵不等式方法求解积分滑模面所涉及的未知矩阵,根据所设计的姿态角速度参考轨迹和姿态角加速度参考轨迹最终都为零,将步骤五所设计的滑模控制律代入刚体航天器双输入混沌姿态动力学非线性方程,可使航天器角速度最终达到平衡状态;具体过称为:
通过选取合适的对称正定矩阵P,若
P(B-FCB-FK)+(B-FCB-FK)TP<0
则满足Hurwitz稳定条件,并能够保证lime=0,即limω=0;
通过求解线性矩阵不等式的可行解,得到滑模控制律中的未知矩阵C和未知矩阵K。
CN201610494493.8A 2016-06-29 2016-06-29 一种部分执行机构故障下航天器混沌姿态控制方法 Active CN105912012B (zh)

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 CN105912012A (zh) 2016-08-31
CN105912012B true 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)

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN106774373B (zh) * 2017-01-12 2019-11-05 哈尔滨工业大学 一种四旋翼无人机有限时间姿态跟踪控制方法
CN113859588B (zh) * 2021-09-30 2023-07-25 西北工业大学 一种航天器协同观测与容错抗干扰控制方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105353615A (zh) * 2015-11-10 2016-02-24 南京航空航天大学 一种基于滑模观测器的四旋翼飞行器的主动容错控制方法
CN105404304A (zh) * 2015-08-21 2016-03-16 北京理工大学 基于归一化神经网络的航天器容错姿态协同跟踪控制方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
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)

* Cited by examiner, † Cited by third party
Title
New result in robust actuator fault reconstruction with application to an aircraft;Kok Yew Ng.etc;《2007 IEEE International Conference on Control Applications》;20071127;第801-806页 *
基于滑模的航天器执行机构故障诊断与容错控制研究;闫鑫;《中国博士学位论文全文数据库》;20130115;第4页、第97-107页 *

Also Published As

Publication number Publication date
CN105912012A (zh) 2016-08-31

Similar Documents

Publication Publication Date Title
CN106527137B (zh) 基于观测器的四旋翼无人机容错控制方法
WO2022105408A1 (zh) 基于径向基神经网络的自动驾驶仪及其解耦控制方法
CN105629732A (zh) 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法
CN109062043A (zh) 考虑网络传输以及执行器饱和的航天器自抗扰控制方法
CN105912012B (zh) 一种部分执行机构故障下航天器混沌姿态控制方法
CN107457783A (zh) 基于pd控制器的六自由度机械臂自适应智能检测方法
CN107065544A (zh) 基于攻角幂函数的高超飞行器神经网络控制方法
CN105652667A (zh) 一种模型不确定双关节机械手的高精度轨迹跟踪控制方法
Li et al. Simulation method for wind tunnel based virtual flight testing
CN106649947B (zh) 基于李群谱算法的卫星姿态数值仿真方法
Zhao et al. μ-Synthesis robust controller design for the supercavitating vehicle based on the BTT strategy
Liu et al. Mass and mass center identification of target satellite after rendezvous and docking
CN108326857A (zh) 基于鲁棒自适应控制算法的书法及雕刻机器人控制方法
CN107831774A (zh) 基于自适应pi控制的刚体卫星姿态系统被动容错控制方法
Lee et al. Performance comparison of three different types of attitude control systems of the quad-rotor UAV to perform flip maneuver
Xing et al. Design and implementation of UAV flight simulation based on Matlab/Simulink
طائی et al. Optimal Control of a Tri-axial Spacecraft Simulator Test bed Actuated by Reaction Wheels
CN108534775A (zh) 基于捷联式惯性导航系统的空间轨迹重建方法及装置
CN104571097B (zh) 一种卫星控制系统在轨闭环验证系统
Koruba Dynamics and control of a gyroscope-stabilized platform in a ship anti-aircraft rocket missile launcher
Qi et al. Trajectory tracking strategy of quadrotor with output delay
Kizir et al. Fuzzy control of a real time inverted pendulum system
CN106628258B (zh) 一种基于太阳矢量信息的卫星自旋姿态确定方法
Khebbache et al. Robust stabilization of a quadrotor aerial vehicle in presence of sensor failures
RU83999U1 (ru) Нелинейная система автоматического управления самолетом

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