CN103076807A - 一种欠驱动柔性航天器姿态稳定的控制方法 - Google Patents

一种欠驱动柔性航天器姿态稳定的控制方法 Download PDF

Info

Publication number
CN103076807A
CN103076807A CN2012105803962A CN201210580396A CN103076807A CN 103076807 A CN103076807 A CN 103076807A CN 2012105803962 A CN2012105803962 A CN 2012105803962A CN 201210580396 A CN201210580396 A CN 201210580396A CN 103076807 A CN103076807 A CN 103076807A
Authority
CN
China
Prior art keywords
centerdot
omega
eta
delta
lambda
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
Application number
CN2012105803962A
Other languages
English (en)
Other versions
CN103076807B (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.)
Beihang University
Original Assignee
Beihang University
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 Beihang University filed Critical Beihang University
Priority to CN201210580396.2A priority Critical patent/CN103076807B/zh
Publication of CN103076807A publication Critical patent/CN103076807A/zh
Application granted granted Critical
Publication of CN103076807B publication Critical patent/CN103076807B/zh
Expired - Fee Related legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明一种欠驱动柔性航天器姿态稳定的控制方法,考虑柔性附件相对于航天器本体无转动的情形。首先建立欠驱动柔性航天器的动力学模型,并用(w,z)参数描述了其姿态运动。然后在欠驱动轴角速度和模态坐标不为零的情况下,由于欠驱动轴没有控制力矩驱动,但驱动轴角速度会对欠驱动轴角速度产生耦合影响,因此设计中间控制律ωc1c2使得欠驱动轴稳定。其次把ω12当作虚拟控制输入,设计出稳定运动学参数的虚拟控制律ωd1d2。最后利用退步控制方法设计出稳定驱动轴角速度和振动模态的控制输入。该方法既为柔性航天器的在轨运行提供一种故障预案,提高系统的可靠性,又能为小型柔性航天器应用两个推力器进行姿态控制的系统提供一种解决方案。

Description

一种欠驱动柔性航天器姿态稳定的控制方法
【技术领域】
本发明涉及一种欠驱动柔性航天器姿态稳定的控制方法,一种在只有两轴控制力矩输出的情况下,实现带柔性附件航天器的三轴姿态稳定的控制方法,属于欠驱动柔性航天器姿态稳定控制的应用技术领域。
【背景技术】
航天器在轨运行时,各种各样的故障是影响航天器工作寿命的主要因素,其中执行机构故障尤为常见。由执行机构故障引起的独立控制输入个数少于自由度个数的航天器称为欠驱动航天器。对于欠驱动系统的研究,为完整驱动系统提供一个应急控制手段,即如果完整驱动系统遭遇故障不能正常运行时,可采用欠驱动系统的控制策略,利用剩下的仍能正常工作的控制力矩对系统进行有效控制,以降低由于某些控制输入发生故障导致整体系统瘫痪而带来的损失。另外,小型航天器由于体积、质量和经济成本的限制,往往不可能像大型航天器一样为提高可靠性而配置冗余的执行机构,此时,在保证姿态控制任务顺利实现的前提下最小化执行机构显得特别有价值。因此,研究欠驱动航天器的姿态控制不仅为大型航天器的姿态控制系统提供一种故障预案,而且对小卫星和深空探测器等对质量、体积和经济成本有特别限制的航天器更具有特殊意义。
随着航天技术的发展,目前航天器往往带有大型柔性帆板或其它柔性附件。在这种航天器的飞行和控制过程中,作用在航天器上的控制力矩不仅会引起航天器姿态的改变,而且可能会激起柔性附件的弹性振动,这些附件的振动进而又会影响航天器的运动和控制。当这类航天器的执行机构出现故障导致控制输入个数少于航天器自由度个数时,称为欠驱动柔性航天器。由于在轨运行中的航天器大都带有柔性附件,因此相比于欠驱动刚体航天器,研究欠驱动柔性航天器的姿态控制问题更符合工程实际需求,并且对控制方法的设计也提出了更高的要求。
针对这类应用需求,本发明提出一种仅利用两个推力器的带柔性附件航天器的三轴姿态控制方法,既为柔性航天器的在轨运行控制提供一种故障预案,提高系统的可靠性,又能为小型柔性航天器应用两个推力器进行姿态控制的系统提供一种解决方案。
【发明内容】
本发明的目的是:针对带柔性附件的航天器,在基于两个推力器为有效控制力矩的情况下,提供了一种欠驱动柔性航天器姿态稳定的控制方法。本发明既可用于推力器执行机构中的部分推力器失效后的两轴控制力矩的欠驱动柔性航天器姿态控制,又适用于仅安装有两个推力器的微小型卫星的姿态控制。
本发明首先建立柔性航天器的动力学模型,并用(w,z)参数描述了其姿态运动。然后在欠驱动轴角速度和模态坐标不为零的情况下,由于欠驱动轴没有控制力矩驱动,但驱动轴角速度会对欠驱动轴角速度产生耦合影响,因此设计稳定动力学方程的中间控制律ωc1c2,使得欠驱动轴稳定。其次把ω12当作虚拟控制输入,设计出稳定运动学参数的虚拟控制律ωd1d2。最后利用退步控制方法设计出稳定驱动轴角速度和振动模态的控制输入。
本发明用到的坐标系定义如下:
惯性标系oxiyizi(si):为地心赤道惯性坐标系,oxi由地球球心指向春分点方向;ozi沿垂直于地球赤道平面并指向北极的方向;oyi由右手定则确定。
航天器本体坐标系obxbybzb(sb):航天器本体坐标系三轴分别取为沿其惯性主轴方向,其中obxb指向飞行前方;obzb是航天器竖轴指向下,即朝向中心天体(地球)球心的方向;obyb由右手定则确定。
柔性附件体坐标系ofxfyfzf(sf):原点位于柔性附件与航天器本体的连接点处,ofxf、ofzf、ofyf与柔性附件固连,且构成右手定则。
本发明考虑柔性附件相对于航天器本体无转动的情形,所述本体坐标系的定义为obxbybzb(sb)。一种欠驱动柔性航天器姿态稳定的控制方法,基于推力器实现,步骤如下:
步骤一,建立系统模型。
假设柔性航天器的挠性变形很小,对变量做一阶线性化处理,运用动量矩定理建立柔性航天器的旋转运动模型;运用变分原理建立柔性附件的振动运动模型;考虑柔性附件相对于航天器本体无转动的情形,假设obzb轴的推力器发生了故障,建立欠驱动柔性航天器的动力学模型为:
J 1 ω · 1 - ( J 2 - J 3 ) ω 2 ω 3 + P 1 T η · · 1 = T 1
J 2 ω · 2 - ( J 3 - J 1 ) ω 3 ω 1 + P 2 T η · · 2 = T 2
J 3 ω · 3 - ( J 1 - J 2 ) ω 1 ω 2 + P 3 T η · · 3 = 0
η · · 1 + 2 ξ 1 Λ 1 η · 1 + Λ 1 2 η 1 + P 1 ω · 1 = 0
η · · 2 + 2 ξ 2 Λ 2 η · 2 + Λ 2 2 η 2 + P 2 ω · 2 = 0
η · · 3 + 2 ξ 3 Λ 3 η · 3 + Λ 3 2 η 3 + P 3 ω · 3 = 0
其中ω1∈R1×12∈R1×13∈R1×1表示航天器本体系sb各轴相对于惯性系si的角速度在本体系sb下的表述,
Figure BDA00002664448400033
分别表示对ω123进行一次时间求导,
Figure BDA00002664448400034
分别表示对η123进行二次时间求导,
Figure BDA00002664448400035
Figure BDA00002664448400036
Figure BDA00002664448400037
(l1+l1+l1=n)分别对应本体系sb三轴的柔性模态坐标,
Figure BDA00002664448400038
Figure BDA00002664448400039
分别对应本体系sb三轴的柔性附件对航天器本体的柔性耦合系数矩阵,
Figure BDA000026644484000311
Figure BDA000026644484000312
Figure BDA000026644484000313
分别对应本体系sb三轴的柔性附件模态频率矩阵,
Figure BDA000026644484000314
Figure BDA000026644484000315
Figure BDA000026644484000316
分别对应本体系sb三轴的柔性附件模态阻尼矩阵,J1,J2,J3分别表示航天器本体系obxb,obyb,obzb轴的转动惯量分量,T1,T2分别表示航天器本体系上的两个控制力矩分量。
采用(w,z)参数来描述航天器相对于惯性坐标系的姿态,其对应的姿态运动学方程为:
w · 1 = ω 3 w 2 + ( 1 + w 1 2 - w 2 2 ) ω 1 / 2 + w 1 w 2 ω 2 w · 2 = - ω 3 w 1 + ( 1 - w 1 2 + w 2 2 ) ω 2 / 2 + w 1 w 2 ω 1 z · = ω 3 + w 1 ω 2 - w 2 ω 1
其中,表示对w1,w2,z进行一次时间求导。
由欠驱动柔性航天器的动力学方程可知,obxb轴,obyb轴角速度各受控制力矩T1,T2驱动,而obzb轴角速度没有控制力矩驱动,但obxb轴,obyb轴角速度会对obzb轴角速度有耦合影响;另外,由姿态运动学方程可知,参量z与无力矩轴相对应,参量w与有力矩轴相对应,物理意义明显,参量z对参量w没有耦合效应,而参量w对参量z有耦合效应,这为欠驱动轴的设计提供了方便,因此该姿态描述参数在欠驱动的应用中比较广泛。
步骤二,针对动力学方程的obzb轴设计控制律。
如果初始条件ω3≠0,η3≠0,则针对obzb轴的动力学方程为:
J 3 ω · 3 - ( J 1 - J 2 ) ω c 1 ω c 2 + P 3 T η · · 3 = 0 η · · 3 + 2 ξ 3 Λ 3 η · 3 + Λ 3 2 η 3 + P 3 ω · 3 = 0
构造准李雅普诺夫函数:
V 1 = 1 2 ( J 3 ω 3 2 + 2 ω 3 P 3 T η · 3 + η · 3 T η · 3 + η 3 T Λ 3 2 η 3 )
其中,V1表示obzb轴的动力学方程的准李雅普诺夫函数。
对上式中的
Figure BDA00002664448400041
进行矩阵变换,则得:
J 3 ω 3 2 + 2 ω 3 P 3 T η · 3 + η · 3 T η · 3
= ( J 3 ω 3 + J 3 - 1 P 3 T η · 3 ) T ( J 3 ω 3 + J 3 - 1 P 3 T η · 3 ) + η · 3 T ( E 3 - P 3 J 3 - 1 P 3 T ) η · 3
其中
Figure BDA00002664448400044
是单位矩阵。因此,若
Figure BDA00002664448400045
成立,则函数V1相对于ω3
Figure BDA00002664448400046
η3是正定函数。
对V1求导,则得:
Figure BDA00002664448400047
为了使
Figure BDA00002664448400048
负定,设计中间控制律:
ω c 1 = - sgn ( J 1 - J 2 ) sgn ( ω 3 ) | ω 3 | ω c 2 = k | ω 3 |
其中,k表示控制常数,sgn(·)表示·的符号函数,ωc1c2表示obxb轴,obyb轴的中间控制律。
将上式中间控制律代入
Figure BDA000026644484000410
则得
V · 1 = - k | J 1 - J 2 | ω 3 2 - 2 ξ 3 η · 3 T Λ 3 2 η · 3
推出进一步求导,则得代入obzb轴的动力学方程可知η3=0。根据李雅普诺夫稳定性定理可知:当采用控制律ωc1c2作为理想角速度输入时,obzb轴动力学系统是渐近稳定的。即当t →∞时,ω3→0,
Figure BDA000026644484000415
η3→0。
步骤三,针对运动学方程设计控制律。
当ω3=0,η3=0时,则针对运动学方程设计准李雅普诺夫函数
V 2 = w 1 2 + w 2 2 + 1 2 z 2 > 0
其中,V2表示运动学方程的准李雅普诺夫函数。
对上式求导,为使
Figure BDA000026644484000417
负定,设计虚拟控制律:
ω d 1 = - k 1 w 1 1 + w 1 2 + w 2 2 + μ z + ω 3 / μ w 1 2 + w 2 2 w 2 ω d 2 = - k 1 w 2 1 + w 1 2 + w 2 2 - μ z + ω 3 / μ w 1 2 + w 2 2 w 1
其中,k1,μ表示控制常数,k1>0,μ>0.5k1。ωd1d2表示obxb轴,obyb轴的虚拟控制律。
将上式代入
Figure BDA000026644484000419
则得:
V &CenterDot; 2 = - k 1 w 1 2 - k 1 w 2 2 - &mu; z 2 < 0
根据李雅普诺夫稳定性定理可知:当采用控制律ωd1d2作为理想角速度输入时,运动学系统是渐近稳定的。即当t →∞时,w1→0,w2→0,z →0。
步骤四,针对动力学方程的obxb轴和obyb轴设计控制律。
考虑obxb轴和obyb轴的动力学方程设计控制律。在步骤三给出的虚拟控制角速度ωd1d2下,系统柔性振动模态坐标ηd1d2应满足:
&eta; &CenterDot; &CenterDot; d 1 + 2 &xi; 1 &Lambda; 1 &eta; &CenterDot; d 1 + &Lambda; 1 2 &eta; d 1 + P 1 &omega; &CenterDot; d 1 = 0
&eta; &CenterDot; &CenterDot; d 2 + 2 &xi; 2 &Lambda; 2 &eta; &CenterDot; d 2 + &Lambda; 2 2 &eta; d 2 + P 2 &omega; &CenterDot; d 2 = 0
其中,
Figure BDA00002664448400053
表示对ηd1d2进行一次时间求导。
Figure BDA00002664448400054
表示对ηd1d2进行二次时间求导。
引入误差Δω11d1,Δω22d2,Δη11d1,Δη22d2,则obxb轴和obyb轴的动力学方程进一步转化为误差的形式如下所示:
J 1 &Delta; &omega; &CenterDot; 1 = T 1 + ( J 2 - J 3 ) &omega; 2 &omega; 3 - J 1 &omega; &CenterDot; d 1 - P 1 T ( &Delta; &eta; &CenterDot; &CenterDot; 1 + &eta; &CenterDot; &CenterDot; d 1 )
J 2 &Delta; &omega; &CenterDot; 2 = T 2 + ( J 3 - J 1 ) &omega; 1 &omega; 3 - J 2 &omega; &CenterDot; d 2 - P 2 T ( &Delta; &eta; &CenterDot; &CenterDot; 2 + &eta; &CenterDot; &CenterDot; d 2 )
&Delta; &eta; &CenterDot; &CenterDot; 1 + 2 &xi; 1 &Lambda; 1 &Delta; &eta; &CenterDot; 1 + &Lambda; 1 2 &Delta; &eta; 1 + P 1 &Delta; &omega; &CenterDot; 1 = 0
&Delta; &eta; &CenterDot; &CenterDot; 2 + 2 &xi; 2 &Lambda; 2 &Delta; &eta; &CenterDot; 2 + &Lambda; 2 2 &Delta; &eta; 2 + P 2 &Delta; &omega; &CenterDot; 2 = 0
针对上述误差动力学模型,构造准李雅普诺夫函数:
V = 1 2 ( J 1 &Delta; &omega; 1 2 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; 1 T &Lambda; 1 2 &Delta; &eta; 1 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1
+ J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &eta; 2 T &Lambda; 2 2 &Delta; &eta; 2 + 2 &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2 )
其中,V表示obxb轴和obyb轴的动力学方程的准李雅普诺夫函数。
对上式中的 J 1 &Delta; &omega; 1 2 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1 J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2 进行矩阵变换,则得:
J 1 &Delta; &omega; 1 2 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1
= ( J 1 &Delta; &omega; 1 + J 1 - 1 P 1 T &Delta; &eta; &CenterDot; 1 ) T ( J 1 &Delta; &omega; 1 + J 1 - 1 P 1 T &Delta; &eta; &CenterDot; 1 ) + &Delta; &eta; &CenterDot; 1 T ( E 1 - P 1 J 1 - 1 P 1 T ) &Delta; &eta; &CenterDot; 1
J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2
= ( J 2 &Delta; &omega; 2 + J 2 - 1 P 2 T &Delta; &eta; &CenterDot; 2 ) T ( J 2 &Delta; &omega; 2 + J 2 - 1 P 2 T &Delta; &eta; &CenterDot; 2 ) + &Delta; &eta; &CenterDot; 2 T ( E 2 - P 2 J 2 - 1 P 2 T ) &Delta; &eta; &CenterDot; 2
其中
Figure BDA000026644484000517
Figure BDA000026644484000518
是单位矩阵。因此,若E
Figure BDA000026644484000523
成立,则函数V相对于ω1
Figure BDA000026644484000520
η12
Figure BDA000026644484000521
η2是正定函数。
对V求导,为了使
Figure BDA000026644484000522
负定,设计
T 1 = - &alpha;&Delta; &omega; 1 - ( J 2 - J 3 ) &omega; 2 &omega; 3 + J 1 &omega; &CenterDot; d 1 + P 1 T &eta; &CenterDot; &CenterDot; d 1 T 2 = - &alpha;&Delta; &omega; 2 - ( J 3 - J 1 ) &omega; 2 &omega; 3 + J 2 &omega; &CenterDot; d 2 + P 2 T &eta; &CenterDot; &CenterDot; d 2
其中,α表示控制常数。
代入
Figure BDA00002664448400062
则得
V &CenterDot; = - &alpha;&Delta; &omega; 1 2 - &alpha;&Delta; &omega; 2 2 - 2 &Delta; &eta; &CenterDot; 1 T &xi; 1 &Lambda; 1 &Delta; &eta; &CenterDot; 1 - 2 &Delta; &eta; &CenterDot; 2 T &xi; 2 &Lambda; 2 &Delta; &eta; &CenterDot; 2
推出Δω1=0,Δω2=0,
Figure BDA00002664448400065
Figure BDA00002664448400066
进一步求导,则得
Figure BDA00002664448400067
Figure BDA00002664448400068
代入误差动力学方程可知Δη1=0,Δη2=0。于是
Figure BDA000026644484000611
只包含系统的零解。根据LaSalle不变集定理可知,系统是渐近稳定的。即当t →∞时,Δω1→0,
Figure BDA000026644484000612
Δη1→0,Δω2→0,
Figure BDA000026644484000613
Δη2→0。
经过上述证明过程,得到控制律T1,T2
Figure BDA000026644484000614
的情况下,可使系统渐近稳定,即能够保证实际角速度ω12趋向于理想角速度ωd1d2
然而,在所有时间点上并不是都有ω1d12d2,因此在控制律T1,T2作用下的完整闭环系统的稳定性仍需严格证明。该证明用李雅普诺夫稳定性定理和LaSalle不变集定理证得,属于本领域专业人员的公知原理,详细的证明过程在此不再赘述。
其中,在步骤一中所述的建立柔性航天器的动力学模型,其建立的方法如下:用动量矩原理建立柔性航天器本体的旋转运动模型和运用变分原理建立柔性附件的振动模型,该部分内容属于该领域的公知理论。
本发明一种欠驱动柔性航天器姿态稳定的控制方法,其优点和有益效果是:
(1)本发明在航天器只具有两轴姿态控制力矩输出能力的条件下实现三轴姿态稳定控制,传统航天器在失去某一轴姿态控制能力时,姿态将失稳,不能进行三轴姿态稳定控制,从而也无法保证载荷工作的条件,而采用本发明的方法,可在此情况下实现三轴姿态稳定控制,从而挽救航天器,具有极高的经济价值;
(2)本发明由于可采用产生两轴力矩的推力器实现三轴姿态稳定控制,极大提高航天器的寿命。对于普通航天器,一般至少配置能产生三轴力矩的推力器,采用本发明的方法,在没有推力器失效的情况下,就关掉某轴推力器的方法,只采用两轴推力器进行三轴姿态稳定控制,在某一轴推力器失效的情况下,再启动此前没有进入控制回路的推力器,继续采用两轴推力器完成三轴姿态控制,可使系统寿命延长一倍,具有极大的经济价值;
(3)与现有技术中的欠驱动控制方法相比,传统的方法一般针对刚体航天器,没有考虑实际工程应用条件下的柔性附件因素。而由于航天器的运动和控制会与柔性附件的弹性振动相互影响,因此相比于欠驱动刚体航天器,欠驱动柔性航天器的姿态控制问题的研究更符合工程实际需求。本发明在基于两个推力器为有效控制力矩的情况下,为欠驱动柔性航天器提供了一种姿态稳定控制方法。
(4)本发明既可用于推力器执行机构中的部分推力器失效后的两轴控制力矩的欠驱动柔性航天器姿态控制,又适用于仅安装有两个推力器的微小型卫星的姿态控制。
【附图说明】
图1为惯性坐标系;
图2为航天器本体坐标系;
图3为柔性附件体坐标系、本体坐标系和惯性坐标系之间的示意关系图;
图4为两个推力器的航天器模型;
图5为本发明流程图;
【具体实施方式】
下面结合附图对本发明的具体实施方式做进一步的详细描述。
本发明用到的坐标系定义如下:
惯性标系oxiyizi(si):为地心赤道惯性坐标系,oxi由地球球心指向春分点方向;ozi沿垂直于地球赤道平面并指向北极的方向;oyi由右手定则确定,如图1所示。
航天器本体坐标系obxbybzb(sb):航天器本体坐标系三轴分别取为沿其惯性主轴方向,其中obxb指向飞行前方;obzb是航天器竖轴指向下,即朝向中心天体(地球)球心的方向;obyb由右手定则确定,如图2所示。
柔性附件体坐标系ofxfyfzf(sf):原点位于柔性附件与航天器本体的连接点处,ofxf、ofzf、ofyf与柔性附件固连,且构成右手定则。考虑柔性附件相对于航天器本体无转动的情形,惯性标系(si)、航天器本体坐标系(sb)和柔性附件体坐标系(sf)的关系如图3所示。
由于航天器的控制包括滚动、俯仰、偏航三轴,因此要实现在轨正常工作,至少需要配置能产生三个轴控制力矩的推力器,采用相应推力器即可对相应轴姿态进行控制,如图4所示。然而推力器具有可靠性问题,由于某些原因或长时间工作,可能失效,可能在某一轴失去控制力矩,例如图4中的提供控制力矩T3的推力器失效,此时,航天器三轴中只有两轴具有姿态控制力矩输出能力,理论上讲,此时航天器只具有两个控制输入,而要完成三轴控制,即是一个欠驱动控制问题。
如图5所示,本发明提出了一种欠驱动柔性航天器姿态稳定的控制方法,基于推力器实现,步骤如下:
步骤一,建立系统模型。
考虑柔性附件相对于航天器本体无转动的情形建立柔性航天器的动力学模型。假设柔性航天器的挠性变形很小,对变量做一阶线性化处理,运用动量矩定理建立柔性航天器的旋转运动模型如式(1a)所示;运用变分原理建立柔性附件的振动运动模型如式(1b)所示:
J &omega; &CenterDot; + &omega; &times; J&omega; + P T &eta; &CenterDot; &CenterDot; = T - - - ( 1 a )
&eta; &CenterDot; &CenterDot; + 2 &xi;&Lambda; &eta; &CenterDot; + &Lambda; 2 &eta; + P &omega; &CenterDot; = 0 - - - ( 1 b )
其中ω表示航天器本体系相对于惯性系的角速度在本体系下的表述,
Figure BDA00002664448400083
表示对ω进行一次时间求导,ω×表示叉乘运算的反对称矩阵,J表示航天器的转动惯量,η是航天器柔性模态坐标,PT是柔性附件对航天器本体的柔性耦合系数矩阵,Λ是柔性附件模态频率矩阵,ξ是柔性附件模态阻尼矩阵,T表示航天器的推力器产生的力矩。
不失一般性,假设obzb轴的推力器发生了故障(对obxb,obyb轴发生故障的情况,可作类似处理),式(1)的欠驱动柔性动力学方程写为式(2a)~式(2f)所示:
J 1 &omega; &CenterDot; 1 - ( J 2 - J 3 ) &omega; 2 &omega; 3 + P 1 T &eta; &CenterDot; &CenterDot; 1 = T 1 - - - ( 2 a )
J 2 &omega; &CenterDot; 2 - ( J 3 - J 1 ) &omega; 3 &omega; 1 + P 2 T &eta; &CenterDot; &CenterDot; 2 = T 2 - - - ( 2 b )
J 3 &omega; &CenterDot; 3 - ( J 1 - J 2 ) &omega; 1 &omega; 2 + P 3 T &eta; &CenterDot; &CenterDot; 3 = 0 - - - ( 2 c )
&eta; &CenterDot; &CenterDot; 1 + 2 &xi; 1 &Lambda; 1 &eta; &CenterDot; 1 + &Lambda; 1 2 &eta; 1 + P 1 &omega; &CenterDot; 1 = 0 - - - ( 2 d )
&eta; &CenterDot; &CenterDot; 2 + 2 &xi; 2 &Lambda; 2 &eta; &CenterDot; 2 + &Lambda; 2 2 &eta; 2 + P 2 &omega; &CenterDot; 2 = 0 - - - ( 2 e )
&eta; &CenterDot; &CenterDot; 3 + 2 &xi; 3 &Lambda; 3 &eta; &CenterDot; 3 + &Lambda; 3 2 &eta; 3 + P 3 &omega; &CenterDot; 3 = 0 - - - ( 2 f )
其中,ω1∈R1×12∈R1×13∈R1×1表示航天器本体系sb各轴相对于惯性系si的角速度在本体系sb下的表述,分别表示对ω123进行一次时间求导,分别表示对η123进行二次时间求导,
Figure BDA000026644484000812
Figure BDA000026644484000813
Figure BDA000026644484000814
(l1+l1+l1=n)分别对应本体系sb三轴的柔性模态坐标,
Figure BDA000026644484000815
Figure BDA000026644484000817
分别对应本体系sb三轴的柔性附件对航天器本体的柔性耦合系数矩阵,
Figure BDA000026644484000818
Figure BDA000026644484000819
Figure BDA000026644484000820
分别对应本体系sb三轴的柔性附件模态频率矩阵,
Figure BDA000026644484000822
Figure BDA000026644484000823
分别对应本体系sb三轴的柔性附件模态阻尼矩阵,J1,J2,J3分别表示航天器本体系obxb,obyb,obzb轴的转动惯量分量,T1,T2分别表示航天器本体系上的两个控制力矩分量。
根据Tsiotras的推导,采用(w,z)参数来描述航天器相对于惯性坐标系的姿态,其对应的姿态运动学方程如式(3)所示:
w &CenterDot; 1 = &omega; 3 w 2 + ( 1 + w 1 2 - w 2 2 ) &omega; 1 / 2 + w 1 w 2 &omega; 2 w &CenterDot; 2 = - &omega; 3 w 1 + ( 1 - w 1 2 + w 2 2 ) &omega; 2 / 2 + w 1 w 2 &omega; 1 z &CenterDot; = &omega; 3 + w 1 &omega; 2 - w 2 &omega; 1 - - - ( 3 )
其中,
Figure BDA00002664448400092
表示对w1,w2,z进行一次时间求导。
分析动力学方程式(2)可知,obxb轴,obyb轴角速度各受控制力矩T1,T2驱动,而obzb轴角速度没有控制力矩驱动,但obxb轴,obyb轴角速度会对该轴角速度有耦合影响;另外,分析运动学方程(3)可知,参量z与无力矩轴相对应,参量w与有力矩轴相对应,物理意义明显,参量z对参量w没有耦合效应,而参量w对参量z有耦合效应,这为欠驱动轴的设计提供了方便,因此该姿态描述参数在欠驱动的应用中比较广泛。
步骤二,针对动力学方程的obzb轴设计控制律。
如果初始条件ω3≠0,η3≠0,则首先针对动力学方程的obzb轴设计控制律,即针对方程如式(4)所示:
J 3 &omega; &CenterDot; 3 - ( J 1 - J 2 ) &omega; c 1 &omega; c 2 + P 3 T &eta; &CenterDot; &CenterDot; 3 = 0 &eta; &CenterDot; &CenterDot; 3 + 2 &xi; 3 &Lambda; 3 &eta; &CenterDot; 3 + &Lambda; 3 2 &eta; 3 + P 3 &omega; &CenterDot; 3 = 0 - - - ( 4 )
构造准李雅普诺夫函数如式(5)所示:
V 1 = 1 2 ( J 3 &omega; 3 2 + 2 &omega; 3 P 3 T &eta; &CenterDot; 3 + &eta; &CenterDot; 3 T &eta; &CenterDot; 3 + &eta; 3 T &Lambda; 3 2 &eta; 3 ) - - - ( 5 )
其中,V1表示obzb轴的动力学方程的准李雅普诺夫函数。
对上式中的
Figure BDA00002664448400095
进行矩阵变换,则得:
J 3 &omega; 3 2 + 2 &omega; 3 P 3 T &eta; &CenterDot; 3 + &eta; &CenterDot; 3 T &eta; &CenterDot; 3
= ( J 3 &omega; 3 + J 3 - 1 P 3 T &eta; &CenterDot; 3 ) T ( J 3 &omega; 3 + J 3 - 1 P 3 T &eta; &CenterDot; 3 ) + &eta; &CenterDot; 3 T ( E 3 - P 3 J 3 - 1 P 3 T ) &eta; &CenterDot; 3
其中
Figure BDA00002664448400098
是单位矩阵。因此,若
Figure BDA00002664448400099
成立,则函数V1相对于ω3η3是正定函数。
对V1求导,则得:
Figure BDA000026644484000911
为了使
Figure BDA000026644484000912
负定,设计中间控制律如式(6)所示:
&omega; c 1 = - sgn ( J 1 - J 2 ) sgn ( &omega; 3 ) | &omega; 3 | &omega; c 2 = k 1 | &omega; 3 | - - - ( 6 )
其中,k表示控制常数,sgn(·)表示·的符号函数,ωc1c2表示obxb轴,obyb轴的中间控制律。
代入则得如式(7)所示:
V &CenterDot; 1 = - k 1 | J 1 - J 2 | &omega; 3 2 - 2 &xi; 3 &eta; &CenterDot; 3 T &Lambda; 3 2 &eta; &CenterDot; 3 - - - ( 7 )
Figure BDA00002664448400103
推出
Figure BDA00002664448400104
进一步求导,则得代入方程式(4)可知η3=0。根据李雅普诺夫稳定性定理可知:当采用控制律式(6)的ωc1c2作为理想角速度输入时,系统(4)是渐近稳定的。即当t →∞时,ω3→0,
Figure BDA00002664448400106
η3→0。
步骤三,针对运动学方程设计控制律。
当ω3=0,η3=0时,则针对运动学方程设计准李雅普诺夫函数如式(8)所示:
V 2 = w 1 2 + w 2 2 + 1 2 z 2 > 0 - - - ( 8 )
其中,V2表示运动学方程的准李雅普诺夫函数。
对上式求导,为使
Figure BDA00002664448400108
负定,设计控制律如式(9)所示:
&omega; d 1 = - k 1 w 1 1 + w 1 2 + w 2 2 + &mu; z + &omega; 3 / &mu; w 1 2 + w 2 2 w 2 &omega; d 2 = - k 1 w 2 1 + w 1 2 + w 2 2 - &mu; z + &omega; 3 / &mu; w 1 2 + w 2 2 w 1 - - - ( 9 )
其中,k1,μ表示控制常数,k1>0,μ>0.5k1。ωd1d2表示obxb轴,obyb轴的虚拟控制律。
将上式代入
Figure BDA000026644484001010
则得如式(10)所示:
V &CenterDot; 2 = - k 1 w 1 2 - k 1 w 2 2 - &mu; z 2 < 0 - - - ( 10 )
根据李雅普诺夫稳定性定理可知:当采用控制律式(9)的ωd1d2作为理想角速度输入时,运动学系统(3)是渐近稳定的。即当t →∞时,w1→0,w2→0,z→0。
步骤四,针对动力学方程的obxb轴和obyb轴设计控制律。
考虑obxb轴和obyb轴的动力学方程,即针对方程式(2a),(2b),(2d)和(2e)设计控制律。在步骤三给出的虚拟控制角速度ωd1d2下,系统柔性振动模态坐标ηd1d2应满足如下式(11a)和(11b)所示:
&eta; &CenterDot; &CenterDot; d 1 + 2 &xi; 1 &Lambda; 1 &eta; &CenterDot; d 1 + &Lambda; 1 2 &eta; d 1 + P 1 &omega; &CenterDot; d 1 = 0 - - - ( 11 a )
&eta; &CenterDot; &CenterDot; d 2 + 2 &xi; 2 &Lambda; 2 &eta; &CenterDot; d 2 + &Lambda; 2 2 &eta; d 2 + P 2 &omega; &CenterDot; d 2 = 0 - - - ( 11 b )
其中,
Figure BDA00002664448400111
表示对ηd1d2进行一次时间求导。
Figure BDA00002664448400112
表示对ηd1d2进行二次时间求导。
引入Δω11d1,Δω22d2,Δη11d1,Δη22d2,则动力学方程(2a),(2b),(2d)和(2e)进一步转化为如式(12a)~(12d)所示:
J 1 &Delta; &omega; &CenterDot; 1 = T 1 + ( J 2 - J 3 ) &omega; 2 &omega; 3 - J 1 &omega; &CenterDot; d 1 - P 1 T ( &Delta; &eta; &CenterDot; &CenterDot; 1 + &eta; &CenterDot; &CenterDot; d 1 ) - - - ( 12 a )
J 2 &Delta; &omega; &CenterDot; 2 = T 2 + ( J 3 - J 1 ) &omega; 1 &omega; 3 - J 2 &omega; &CenterDot; d 2 - P 2 T ( &Delta; &eta; &CenterDot; &CenterDot; 2 + &eta; &CenterDot; &CenterDot; d 2 ) - - - ( 12 b )
&Delta; &eta; &CenterDot; &CenterDot; 1 + 2 &xi; 1 &Lambda; 1 &Delta; &eta; &CenterDot; 1 + &Lambda; 1 2 &Delta; &eta; 1 + P 1 &Delta; &omega; &CenterDot; 1 = 0 - - - ( 12 c )
&Delta; &eta; &CenterDot; &CenterDot; 2 + 2 &xi; 2 &Lambda; 2 &Delta; &eta; &CenterDot; 2 + &Lambda; 2 2 &Delta; &eta; 2 + P 2 &Delta; &omega; &CenterDot; 2 = 0 - - - ( 12 d )
针对式(12a)~(12d),构造准李雅普诺夫函数如式(13)所示:
V = 1 2 ( J 1 &Delta; &omega; 1 2 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; 1 T &Lambda; 1 2 &Delta; &eta; 1 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1 - - - ( 13 )
+ J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &eta; 2 T &Lambda; 2 2 &Delta; &eta; 2 + 2 &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2 )
其中,V表示obxb轴和obyb轴的动力学方程的准李雅普诺夫函数。
对上式中的 J 1 &Delta; &omega; 1 2 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1 J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2 进行矩阵变换,则得:
J 1 &Delta; &omega; 1 2 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1
= ( J 1 &Delta; &omega; 1 + J 1 - 1 P 1 T &Delta; &eta; &CenterDot; 1 ) T ( J 1 &Delta; &omega; 1 + J 1 - 1 P 1 T &Delta; &eta; &CenterDot; 1 ) + &Delta; &eta; &CenterDot; 1 T ( E 1 - P 1 J 1 - 1 P 1 T ) &Delta; &eta; &CenterDot; 1
J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2
= ( J 2 &Delta; &omega; 2 + J 2 - 1 P 2 T &Delta; &eta; &CenterDot; 2 ) T ( J 2 &Delta; &omega; 2 + J 2 - 1 P 2 T &Delta; &eta; &CenterDot; 2 ) + &Delta; &eta; &CenterDot; 2 T ( E 2 - P 2 J 2 - 1 P 2 T ) &Delta; &eta; &CenterDot; 2
其中
Figure BDA000026644484001115
Figure BDA000026644484001116
是单位矩阵。因此,若E
Figure BDA000026644484001132
成立,则函数V相对于ω1
Figure BDA000026644484001118
η12
Figure BDA000026644484001119
η2是正定函数。
对V求导,为了使
Figure BDA000026644484001120
负定,设计控制律如式(14)所示:
T 1 = - &alpha;&Delta; &omega; 1 - ( J 2 - J 3 ) &omega; 2 &omega; 3 + J 1 &omega; &CenterDot; d 1 + P 1 T &eta; &CenterDot; &CenterDot; d 1 T 2 = - &alpha;&Delta; &omega; 2 - ( J 3 - J 1 ) &omega; 2 &omega; 3 + J 2 &omega; &CenterDot; d 2 + P 2 T &eta; &CenterDot; &CenterDot; d 2 - - - ( 14 )
其中,α表示控制常数。
代入
Figure BDA000026644484001122
则得如式(15)所示:
V &CenterDot; = - &alpha;&Delta; &omega; 1 2 - &alpha;&Delta; &omega; 2 2 - 2 &Delta; &eta; &CenterDot; 1 T &xi; 1 &Lambda; 1 &Delta; &eta; &CenterDot; 1 - 2 &Delta; &eta; &CenterDot; 2 T &xi; 2 &Lambda; 2 &Delta; &eta; &CenterDot; 2 - - - ( 15 )
推出Δω1=0,Δω2=0,
Figure BDA000026644484001125
Figure BDA000026644484001126
进一步求导,则得
Figure BDA000026644484001127
Figure BDA000026644484001128
Figure BDA000026644484001129
Figure BDA000026644484001130
代入方程式(12c)~(12d)可知Δη1=0,Δη2=0。于是只包含系统(12a)~(12d)的零解。根据LaSalle不变集定理可知,系统是渐近稳定的。即当t→∞时,Δω1→0,
Figure BDA00002664448400121
Δη1→0,Δω2→0,
Figure BDA00002664448400122
Δη2→0。
经过上述证明过程,得到控制律T1,T2在E
Figure BDA00002664448400123
的情况下,可使系统渐近稳定,即能够保证实际角速度ω12趋向于理想角速度ωd1d2
然而,在所有时间点上并不是都有ω1d12d2,因此在控制律T1,T2作用下的完整闭环系统的稳定性仍需严格证明。该证明用李雅普诺夫稳定性定理和LaSalle不变集定理证得,属于本领域专业人员的公知原理,详细的证明过程在此不再赘述。

Claims (2)

1.一种欠驱动柔性航天器姿态稳定的控制方法,其特征在于:其步骤如下:
步骤一,建立系统模型;
假设柔性航天器的挠性变形很小,对变量做一阶线性化处理,运用动量矩定理建立柔性航天器的旋转运动模型;运用变分原理建立柔性附件的振动运动模型;考虑柔性附件相对于航天器本体无转动的情形,假设obzb轴的推力器发生了故障,建立欠驱动柔性航天器的动力学模型为:
J 1 &omega; &CenterDot; 1 - ( J 2 - J 3 ) &omega; 2 &omega; 3 + P 1 T &eta; &CenterDot; &CenterDot; 1 = T 1
J 2 &omega; &CenterDot; 2 - ( J 3 - J 1 ) &omega; 3 &omega; 1 + P 2 T &eta; &CenterDot; &CenterDot; 2 = T 2
J 3 &omega; &CenterDot; 3 - ( J 1 - J 2 ) &omega; 1 &omega; 2 + P 3 T &eta; &CenterDot; &CenterDot; 3 = 0
&eta; &CenterDot; &CenterDot; 1 + 2 &xi; 1 &Lambda; 1 &eta; &CenterDot; 1 + &Lambda; 1 2 &eta; 1 + P 1 &omega; &CenterDot; 1 = 0
&eta; &CenterDot; &CenterDot; 2 + 2 &xi; 2 &Lambda; 2 &eta; &CenterDot; 2 + &Lambda; 2 2 &eta; 2 + P 2 &omega; &CenterDot; 2 = 0
&eta; &CenterDot; &CenterDot; 3 + 2 &xi; 3 &Lambda; 3 &eta; &CenterDot; 3 + &Lambda; 3 2 &eta; 3 + P 3 &omega; &CenterDot; 3 = 0
其中ω1∈R1×12∈R1×13∈R1×1表示航天器本体系sb各轴相对于惯性系si的角速度在本体系sb下的表述,
Figure FDA00002664448300017
分别表示对ω123进行一次时间求导,
Figure FDA00002664448300018
分别表示对η123进行二次时间求导,
Figure FDA00002664448300019
Figure FDA000026644483000111
(l1+l1+l1=n)分别对应本体系sb三轴的柔性模态坐标,
Figure FDA000026644483000114
分别对应本体系sb三轴的柔性附件对航天器本体的柔性耦合系数矩阵,
Figure FDA000026644483000115
Figure FDA000026644483000117
分别对应本体系sb三轴的柔性附件模态频率矩阵,
Figure FDA000026644483000118
Figure FDA000026644483000120
分别对应本体系sb三轴的柔性附件模态阻尼矩阵,J1,J2,J3分别表示航天器本体系obxb,obyb,obzb轴的转动惯量分量,T1,T2分别表示航天器本体系上的两个控制力矩分量;
采用(w,z)参数来描述航天器相对于惯性坐标系的姿态,其对应的姿态运动学方程为:
w &CenterDot; 1 = &omega; 3 w 2 + ( 1 + w 1 2 - w 2 2 ) &omega; 1 / 2 + w 1 w 2 &omega; 2 w &CenterDot; 2 = - &omega; 3 w 1 + ( 1 - w 1 2 + w 2 2 ) &omega; 2 / 2 + w 1 w 2 &omega; 1 z &CenterDot; = &omega; 3 + w 1 &omega; 2 - w 2 &omega; 1
其中,
Figure FDA000026644483000122
表示对w1,w2,z进行一次时间求导;
由欠驱动柔性航天器的动力学方程可知,obxb轴,obyb轴角速度各受控制力矩T1,T2驱动,而obzb轴角速度没有控制力矩驱动,但obxb轴,obyb轴角速度会对obzb轴角速度有耦合影响;另外,由姿态运动学方程可知,参量z与无力矩轴相对应,参量w与有力矩轴相对应,参量z对参量w没有耦合效应,而参量w对参量z有耦合效应;
步骤二,针对动力学方程的obzb轴设计控制律;
如果初始条件ω3≠0,η3≠0,则针对obzb轴的动力学方程为:
J 3 &omega; &CenterDot; 3 - ( J 1 - J 2 ) &omega; c 1 &omega; c 2 + P 3 T &eta; &CenterDot; &CenterDot; 3 = 0 &eta; &CenterDot; &CenterDot; 3 + 2 &xi; 3 &Lambda; 3 &eta; &CenterDot; 3 + &Lambda; 3 2 &eta; 3 + P 3 &omega; &CenterDot; 3 = 0
构造准李雅普诺夫函数:
V 1 = 1 2 ( J 3 &omega; 3 2 + 2 &omega; 3 P 3 T &eta; &CenterDot; 3 + &eta; &CenterDot; 3 T &eta; &CenterDot; 3 + &eta; 3 T &Lambda; 3 2 &eta; 3 )
其中,V1表示obzb轴的动力学方程的准李雅普诺夫函数;
对上式中的进行矩阵变换,则得:
J 3 &omega; 3 2 + 2 &omega; 3 P 3 T &eta; &CenterDot; 3 + &eta; &CenterDot; 3 T &eta; &CenterDot; 3
= ( J 3 &omega; 3 + J 3 - 1 P 3 T &eta; &CenterDot; 3 ) T ( J 3 &omega; 3 + J 3 - 1 P 3 T &eta; &CenterDot; 3 ) + &eta; &CenterDot; 3 T ( E 3 - P 3 J 3 - 1 P 3 T ) &eta; &CenterDot; 3
其中
Figure FDA00002664448300026
是单位矩阵,因此,若
Figure FDA00002664448300027
成立,则函数V1相对于ω3
Figure FDA00002664448300028
η3是正定函数;
对V1求导,则得:
Figure FDA00002664448300029
为了使
Figure FDA000026644483000210
负定,设计中间控制律:
&omega; c 1 = - sgn ( J 1 - J 2 ) sgn ( &omega; 3 ) | &omega; 3 | &omega; c 2 = k | &omega; 3 |
其中,k表示控制常数,sgn(·)表示·的符号函数,ωc1c2表示obxb轴,obyb轴的中间控制律;
将上式中间控制律代入
Figure FDA000026644483000212
则得
V &CenterDot; 1 = - k | J 1 - J 2 | &omega; 3 2 - 2 &xi; 3 &eta; &CenterDot; 3 T &Lambda; 3 2 &eta; &CenterDot; 3
Figure FDA000026644483000214
推出
Figure FDA000026644483000215
进一步求导,则得
Figure FDA000026644483000216
代入obzb轴的动力学方程可知η3=0,根据李雅普诺夫稳定性定理可知:当采用控制律ωc1c2作为理想角速度输入时,obzb轴动力学系统是渐近稳定的,即当t →∞时,ω3→0,
Figure FDA000026644483000217
η3→0;
步骤三,针对运动学方程设计控制律;
当ω3=0,η3=0时,则针对运动学方程设计准李雅普诺夫函数:
V 2 = w 1 2 + w 2 2 + 1 2 z 2 > 0
其中,V2表示运动学方程的准李雅普诺夫函数;
对上式求导,为使
Figure FDA00002664448300032
负定,设计虚拟控制律:
&omega; d 1 = - k 1 w 1 1 + w 1 2 + w 2 2 + &mu; z + &omega; 3 / &mu; w 1 2 + w 2 2 w 2 &omega; d 2 = - k 1 w 2 1 + w 1 2 + w 2 2 - &mu; z + &omega; 3 / &mu; w 1 2 + w 2 2 w 1
其中,k1,μ表示控制常数,k1>0,μ>0.5k1,ωd1d2表示obxb轴,obyb轴的虚拟控制律;
将上式代入
Figure FDA00002664448300034
则得:
V &CenterDot; 2 = - k 1 w 1 2 - k 1 w 2 2 - &mu; z 2 < 0
根据李雅普诺夫稳定性定理可知:当采用控制律ωd1d2作为理想角速度输入时,运动学系统是渐近稳定的,即当t→∞时,w1→0,w2→0,z→0;
步骤四,针对动力学方程的obxb轴和obyb轴设计控制律;
考虑obxb轴和obyb轴的动力学方程设计控制律,在步骤三给出的虚拟控制角速度ωd1d2下,系统柔性振动模态坐标ηd1d2应满足:
&eta; &CenterDot; &CenterDot; d 1 + 2 &xi; 1 &Lambda; 1 &eta; &CenterDot; d 1 + &Lambda; 1 2 &eta; d 1 + P 1 &omega; &CenterDot; d 1 = 0
&eta; &CenterDot; &CenterDot; d 2 + 2 &xi; 2 &Lambda; 2 &eta; &CenterDot; d 2 + &Lambda; 2 2 &eta; d 2 + P 2 &omega; &CenterDot; d 2 = 0
其中,表示对ηd1d2进行一次时间求导,
Figure FDA00002664448300039
表示对ηd1d2进行二次时间求导;
引入误差Δω11d1,Δω22d2,Δη11d1,Δη22d2,则obxb轴和obyb轴的动力学方程进一步转化为误差的形式如下所示:
J 1 &Delta; &omega; &CenterDot; 1 = T 1 + ( J 2 - J 3 ) &omega; 2 &omega; 3 - J 1 &omega; &CenterDot; d 1 - P 1 T ( &Delta; &eta; &CenterDot; &CenterDot; 1 + &eta; &CenterDot; &CenterDot; d 1 )
J 2 &Delta; &omega; &CenterDot; 2 = T 2 + ( J 3 - J 1 ) &omega; 1 &omega; 3 - J 2 &omega; &CenterDot; d 2 - P 2 T ( &Delta; &eta; &CenterDot; &CenterDot; 2 + &eta; &CenterDot; &CenterDot; d 2 )
&Delta; &eta; &CenterDot; &CenterDot; 1 + 2 &xi; 1 &Lambda; 1 &Delta; &eta; &CenterDot; 1 + &Lambda; 1 2 &Delta; &eta; 1 + P 1 &Delta; &omega; &CenterDot; 1 = 0
&Delta; &eta; &CenterDot; &CenterDot; 2 + 2 &xi; 2 &Lambda; 2 &Delta; &eta; &CenterDot; 2 + &Lambda; 2 2 &Delta; &eta; 2 + P 2 &Delta; &omega; &CenterDot; 2 = 0
针对上述误差动力学模型,构造准李雅普诺夫函数:
V = 1 2 ( J 1 &Delta; &omega; 1 2 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; 1 T &Lambda; 1 2 &Delta; &eta; 1 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1
+ J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &eta; 2 T &Lambda; 2 2 &Delta; &eta; 2 + 2 &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2 )
其中,V表示obxb轴和obyb轴的动力学方程的准李雅普诺夫函数;
对上式中的 J 1 &Delta; &omega; 1 2 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1 J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2 进行矩阵变换,则得:
J 1 &Delta; &omega; 1 2 + 2 &Delta; &omega; 1 P 1 T &Delta; &eta; &CenterDot; 1 + &Delta; &eta; &CenterDot; 1 T &Delta; &eta; &CenterDot; 1
= ( J 1 &Delta; &omega; 1 + J 1 - 1 P 1 T &Delta; &eta; &CenterDot; 1 ) T ( J 1 &Delta; &omega; 1 + J 1 - 1 P 1 T &Delta; &eta; &CenterDot; 1 ) + &Delta; &eta; &CenterDot; 1 T ( E 1 - P 1 J 1 - 1 P 1 T ) &Delta; &eta; &CenterDot; 1
J 2 &Delta; &omega; 2 2 + &Delta; &eta; &CenterDot; 2 T &Delta; &eta; &CenterDot; 2 + &Delta; &omega; 2 P 2 T &Delta; &eta; &CenterDot; 2
= ( J 2 &Delta; &omega; 2 + J 2 - 1 P 2 T &Delta; &eta; &CenterDot; 2 ) T ( J 2 &Delta; &omega; 2 + J 2 - 1 P 2 T &Delta; &eta; &CenterDot; 2 ) + &Delta; &eta; &CenterDot; 2 T ( E 2 - P 2 J 2 - 1 P 2 T ) &Delta; &eta; &CenterDot; 2
其中
Figure FDA00002664448300049
是单位矩阵,因此,若E
Figure FDA000026644483000429
成立,则函数V相对于ω1
Figure FDA000026644483000412
η12
Figure FDA000026644483000413
η2是正定函数;
对V求导,为了使
Figure FDA000026644483000414
负定,设计:
T 1 = - &alpha;&Delta; &omega; 1 - ( J 2 - J 3 ) &omega; 2 &omega; 3 + J 1 &omega; &CenterDot; d 1 + P 1 T &eta; &CenterDot; &CenterDot; d 1 T 2 = - &alpha;&Delta; &omega; 2 - ( J 3 - J 1 ) &omega; 2 &omega; 3 + J 2 &omega; &CenterDot; d 2 + P 2 T &eta; &CenterDot; &CenterDot; d 2
其中,α表示控制常数;
代入
Figure FDA000026644483000416
则得
V &CenterDot; = - &alpha;&Delta; &omega; 1 2 - &alpha;&Delta; &omega; 2 2 - 2 &Delta; &eta; &CenterDot; 1 T &xi; 1 &Lambda; 1 &Delta; &eta; &CenterDot; 1 - 2 &Delta; &eta; &CenterDot; 2 T &xi; 2 &Lambda; 2 &Delta; &eta; &CenterDot; 2
Figure FDA000026644483000418
推出Δω1=0,Δω2=0,
Figure FDA000026644483000419
Figure FDA000026644483000420
进一步求导,则得
Figure FDA000026644483000421
Figure FDA000026644483000424
代入误差动力学方程后有Δη1=0,Δη2=0,于是
Figure FDA000026644483000425
只包含系统的零解,根据LaSalle不变集定理,系统是渐近稳定的,即当t →∞时,Δω1→0,Δω2→0,
Figure FDA000026644483000426
Δη1→0,
Figure FDA000026644483000427
Δη2→0;
经过上述证明过程,得到控制律T1,T2在E
Figure FDA000026644483000430
的情况下,可使系统渐近稳定,即能够保证实际角速度ω12趋向于理想角速度ωd1d2
2.根据权利要求1所述的一种欠驱动航天器三轴姿态稳定控制方法,其特征在于:在步骤一所述的柔性航天器的动力学模型,包括柔性航天器的旋转运动模型和柔性附件的振动运动模型。
CN201210580396.2A 2012-12-27 2012-12-27 一种欠驱动柔性航天器姿态稳定的控制方法 Expired - Fee Related CN103076807B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201210580396.2A CN103076807B (zh) 2012-12-27 2012-12-27 一种欠驱动柔性航天器姿态稳定的控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201210580396.2A CN103076807B (zh) 2012-12-27 2012-12-27 一种欠驱动柔性航天器姿态稳定的控制方法

Publications (2)

Publication Number Publication Date
CN103076807A true CN103076807A (zh) 2013-05-01
CN103076807B CN103076807B (zh) 2015-11-04

Family

ID=48153374

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201210580396.2A Expired - Fee Related CN103076807B (zh) 2012-12-27 2012-12-27 一种欠驱动柔性航天器姿态稳定的控制方法

Country Status (1)

Country Link
CN (1) CN103076807B (zh)

Cited By (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103412573A (zh) * 2013-07-22 2013-11-27 西北工业大学 基于级联方程的椭圆轨道航天器相对位置退步控制方法
CN103455035A (zh) * 2013-08-26 2013-12-18 北京理工大学 基于反步设计和非线性反馈的pd+姿态控制律设计方法
CN103792945A (zh) * 2014-01-26 2014-05-14 南京航空航天大学 一种充液航天器系统的姿态控制和燃料晃动抑制方法
CN104020778A (zh) * 2014-06-18 2014-09-03 哈尔滨工业大学 基于跟踪时间-能耗最优轨线的挠性卫星姿态机动控制方法
CN105843237A (zh) * 2016-03-22 2016-08-10 北京航空航天大学 一种用于抑制柔性振动的航天器姿态参考指令生成方法
CN106054912A (zh) * 2016-07-28 2016-10-26 北京航空航天大学 一种挠性航天器的高精度姿态镇定方法
CN106201996A (zh) * 2016-07-19 2016-12-07 宝鸡文理学院 一种改进的三角函数切换算法
CN106446481A (zh) * 2016-12-11 2017-02-22 河北工业大学 含柔性运动副欠驱动机构运动学、动力学求解方法
CN106933237A (zh) * 2017-02-28 2017-07-07 北京天恒长鹰科技股份有限公司 一种平流层飞艇的被动容错控制方法
CN109782787A (zh) * 2019-03-08 2019-05-21 北京航空航天大学 一种太阳光压辅助下欠驱动航天器姿态的双模mpc控制方法
CN110119153A (zh) * 2019-05-10 2019-08-13 北京航空航天大学 一种光压力矩主动辅助下的欠驱动航天器姿态控制方法

Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3750984A (en) * 1971-05-18 1973-08-07 Aerospatiale Mechanical transmission relay for a control facility comprising a manual element and a servo-motor, and its use in aircraft control systems
CN101576750A (zh) * 2009-04-14 2009-11-11 上海微小卫星工程中心 航天器的姿态跟踪控制系统及方法
CN101708780A (zh) * 2009-11-26 2010-05-19 哈尔滨工业大学 用于目标姿态跟踪的刚性航天器的控制方法
CN102073280A (zh) * 2011-01-13 2011-05-25 北京科技大学 一种复杂挠性航天器模糊奇异摄动建模与姿态控制方法
CN102431659A (zh) * 2011-10-27 2012-05-02 北京航空航天大学 一种日地系统Halo轨道探测器的构型及其姿态指向
CN102530269A (zh) * 2011-12-31 2012-07-04 北京航空航天大学 一种利用流速调节控制航天器姿态的方法及其执行机构
CN102830242A (zh) * 2012-08-17 2012-12-19 北京航空航天大学 一种基于磁悬浮惯性执行机构的姿态角速度测量方法

Patent Citations (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US3750984A (en) * 1971-05-18 1973-08-07 Aerospatiale Mechanical transmission relay for a control facility comprising a manual element and a servo-motor, and its use in aircraft control systems
CN101576750A (zh) * 2009-04-14 2009-11-11 上海微小卫星工程中心 航天器的姿态跟踪控制系统及方法
CN101708780A (zh) * 2009-11-26 2010-05-19 哈尔滨工业大学 用于目标姿态跟踪的刚性航天器的控制方法
CN102073280A (zh) * 2011-01-13 2011-05-25 北京科技大学 一种复杂挠性航天器模糊奇异摄动建模与姿态控制方法
CN102431659A (zh) * 2011-10-27 2012-05-02 北京航空航天大学 一种日地系统Halo轨道探测器的构型及其姿态指向
CN102530269A (zh) * 2011-12-31 2012-07-04 北京航空航天大学 一种利用流速调节控制航天器姿态的方法及其执行机构
CN102830242A (zh) * 2012-08-17 2012-12-19 北京航空航天大学 一种基于磁悬浮惯性执行机构的姿态角速度测量方法

Cited By (16)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103412573A (zh) * 2013-07-22 2013-11-27 西北工业大学 基于级联方程的椭圆轨道航天器相对位置退步控制方法
CN103455035A (zh) * 2013-08-26 2013-12-18 北京理工大学 基于反步设计和非线性反馈的pd+姿态控制律设计方法
CN103455035B (zh) * 2013-08-26 2015-12-23 北京理工大学 基于反步设计和非线性反馈的pd+姿态控制律设计方法
CN103792945A (zh) * 2014-01-26 2014-05-14 南京航空航天大学 一种充液航天器系统的姿态控制和燃料晃动抑制方法
CN103792945B (zh) * 2014-01-26 2016-05-18 南京航空航天大学 一种充液航天器系统的姿态控制和液体燃料晃动抑制方法
CN104020778A (zh) * 2014-06-18 2014-09-03 哈尔滨工业大学 基于跟踪时间-能耗最优轨线的挠性卫星姿态机动控制方法
CN105843237A (zh) * 2016-03-22 2016-08-10 北京航空航天大学 一种用于抑制柔性振动的航天器姿态参考指令生成方法
CN105843237B (zh) * 2016-03-22 2017-07-04 北京航空航天大学 一种用于抑制柔性振动的航天器姿态参考指令生成方法
CN106201996A (zh) * 2016-07-19 2016-12-07 宝鸡文理学院 一种改进的三角函数切换算法
CN106054912A (zh) * 2016-07-28 2016-10-26 北京航空航天大学 一种挠性航天器的高精度姿态镇定方法
CN106054912B (zh) * 2016-07-28 2018-10-26 北京航空航天大学 一种挠性航天器的高精度姿态镇定方法
CN106446481A (zh) * 2016-12-11 2017-02-22 河北工业大学 含柔性运动副欠驱动机构运动学、动力学求解方法
CN106446481B (zh) * 2016-12-11 2019-06-07 河北工业大学 含柔性运动副欠驱动机构运动学、动力学求解方法
CN106933237A (zh) * 2017-02-28 2017-07-07 北京天恒长鹰科技股份有限公司 一种平流层飞艇的被动容错控制方法
CN109782787A (zh) * 2019-03-08 2019-05-21 北京航空航天大学 一种太阳光压辅助下欠驱动航天器姿态的双模mpc控制方法
CN110119153A (zh) * 2019-05-10 2019-08-13 北京航空航天大学 一种光压力矩主动辅助下的欠驱动航天器姿态控制方法

Also Published As

Publication number Publication date
CN103076807B (zh) 2015-11-04

Similar Documents

Publication Publication Date Title
CN103076807B (zh) 一种欠驱动柔性航天器姿态稳定的控制方法
Hu et al. Robust fault-tolerant tracking control for spacecraft proximity operations using time-varying sliding mode
CN106814746B (zh) 一种航天器姿轨一体化反步跟踪控制方法
Sun et al. Adaptive backstepping control of spacecraft rendezvous and proximity operations with input saturation and full-state constraint
Jiang et al. Fixed-time rendezvous control of spacecraft with a tumbling target under loss of actuator effectiveness
CN106292681B (zh) 一种基于观测器和在线控制分配的卫星主动容错控制方法
CN104527994B (zh) 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法
CN105867401B (zh) 单框架控制力矩陀螺群的航天器姿态容错控制方法
Qinglei et al. Adaptive integral-type sliding mode control for spacecraft attitude maneuvering under actuator stuck failures
CN104460679B (zh) 一种基于切换控制方法的挠性航天器欠驱动控制系统及其姿态控制方法
CN105911866A (zh) 四旋翼无人飞行器的有限时间全阶滑模控制方法
CN109885075A (zh) 一种基于t-s模糊建模的卫星姿态抗干扰容错控制方法
Richie et al. Simultaneous attitude control and energy storage using VSCMGs: Theory and simulation
CN108804846B (zh) 非合作目标组合体航天器的数据驱动姿态控制器设计方法
CN106933241A (zh) 基于故障解耦的单框架控制力矩陀螺航天器容错控制方法
CN104656447A (zh) 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法
Jin et al. Underactuated spacecraft angular velocity stabilization and three-axis attitude stabilization using two single gimbal control moment gyros
Sanyal et al. Guidance and control for spacecraft autonomous chasing and close proximity maneuvers
Zhang et al. Integrated translational and rotational control for the terminal landing phase of a lunar module
Zhu et al. Rotating object specific tracking based on orbit-attitude coordinated adaptive control
Guerrero-Castellanos et al. Bounded attitude stabilization: Application on four-rotor helicopter
Schlanbusch et al. PD+ attitude control of rigid bodies with improved performance
CN112389679B (zh) 一种考虑多种摄动力的小卫星常值推力轨道递推方法
Holguin et al. Guidance and control for spacecraft autonomous rendezvous and proximity maneuvers using a geometric mechanics framework
Yang et al. Ground micro-gravity verification of free-floating non-cooperative satellite docking

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
C14 Grant of patent or utility model
GR01 Patent grant
CF01 Termination of patent right due to non-payment of annual fee

Granted publication date: 20151104

Termination date: 20201227

CF01 Termination of patent right due to non-payment of annual fee