CN104290925B - 一种航天器在惯性系内的角动量控制方法 - Google Patents
一种航天器在惯性系内的角动量控制方法 Download PDFInfo
- Publication number
- CN104290925B CN104290925B CN201410514465.9A CN201410514465A CN104290925B CN 104290925 B CN104290925 B CN 104290925B CN 201410514465 A CN201410514465 A CN 201410514465A CN 104290925 B CN104290925 B CN 104290925B
- Authority
- CN
- China
- Prior art keywords
- axis
- spacecraft
- theta
- control
- angular momentum
- 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
Links
- 238000000034 method Methods 0.000 title claims abstract description 22
- 238000005096 rolling process Methods 0.000 claims description 38
- 239000011159 matrix material Substances 0.000 claims description 12
- 230000009471 action Effects 0.000 claims description 5
- 238000005259 measurement Methods 0.000 claims description 3
- 230000005484 gravity Effects 0.000 abstract description 20
- 230000007774 longterm Effects 0.000 abstract description 3
- 230000006641 stabilisation Effects 0.000 abstract description 2
- 238000011105 stabilization Methods 0.000 abstract description 2
- 230000007246 mechanism Effects 0.000 description 11
- 238000009825 accumulation Methods 0.000 description 5
- 238000002347 injection Methods 0.000 description 5
- 239000007924 injection Substances 0.000 description 5
- 238000010586 diagram Methods 0.000 description 3
- 230000007613 environmental effect Effects 0.000 description 2
- 206010034719 Personality change Diseases 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000002131 composite material Substances 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 239000000243 solution Substances 0.000 description 1
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种航天器在惯性系内的角动量控制方法,该方法采用在惯性系内进行三轴稳定控制,通过将执行机构的角动量、三轴姿态角信息进行反馈设计得到反馈控制器,该方法不需要重力梯度力矩大于气动力矩,保证长期稳定飞行而执行机构不饱和,可应用于无法配置磁力矩器或磁力矩器出现故障,而又无法或不希望采用喷气方式进行卸载的航天器姿态控制中。
Description
技术领域
本发明涉及一种角动量控制方法,属于航天器姿态控制领域。
背景技术
采用角动量交换执行机构(飞轮、控制力矩陀螺)进行姿态控制的航天器长期在轨飞行时,在空间环境干扰力矩的作用下,会导致执行机构角动量增长,进而达到饱和,因此必须进行角动量卸载。目前主要的卸载方式包括磁力矩器卸载、喷气卸载。
由于空间站的惯量大,所受的环境力矩也大,如国际空间站最大气动力矩达到8.8Nm,如此大的外干扰力矩引起的角动理积累不可能采用磁力矩器来完成卸载,因此空间站均利用重力梯度力矩来进行角动量的管理。
国际空间站采用力矩平衡姿态(TorqueEquilibriumAttitude,TEA)的思想,利用三轴姿态实时调整,达到重力梯度力矩与气动力矩在轨道周期内的平衡,三轴姿态活动范围为15°。国际空间站实际上是利用重力梯度力矩来平衡气动力矩,因此空间站的惯量特性必须满足一定约束条件,即其主惯性轴必须相差较大,才能产生足够的重力梯度力矩来平衡气动力矩,但这个要求有时候并不能得到满足,如我国空间站在早期只有一个核心舱在轨时,由于舱体呈细长构型,俯仰轴与偏航轴转动惯量接近,就无法产生足够的重力梯度力矩,因此也无法利用力矩平衡姿态控制进行角动量控制。
发明内容
本发明解决的技术问题是:克服现有技术的不足,提供一种航天器在惯性系内的角动量控制方法,该方法不需要重力梯度力矩大于气动力矩,即能完成角动量控制,从而保证执行机构不饱和。
本发明的技术解决方案是:一种航天器在惯性系内的角动量控制方法,包括以下步骤:
(1)在惯性坐标系内建立航天器俯仰轴、滚动轴、偏航轴上的控制器,形式如下:
其中,[TxTyTz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的控制力矩;[θxθyθz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的姿态角; 为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的角速度;[HcmgxHcmgyHcmgz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上控制力矩陀螺的角动量;
其中Bx、Sx满足方程
其中Bz、Sz满足方程
J1、J2、J3为航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的主转动惯量,ω0为轨道角速度。
(2)星敏感器实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角θx、θy、θz,并将测得的姿态角传送给地面控制计算机;
(3)角速率陀螺实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的角速度并将测得的角速度传送给地面控制计算机;
(4)航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的控制力矩陀螺分别将自身实时角动量Hcmgx、Hcmgy、Hcmgz传送给地面控制计算机;
(5)地面控制计算机根据步骤(2)、(3)和(4)得到的航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角,角速度和角动量,以及步骤(1)中建立的控制器,得到航天器滚动轴、俯仰轴以及偏航轴上的控制力矩Tx、Ty、Tz,并将该控制力矩以指令的形式上传给控制力矩陀螺,控制力矩陀螺对接收到的控制力矩指令进行解算后以该控制力矩控制航天器的在轨飞行;
(6)重复执行步骤(2)—(5),在步骤(1)建立的控制器的作用下使航天器处于稳定飞行状态,控制力矩陀螺的角动量Hcmgx、Hcmgy、Hcmgz维持一个固定值,从而实现角动量控制。
本发明与现有技术相比的有益效果是:
(1)国际空间站采用的力矩平衡姿态控制方法以轨道坐标系为参考坐标系,要求航天器三轴转动惯量足够大,能产生比气动力矩大的重力梯度力矩,而本发明以惯性坐标系为参考系,不需要满足重力梯度力矩比气动力矩大的约束即能实现角动量控制,能在国际空间站所采用的力矩平衡姿态控制方法无法应用的场合使用。
(2)本发明采用在惯性系内进行三轴稳定控制,并将执行机构的角动量、三轴姿态角信息进行反馈得到反馈控制器,保证长期稳定飞行而执行机构不饱和,可应用于无法配置磁力矩器或磁力矩器出现故障,而又无法或不希望采用喷气方式进行卸载的航天器姿态控制中。
(3)本发明方法还能实现帆板对日,是一种无需初始角速度和喷气的对日定向控制方法,可以实现向其它航天器的推广。
附图说明
图1为本发明方法流程图;
图2为控制系统回路图;
图3为惯性坐标系与轨道坐标系示意图;
图4为在航天器本体系内看地球运行及大气方向的示意图;
图5为三轴惯性稳定情况下实现帆板对日定向的示意图;
具体实施方式
下面结合附图对本发明的具体实施方式进行进一步的介绍。
如图1所示为本发明的方法流程图,如图2所示为本发明控制系统回路图。结合图1和图2,本发明的方法流程如下:
(1)在惯性坐标系内建立航天器俯仰轴、滚动轴、偏航轴上的控制器,形式如下:
其中,[TxTyTz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的控制力矩;[θxθyθz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的姿态角; 为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的角速度;[HcmgxHcmgyHcmgz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上控制力矩陀螺的角动量;
上面系数矩阵kx的求解方法如下:
解如下代数Riccati方程
其中,
J1、J2、J3为主转动惯量,ω0为轨道角速度。
同理,
解如下代数Riccati方程,可求得kz:
其中,
kyi、kyp、kyd为正的常值,根据系统性能通过调试得到,一般可按如下方式选取:kyp=J2(nω0)2,kyd=1.4J2nω0,kyi=0.01kyp,n=40~100。
(2)星敏感器实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角θx、θy、θz,并将测得的姿态角传送给地面控制计算机;
(3)角速率陀螺实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的角速度并将测得的角速度传送给地面控制计算机;
(4)航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的控制力矩陀螺分别将自身实时角动量Hcmgx、Hcmgy、Hcmgz传送给地面控制计算机;
(5)地面控制计算机根据步骤(2)、(3)和(4)得到的航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角,角速度和角动量,以及步骤(1)中建立的控制器,得到航天器滚动轴、俯仰轴以及偏航轴上的控制力矩Tx、Ty、Tz,并将该控制力矩以指令的形式上传给控制力矩陀螺,控制力矩陀螺对接收到的控制力矩指令进行解算后以该控制力矩控制航天器的在轨飞行;
(6)重复执行步骤(2)—(5),在步骤(1)建立的控制器的作用下最终使航天器处于稳定飞行状态,航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角、角速度以及控制力矩陀螺的角动量Hcmgx、Hcmgy、Hcmgz均维持一个固定值,从而实现角动量控制。
本发明提出的航天器在惯性系内的角动量控制方法基本原理是:如图3所示,定义航天器的轨道坐标系:xo方向指向飞行方向,zo方向指向地心,yo与xo、zo构成右手坐标系;惯性坐标系:xi、yi、zi(对应滚动轴、俯仰轴、偏航轴三个轴)在初始时刻与xo、yo、zo重合,在惯性空间内保持指向不变;本体坐标系,坐标系三轴与主惯性轴重合,在零姿态偏差时,xb、yb、zb分别与xi、yi、zi重合。如图4所示,假设航天器姿态在惯性系内保持三轴稳定,在惯性系内看地球与大气来流方向,在一个轨道周期内,地球围绕航天器飞行一圈,同时大气方向围绕航天器改变360度。
定性来看,由于对称性,重力梯度力矩与气动力矩在航天器本体系内引起的角动量不积累,从而使航天器的角动量执行机构(控制力矩陀螺)的角动量不积累,达到角动量管理控制的目的。
定量来看,通过推导,航天器在惯性系内保持三轴稳定时,所受的重力梯度力矩Tgg公式如下:
其中,Tgg=[TggxTggyTggz]T,航天器在惯性系内的姿态角为[θxθyθz]T,J1、J2、J3为主转动惯量,为xo与xi轴间的夹角。
通过上面重力梯度力矩的公式可以看到,重力梯度力矩由两项构成,其中由航天器在惯性系内的姿态角引起,将引起执行机构角动量的积累,为周期性波动重力梯度力矩,不引起角动量的积累。
俯仰轴上即使存在姿态误差,在该轴上也没有常值重力梯度力矩,而滚动与偏航轴上,常值姿态偏差将引起角动量的积累。
因此,如果保证航天器在惯性系内滚动、偏航角平均姿态为0,则可保证重力梯度力矩不积累。
下面阐述一下本发明所建立的如下形式的惯性系内的三轴控制器能够使控制力矩陀螺(执行机构)的角动量不积累,达到了角动量控制的目的:
(1)以惯性坐标系为参考坐标系,建立航天器的姿态动力学方程,注意普通航天器建模时,是以轨道坐标系为参考系建立姿态动力学方程;由于是以惯性坐标系为参考系建立姿态动力学方程,没有轨道角速度引起的滚动、偏航耦合项,所建立的姿态动力学方程可近似实现三轴解耦,因此进一步建立惯性系内三轴解耦的姿态动力学方程,以航天器的角动量形式表示;
其中, 为航天器滚动轴、俯仰轴以及偏航轴上控制力矩陀螺的角动量;Tc=[TxTyTz]T为航天器滚动轴、俯仰轴以及偏航轴的控制力矩;Tdist=[TdistxTdistyTdistz]T为航天器滚动轴、俯仰轴以及偏航轴的环境力矩。
(2)俯仰轴上的控制特性:通过上面图1及基本原理的解释,可以看到,俯仰轴上,由于地球运行及大气方向的对称性,以及重力梯度力矩在该轴上不存在常值项成份,导致该轴上角动量不积累,因此将俯仰轴上的PID控制器代入俯仰轴动力学方程可得;
上述方程为典型的稳定二阶系统,在外干扰作用下,俯仰轴保持稳定,由于外干扰本来不会导致执行机构角动量的积累,因此俯仰轴保持姿态稳定。
(3)滚动轴上的控制性能:通过上面图1及基本原理的解释,可以看到,只要滚动轴上的平均姿态角保持0度,则可保证该轴上重力梯度力矩不积累;反之,利用该轴上的姿态变化,可以产生重力梯度力矩。而在该轴上气动力矩可能产生积累,因此利用该轴上的重力梯度力矩,可以进行角动量管理。具体方法如下:
(a)、在惯性系内建立以角动量形式表示的姿态动力学方程,同时将重力梯度力矩的常值部份的显式代入,得到如下形式:
(b)、该轴上控制力矩陀螺的角动量方程为:
(c)、该轴上运动学方程为:
(d)、将上面(a)、(b)、(c)的方程,以及积分变量fθx=∫θxdt、fHx=∫Hcmgxdt扩展后联立的状态空间形式方程如下:
上述状态空间形式方程的可控性矩阵为:
可以看到,上述矩阵为满秩矩阵,根据现代控制理论,也就是说一定存在反馈矩阵Kx,使具有如下形式的控制器:
能使系统达到稳定,上述控制器的形式即为前面所建的控制器
上述反馈控制能使系统达到稳定,也就是说在存在外干扰的情况下,系统状态最后达到稳定。因此在气动力矩的作用下,系统状态达到最终的稳定状态,不会无限增长而导致发散。而上述系统的状态中,由于引入的变量Hcmgx、fHx=∫Hcmgxdt,以及姿态变量θx、fθx=∫θxdt,因此控制器施加控制,以使上述状态量达到稳定状态,从而达到在控制姿态的同时,使执行机构的角动量不积累,达到了角动量管理控制的目的。
(4)类似地,偏航轴上的控制性能:同(4),联立的状态空间形式方程如下:
上述状态空间形式方程的可控性矩阵为:
同理,一定存在如下形式的控制器:
能使系统达到稳定,上述控制器的形式即为前面所建的控制器
上面状态空间形式的方程中,由于引入的变量Hcmgz、fHz=∫Hcmgzdt,以及姿态变量θz、fθz=∫θzdt,因此控制器施加控制,以使上述状态量为零为稳定状态,从而达到在控制姿态的同时,使执行机构的角动量不积累,达到了角动量管理控制的目的。
本发明在航天器不配置磁力矩器、不进行喷气卸载的情况下,采用在惯性系内进行三轴稳定控制,并将执行机构的角动量、三轴姿态角信息进行反馈得到反馈控制器,保证长期稳定飞行而执行机构不饱和,与现有方法不同,是一种新的利用重力梯度力矩进行角动量控制的新方法。
对于将帆板安装在本体左右两侧的航天器,通过采用如下策略,还能实现三轴惯性稳定情况下的帆板对日定向,如图5所示:将本体xb轴垂直于轨道面,-zb指向太阳在轨道面内的投影方向,转动帆板驱动机构,转动角度为太阳与轨道面的夹角,实现帆板法线指向太阳方向,在此基础上利用本专利设计的控制器,即可实现惯性稳定,同时实现帆板对日定向。因此本发明还可作为一种对日定向控制方法。因此也是一种无需初始角速度和喷气的对日定向控制方法,可以实现向其它航天器的推广。
本发明中涉及的计算量不大,所需要的参数都可以获取,我国空间站采用了本发明的控制器,并按照本发明所述的惯性系力矩平衡姿态控制方案进行角动量的管理和控制。
本发明未详细说明部分属本领域技术人员公知常识。
Claims (1)
1.一种航天器在惯性系内的角动量控制方法,其特征在于包括以下步骤:
(1)在惯性坐标系内建立航天器俯仰轴、滚动轴、偏航轴上的控制器,形式如下:
其中,[TxTyTz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的控制力矩;[θxθyθz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的姿态角;为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上的角速度;[HcmgxHcmgyHcmgz]T为惯性坐标系内航天器滚动轴、俯仰轴以及偏航轴上控制力矩陀螺的角动量;
其中Bx、Sx满足方程
其中Bz、Sz满足方程
J1、J2、J3为航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的主转动惯量,ω0为轨道角速度;
(2)星敏感器实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角θx、θy、θz,并将测得的姿态角传送给地面控制计算机;
(3)角速率陀螺实时测量惯性坐标系内航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的角速度并将测得的角速度传送给地面控制计算机;
(4)航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的控制力矩陀螺分别将自身实时角动量Hcmgx、Hcmgy、Hcmgz传送给地面控制计算机;
(5)地面控制计算机根据步骤(2)、(3)和(4)得到的航天器在轨飞行时滚动轴、俯仰轴以及偏航轴上的姿态角,角速度和角动量,以及步骤(1)中建立的控制器,得到航天器滚动轴、俯仰轴以及偏航轴上的控制力矩Tx、Ty、Tz,并将该控制力矩以指令的形式上传给控制力矩陀螺,控制力矩陀螺对接收到的控制力矩指令进行解算后以该控制力矩控制航天器的在轨飞行;
(6)重复执行步骤(2)—(5),在步骤(1)建立的控制器的作用下使航天器处于稳定飞行状态,控制力矩陀螺的角动量Hcmgx、Hcmgy、Hcmgz维持一个固定值,从而实现角动量控制。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410514465.9A CN104290925B (zh) | 2014-09-29 | 2014-09-29 | 一种航天器在惯性系内的角动量控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410514465.9A CN104290925B (zh) | 2014-09-29 | 2014-09-29 | 一种航天器在惯性系内的角动量控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104290925A CN104290925A (zh) | 2015-01-21 |
CN104290925B true CN104290925B (zh) | 2016-06-29 |
Family
ID=52310929
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410514465.9A Active CN104290925B (zh) | 2014-09-29 | 2014-09-29 | 一种航天器在惯性系内的角动量控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104290925B (zh) |
Families Citing this family (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107703905B (zh) * | 2017-07-28 | 2020-02-14 | 北京宇航系统工程研究所 | 一种全闭环航天器姿控极性测试方法 |
CN107933967A (zh) * | 2017-11-23 | 2018-04-20 | 北京控制工程研究所 | 一种卫星转动惯量的在轨辨识方法 |
CN109613932A (zh) * | 2019-01-09 | 2019-04-12 | 北京空间飞行器总体设计部 | 一种采用相对导航信息的j2摄动下最优连续推力控制方法 |
CN110697085B (zh) * | 2019-09-16 | 2020-09-18 | 北京控制工程研究所 | 一种双sgcmg与磁力矩器组合的卫星控制方法 |
CN111367304B (zh) * | 2020-02-25 | 2023-07-14 | 上海航天控制技术研究所 | 一种基于双重异构力矩陀螺群的执行机构配置及使用方法 |
Family Cites Families (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US3567155A (en) * | 1968-12-20 | 1971-03-02 | James A Gatlin | Gravity gradient attitude control system |
CN103950556B (zh) * | 2014-04-22 | 2016-01-13 | 北京控制工程研究所 | 一种控制力矩陀螺替代动量轮的卫星稳态控制方法 |
CN104071355B (zh) * | 2014-06-12 | 2016-03-30 | 上海微小卫星工程中心 | 一种卫星姿态稳定控制方法及装置 |
-
2014
- 2014-09-29 CN CN201410514465.9A patent/CN104290925B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN104290925A (zh) | 2015-01-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104290925B (zh) | 一种航天器在惯性系内的角动量控制方法 | |
CN105159310B (zh) | 一种惯性系航天器姿态控制/角动量管理方法 | |
CN106915477B (zh) | 一种姿态控制方法 | |
CN105867401B (zh) | 单框架控制力矩陀螺群的航天器姿态容错控制方法 | |
Xu et al. | Sliding mode control of a quadrotor helicopter | |
CN107364589B (zh) | 基于多系绳连接点对空间失稳目标的绕飞消旋控制方法 | |
CN109625329B (zh) | 一种基于离散喷气的飞轮角动量自主卸载方法 | |
CN102923317B (zh) | 一种适用于卫星姿态角速度阻尼的欠驱动控制方法 | |
CN110884691B (zh) | 整星下冗余动量轮组转速闭环控制极性测试方法 | |
CN112572835B (zh) | 一种具有姿态切换的卫星在轨角动量管理及控制方法 | |
CN107065916B (zh) | 亚轨道卫星全被动稳定姿控系统及方法 | |
CN109649691B (zh) | 一种偏置动量卫星单飞轮与磁联合控制方法和系统 | |
Chen et al. | Modeling and control of a quadrotor helicopter system under impact of wind field | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
CN103231810A (zh) | 一种利用卫星俯仰轴姿态机动卸载俯仰轴角动量的方法 | |
Sanchez et al. | Continuous reactive-based position-attitude control of quadrotors | |
Ishijima et al. | The on-orbit maneuvering of large space flexible structures by free-flying robots | |
CN103336528B (zh) | 一种欠驱动航天器三轴姿态稳定控制方法 | |
CN103818564B (zh) | 一种采用小推力的航天器轨道维持与对地定向姿态保持一体化控制方法 | |
CN110162070B (zh) | 末端自由边界约束下的三轴姿态运动轨迹规划系统及方法 | |
Yang et al. | Position control of tethered UAV with onboard inertial sensors | |
CN108891625B (zh) | 固体微推进器阵列与磁力矩器联合控制方法 | |
Reijneveld et al. | Attitude control system of the Delfi-n3Xt satellite | |
Zenteno-Torres et al. | A tracking backstepping sliding-mode control for spacecraft rendezvous with a passive target | |
Jun et al. | Attitude control and momentum management of inertially oriented space station |
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 |