[发明专利]一种挠性航天器特征轴姿态机动指数时变滑模控制方法有效
申请号: | 201310377437.2 | 申请日: | 2013-08-27 |
公开(公告)号: | CN103412491A | 公开(公告)日: | 2013-11-27 |
发明(设计)人: | 刘向东;苗双全;陈振;丛炳龙 | 申请(专利权)人: | 北京理工大学 |
主分类号: | G05B13/04 | 分类号: | G05B13/04 |
代理公司: | 暂无信息 | 代理人: | 暂无信息 |
地址: | 100081 *** | 国省代码: | 北京;11 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | 本发明涉及一种挠性航天器特征轴姿态机动指数时变滑模控制方法,属于航天器控制技术领域。首先在航天器本体系下建立系统等效动力学模型、运动学模型和挠性振动模型,然后计算带有指数时变滑模控制律的闭环系统振动频率和阻尼比参数,根据单轴输入成型器设计方法,设计以特征轴为旋转轴的单轴多模态滤波输入成型器,抑制三轴运动中的挠性振动。同时,设计状态观测器实时估计挠性模态信息,构成输出反馈指数时变滑模控制方法。最后进行控制力矩的饱和性分析,以满足控制力矩的物理饱和约束。本发明扩大了现有输入成型的应用范围,将输入成型技术由单轴机动扩展到了三轴机动过程当中,增强了滤波输入成型自身鲁棒性,实现了航天器的姿态机动路径最短。 | ||
搜索关键词: | 一种 航天器 特征 姿态 机动 指数 时变滑模 控制 方法 | ||
【主权项】:
1.一种挠性航天器特征轴姿态机动指数时变滑模控制方法,其特征在于:具体包括以下步骤:步骤1,在航天器姿态运动的构型空间内定义相对姿态变量和挠性振动变量,在航天器本体系下建立系统等效动力学模型、运动学模型和挠性振动模型;具体方法为:挠性航天器动力学方程为:J ω · + ω × Jω + C η · · = T c + T d ]]> (1)振动方程为:η · · + 2 ζΛ η · + Λ 2 η + C T ω · = 0 ]]> (2)式中
为系统实际的正定对称转动惯量矩阵,
为系统名义惯量阵,ΔJ为由系统质量变化引起的惯量阵误差;ω=[ω1 ω2 ω3]T为在本体系下的刚体角速度表示;Tc=[Tc1 Tc2 Tc3]T和Td=[Td1 Td2 Td3]T分别表示控制力矩和外界干扰力矩;η为挠性结构弹性形变的广义坐标,ζ和Λ分别为挠性附件的模态阻尼矩阵和模态频率矩阵,C为挠性附件与星体的刚柔耦合矩阵;姿态误差σe和角速度误差ωe为:σ e = σ ⊗ σ d - 1 = ( σ T σ - 1 ) σ d + ( 1 - σ d T σ d ) σ + 2 σ d × σ 1 + ( σ T σ ) ( σ d T σ d ) + 2 ( σ T σ d ) ]]> (3)ω e = ω - ω d b ]]> (4)式中σ为挠性航天器当前姿态角,σd为期望姿态角,
为航天器在本体系下的期望角速度,ωd为航天器在惯性系下的期望角速度,R bd ( σ ) = I 3 - 4 1 - σ T σ ( 1 + σ T σ ) 2 σ × + 8 ( 1 + σ T σ ) 2 σ × σ × ]]> 为从惯性系到本体系的转移矩阵;姿态运动学方程在本体系下表示为σ · = M ( σ ) ω ]]> (5)式中M ( σ ) = 1 4 [ ( 1 - σ T σ ) I 3 + 2 σ × + 2 σ σ T ] , ]]> 满足条件MTM=maI3×3,其中m a = 1 16 ( 1 + σ T σ ) , ]]> I3×3为3×3的单位矩阵;设φ=[ηT ψT]T为状态变量,其中
令D=2ζΛ,K=Λ2;整理得到等效的数学模型:J ^ m ω · e = T c + CEφ - CD C T ω e - J ^ m ω · d b - ω × J ^ ω + d φ · = A φ - ABC T ω e - BC T ω · d b σ · e = M ω e ]]> (6)式中A = 0 I - K - D , ]]>B = 0 I , ]]> E=[K D],J ^ m = J ^ - CC T , ]]>d = T d - ω × ΔJω - ΔJ ω · d b - ΔJ ω · e ]]> 表示由惯量阵不确定性和外界干扰引起的聚合扰动,I表示单位阵,d约束于未知上界dmax;步骤2,针对步骤1建立的等效数学模型,设计状态反馈指数时变滑模控制律,具体方法为:设计滑模面函数为S ( ω e , σ e , t ) = ω e + l M T m a σ e + M T m a Qe - at - - - ( 7 ) ]]> 式中l和a为正的标量;设计状态反馈指数时变滑模控制律如下T c = - CEφ + CDC T ω e + ω × J ^ ω + J ^ m ω · d b - l J ^ m d dt ( M T m σ e ) - J ^ m d dt ( M T m Qe - at ) - γsgn ( S ) - - - ( 8 ) ]]> γ>0,为滑模的切换增益;步骤3,将系统三轴运动转变为绕特征轴旋转的单轴运动,计算出带有步骤2中指数时变滑模控制律的闭环系统振动频率和阻尼比参数,设计多模态滤波输入成型器;多模态滤波输入成型器的具体设计方法为:设状态变量为X=[σT ωT ηT ψT]T,对闭环系统建立状态空间方程,求出系数矩阵的特征值λsys,再通过下式求出闭环系统的振动频率和阻尼比信息:λ sys = - ζ sys , i ω sys , i ± jω sys , i 1 - ζ sys , i 2 , i = 1,2 , · · · , n - - - ( 9 ) ]]> 式中ζsys,i和ωsys,i分别为第i阶振动阻尼和频率;ZVD输入成型器形式为A 1 = 1 1 + 2 K + K 2 ]]>A 2 = 2 K 1 + 2 K + K 2 ]]>A 3 = K 2 1 + 2 K + K 2 ]]> T1=0T 2 = π ω sys , i 1 - ζ sys , i 2 ]]>T 3 = 2 π ω sys , i 1 - ζ sys , i 2 ]]> (10)式中
A1,A2,A3和T1,T2,T3分别为脉冲的幅值和时间;输入成形器的脉冲序列通过各个单模态的脉冲序列相卷积得到,公式如下:Amult=Am1*Am2*…*Amn式中Ami代表第i阶模态的脉冲序列,*代表卷积运算;将设计好的输入成型器与一个一阶惯性环节相连接,构成滤波输入成型器;步骤4,设计挠性状态观测器如下φ ^ · = A φ ^ - AB C T ω e - BC T ω · d b + P - 1 ( S T CE ) T ]]> (12)其中
为航天器挠性振动变量φ的估计值,P为观测器正定对称增益矩阵,且PA<0;则输出反馈指数时变滑模控制律如下T c ′ = - CE φ ^ + CDC T ω e + ω × J ^ ω + J ^ m ω · d b - l J ^ m d dt ( M T m a σ e ) - J ^ m d dt ( M T m a Qe - at ) - γsgn ( S ) ]]> (13)将输出反馈指数时变滑模控制律输入航天器模型,航天器模型在控制律控制下得到σ,再将σ分别输入挠性状态观测器和控制器,形成闭环系统。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于北京理工大学,未经北京理工大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201310377437.2/,转载请声明来源钻瓜专利网。
- 上一篇:Chukrasone B在治疗前列腺癌药物中的应用
- 下一篇:医疗用泵