CN103112603A - 欠驱动高速自旋卫星建立正常姿态的方法 - Google Patents
欠驱动高速自旋卫星建立正常姿态的方法 Download PDFInfo
- Publication number
- CN103112603A CN103112603A CN2013100363829A CN201310036382A CN103112603A CN 103112603 A CN103112603 A CN 103112603A CN 2013100363829 A CN2013100363829 A CN 2013100363829A CN 201310036382 A CN201310036382 A CN 201310036382A CN 103112603 A CN103112603 A CN 103112603A
- Authority
- CN
- China
- Prior art keywords
- satellite
- attitude
- normal
- under
- axis
- 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
Images
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种欠驱动高速自旋卫星建立正常姿态的方法,包括以下步骤:(1)利用姿态敏感器的输出数据确定欠驱动卫星的自旋轴;(2)确定欠驱动轴和正常轴;(3)对卫星进行欠驱动消旋、进动控制至所述陀螺退饱和;(4)所述陀螺退饱和后,对三轴角速度进行欠驱动控制;(5)确定并更新初始姿态四元数;(6)采用动量轮进行姿态捕获和磁力矩器卸载,并确定卫星姿态,将卫星恢复至正常对地三轴稳定姿态。本发明解决了某通道丧失喷气控制能力的欠驱动卫星恢复正常姿态的问题。
Description
技术领域
本发明属于卫星姿态与轨道控制技术领域,涉及一种欠驱动高速自旋卫星建立正常姿态的方法。
背景技术
在轨卫星一般具有喷气控制和基于角动量管理装置(如飞轮/动量轮、控制力矩陀螺等)控制两种方式。基于角动量管理装置的控制由于受限角动量约束,一般仅用于正常情况下的姿态控制。喷气控制具有力矩大且无角动量的约束,对于大的星体初始姿态角速度均可有效地阻尼下来,因此常常用于卫星入轨阶段、***异常下的对日安全、以及安全模式转正常对地等场合。在全驱动控制方式下,可通过三轴解耦控制方法比较容易地实现卫星的三轴控制,因此目前在轨卫星在三轴上均配置喷气发动机等执行机构。卫星在轨运行过程中,一旦因某种故障导致某一星体轴的喷气发动机无法正常工作时,则卫星喷气控制变为一个欠驱动控制问题,若仍采用全驱动控制下的常规方法则无法实现三轴阻尼控制,从而危及卫星安全。
为了建立高速自旋异常卫星的正常姿态,需要进行消旋和进动控制,在陀螺退饱和后,进行速率阻尼直至完成大角度姿态捕获建立正常姿态,这些都需要执行机构来完成控制驱动。相关文献有:Ramin E等,A Lyapunov-basedfail-safe controller for an underactuated rigid-body spacecraft,AIAA-2001-4212。刘海颖等,基于(w,z)参数化的微小卫星喷气欠驱动控制,北京航空航天大学学报,34卷(2),2008:229~233。徐福祥,用地球磁场和重力场成功挽救风云一号(B)卫星的控制技术,宇航学报,22卷(2),2001:1~11,利用三轴磁力矩器和三轴动量轮等执行机构完成了在轨抢救,属于全驱动控制方式。彭仁军等,一种低轨道卫星在轨故障抢修与恢复,航天器工程,17卷(1),2008:24~29,利用三轴磁力矩器和喷气推进***等执行机构完成了在轨抢救,属于全驱动控制方式。上述方法存在如下不足:主要基于Lyapunov稳定性理论进行正常姿态下的欠驱动***控制器设计,而且在轨卫星故障抢救均未涉及欠驱动控制方法,相关研究仅注重控制***的稳定性及收敛性,没有兼顾控制***的动态过程,而后者恰恰是影响工程实际应用成功与否的关键因素之一,如实际在轨运行卫星受到姿态测量量程和执行机构输出能力的约束,一般的欠驱动控制方法其动态性能可能难以适应实际工程应用的要求。
发明内容
本发明的技术解决问题是:针对现有技术的不足,提供一种欠驱动高速自旋卫星建立正常姿态的方法,解决了某通道丧失喷气控制能力的欠驱动卫星恢复正常姿态的问题。
本发明的技术解决方案是:
(1)利用姿态敏感器的输出数据确定欠驱动卫星的自旋轴;
(2)确定欠驱动轴和正常轴;
(3)对卫星进行欠驱动消旋、进动控制至所述陀螺退饱和;
(4)所述陀螺退饱和后,对三轴角速度进行欠驱动控制;
(5)确定并更新初始姿态四元数;
(6)采用动量轮进行姿态捕获和磁力矩器卸载,并确定卫星姿态,将卫星恢复至正常对地三轴稳定姿态。
本发明与现有技术相比具有如下优点:
(1)本发明针对欠驱动卫星,设计了由高速自旋异常状态恢复到正常对地姿态的方法,工程可实现性强。
(2)本发明的消旋和进动控制策略可适用于全驱动控制方式和欠驱动控制方式。
(3)本发明利用三轴动量轮进行全姿态捕获控制方式,是一种不依赖喷气推进***的大角度姿态捕获技术,磁力矩器卸载,利用红外地球敏感器和数字太阳敏感器或单独利用星敏感器进行姿态确定,利于工程实际应用。
附图说明
图1为本发明流程图。
具体实施方式
下面就结合附图对本发明做进一步介绍。
如图1所示为本发明流程图,具体过程如下:
(1)利用姿态敏感器确定欠驱动卫星的自旋轴
在本发明实施例中,用于确定卫星自旋轴的姿态敏感器可以为数字太阳敏感器。自旋轴的确定内容包括其方位和大小,确定的过程包括确定数据采纳间隔、判断数据有效性和确定自旋轴。
确定数据采纳间隔:自旋角速度较大,姿态敏感器输出的有效数据比较稀疏,但相邻测量结果增量变化大;自旋角速度较小,姿态敏感器输出的有效数据比较密集,但相邻测量结果增量变化小。如果敏感器测量精度为σm,采纳数据间隔为Δt,则自旋轴确定误差∝σm/Δt,由此可见,要根据数据稀疏程度、敏感器测量精度等调整采纳的数据,比如在角速度很大的抢救初期,可以根据相邻有效数据进行自旋轴确定;随着消旋的持续实施,角速度逐渐降低,相邻有效数据变化小,就需加大数据间隔选择相应的有效数据。
判断数据有效性:根据数据有效性标志、相邻周期的增量合理性和其它物理意义标志,如数字太阳敏感器的“见太阳”标志,进行数据有效性综合判断。
确定自旋轴:设计确定自旋轴的算法,一般采用几何法或代数法确定自旋轴相关信息,如方位(本体系和惯性系)、大小,具体确定方法可参考《屠善澄,卫星姿态动力学与控制[M],宇航出版社,2001》。
(2)确定欠驱动轴和正常轴
在完成自旋轴的确定后,需要确定卫星的欠驱动轴和正常轴。在卫星姿态发生异常后,可以对姿态异常前的遥测数据进行分析,一般根据姿态异常前的数据确定卫星的欠驱动轴,主要分析控制力矩和陀螺测量的响应是否一致。
首先提取遥测的控制量和陀螺测量数据,再分析控制量和陀螺测量的响应是否一致,即是否满足其中为由陀螺计算的角速度、Tci为控制力矩、Ji为卫星惯量,x、y和z分别为星体三轴。如果在星体三轴三个方向均满足上述关系式,则卫星属于全驱动控制;否则属于欠驱动控制,不满足上述关系式的轴为欠驱动轴,满足上述关系式的轴为正常轴。
(3)对卫星进行欠驱动消旋、进动控制
为了使高速自旋异常卫星恢复至正常姿态,首先要使陀螺退饱和,这就要进行消旋和进动控制。对于全驱动卫星,消旋和进动控制可以采用经典的控制理论和方法,而对于自旋轴和星体轴不一致的欠驱动卫星,需要利用力矩分量进行消旋或进动控制。在本实施例中,欠驱动消旋和进动控制的过程如下:
1)确定消旋、进动控制的方向和大小;
2)确定各喷气控制发动机和消旋、进动控制方向的几何关系;
3)确定进行消旋、进动控制的喷气发动机;
4)进行欠驱动消旋、进动控制。
选取喷气控制力矩在消旋、进动控制方向上分量最大的喷气发动机作为控制发动机,选择合理的喷气控制方案尽量避免引起章动,消旋至陀螺退饱和的同时确保整星能源安全。
(4)陀螺退饱和后,进行欠驱动三轴角速度阻尼控制
消旋至陀螺退饱和后,为了保证整星安全不能无限的利用喷气推进***继续消旋,必须及时进行三轴闭环控制,姿态角速度比较大,动量轮无法接入闭环控制,速率阻尼控制只能采用欠驱动的喷气推进***。根据上述欠驱动轴和正常轴的分析结果,利用正常轴进行星体三轴角速度阻尼,包括姿态确定和控制量计算过程。
姿态确定:根据陀螺测量数据预估卫星姿态和角速度。
控制量计算:利用两个正常轴的喷气发动机作为执行机构,设计欠驱动控制策略,采用PD控制律,将卫星三轴角速度阻尼到较小的阈值。阈值的选取要考虑两个方面:1)将星体角速度阻尼下来,使星体三轴角动量小于动量轮允许角动量,为后继转入三轴动量轮控制创造条件;2)为恒星捕获提供条件,以满足星敏感器的全天区捕获功能对星体角速度大小的要求(如0.15度/秒,设计依据:在0.3度/秒内星敏感器能进行全天区识别)。
(5)动态运动下的自主初始姿态四元数确定和更新
进行建立正常姿态过程前,需要建立初始姿态,考虑到此时卫星一般具有大角度姿态,因此采用姿态四元数表示姿态,姿态初始值可以根据红外地球敏感器和数字太阳敏感器信息进行双矢量定姿,或者单独根据星敏感器信息解算。
以星敏感器作为实施例,星敏感器完成恒星捕获后,如果星敏感器数据有效,则根据双矢量几何定姿原理,由星敏感器数据定姿结果更新卫星姿态;星敏感器数据无效,则根据陀螺测量数据预估姿态。根据卫星姿态和轨道,采用地磁强度拟合算法计算星本体地磁强度。
如果仅单星敏感器数据有效,则姿态更新算法如下(以星敏感器A为例):
1)如果星敏感器输出数据为四元数,则:
2)如果星敏感器输出数据为测量轴矢量,则
AI=ZAI;BI=XAI;CI=AI×BI;
AB=ZAB;BB=XAB;CB=AB×BB;
CBI=[AB,BB,CB]·[AI,BI,CI]T;
3)计算本体系相对轨道系的姿态矩阵
如果星敏感器数据无效,则陀螺预估姿态四元数算法如下:
若 则
上述公式中Δt为采样周期,为星本体相对惯性系的姿态四元数(其中为标量),为陀螺测量输出的星体三轴惯性角速度,ZAI、XAI分别为星敏感器输出的四元数、光轴和横轴矢量,ZAB、XAB、YAB分别为星敏感器光轴、横轴、Y轴在星体系的安装位置,CBI为本体系相对惯性系的姿态矩阵,CBO为本体系相对轨道系的姿态矩阵,COI为轨道转换矩阵。函数Aq(·)为将四元数化为姿态矩阵的计算公式,函数Eq(·)为利用姿态角速度信息预估姿态四元数的计算公式,属于公知算法。
根据轨道信息,采用四阶以上地磁强度拟合算法计算得到在星体轨道系下的地磁强度Bo(此属于公知算法),则星本体地磁强度矢量为:
(6)采用动量轮进行姿态捕获和磁力矩器卸载,并利用红外地球敏感器和数字太阳敏感器或单独利用星敏感器确定卫星姿态,将卫星恢复至正常对地三轴稳定姿态
速率阻尼使星体三轴角动量小于动量轮允许角动量,就可切入三轴动量轮控制阶段,采用三轴动量轮控制,控制律的设计以动量轮不饱和为前提,并采用磁力矩器卸载,地磁强度根据轨道和姿态信息解算,消除卫星三轴的姿态和角速度,以便姿态和角速度较小后进入三轴正常对地任务的姿态。建立正常姿态包括:姿态控制误差确定和控制量计算。
姿态控制误差的计算公式为:
动量轮控制量计算:
上述公式中,Vci为动量轮控制电压(i=x,y,z),kpi和kdi分别为PD控制律的比例、微分参数,CUT为动量轮力矩电压系数。PD控制律的选取要考虑两种情况:一要尽量确保星体角速度在一定范围内,以利于星敏感器工作于跟踪模式;二是轮控作用后,动量轮不超过允许的角动量范围并有10%的余量,以解决动量轮输出受限的问题。
本发明未详细说明部分属本领域技术人员公知常识。
Claims (4)
1.一种欠驱动高速自旋卫星建立正常姿态的方法,其特征在于,包括如下步骤:
(1)利用姿态敏感器的输出数据确定欠驱动卫星的自旋轴:
根据所述姿态敏感器的测量精度和卫星自旋角速度的变化率确定对所述输出数据的采纳间隔;
根据所述采纳间隔获取所述输出数据,并进行有效性判断;
利用经所述有效性判断的输出数据确定所述自旋轴的方位和大小;
(3)对卫星进行欠驱动消旋、进动控制至所述陀螺退饱和:
确定所述消旋、进动控制的方向和大小;
确定与所述正常轴对应的喷气控制发动机与所述消旋、进动控制方向的几何关系;
确定进行消旋、进动控制的喷气发动机,并进行所述消旋、进动控制;
(4)所述陀螺退饱和后,对三轴角速度进行欠驱动控制:
根据所述陀螺测量获得的测量数据预估卫星姿态和角速度;
利用与所述正常轴对应的喷气发动机将所述三轴角速度阻尼到设定的阈值;
(5)确定并更新初始姿态四元数;
(6)采用动量轮进行姿态捕获和磁力矩器卸载,并确定卫星姿态,将卫星恢复至正常对地三轴稳定姿态。
2.如权利要求1所述建立正常姿态的方法,其特征在于:在所述步骤(1)中,若所述自旋角速度变化率较大,则采用较小的采纳间隔;若所述自旋角速度变化率较小,则采用较大的采纳间隔。
3.如权利要求1所述建立正常姿态的方法,其特征在于:在所述步骤(1)中采用几何法或代数法确定所述自旋轴的方位和大小。
4.如权利要求1所述建立正常姿态的方法,其特征在于:在所述步骤(6)中,采用红外地球敏感器和数字太阳敏感器或单独采用星敏感器进行姿态确定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013100363829A CN103112603B (zh) | 2013-01-30 | 2013-01-30 | 欠驱动高速自旋卫星建立正常姿态的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2013100363829A CN103112603B (zh) | 2013-01-30 | 2013-01-30 | 欠驱动高速自旋卫星建立正常姿态的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103112603A true CN103112603A (zh) | 2013-05-22 |
CN103112603B CN103112603B (zh) | 2013-11-20 |
Family
ID=48411005
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2013100363829A Active CN103112603B (zh) | 2013-01-30 | 2013-01-30 | 欠驱动高速自旋卫星建立正常姿态的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103112603B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105197261A (zh) * | 2015-08-24 | 2015-12-30 | 哈尔滨工业大学 | 面向在轨服务的快速翻滚目标消旋细胞帆及其工作方法 |
CN105883006A (zh) * | 2015-01-23 | 2016-08-24 | 北京空间飞行器总体设计部 | 一种深空再入返回服务平台和返回器分离姿态设计方法 |
CN106379560A (zh) * | 2016-08-30 | 2017-02-08 | 上海航天控制技术研究所 | 基于四元数信息的喷气控制方法 |
CN106494643A (zh) * | 2016-10-10 | 2017-03-15 | 北京控制工程研究所 | 一种基于地心矢量信息的卫星姿态异常恢复控制方法 |
CN108639385A (zh) * | 2018-05-15 | 2018-10-12 | 浙江大学 | 一种无基准最简姿控***快速稳定控制的实现方法 |
CN109625330A (zh) * | 2018-12-12 | 2019-04-16 | 上海航天控制技术研究所 | 一种基于角动量信息重复使用的卫星姿态控制方法 |
CN110543181A (zh) * | 2019-08-26 | 2019-12-06 | 北京电子工程总体研究所 | 一种欠驱动角度解耦姿态控制方法及*** |
CN111532456A (zh) * | 2020-05-15 | 2020-08-14 | 清华大学 | 一种控制方法和装置 |
CN112257222A (zh) * | 2020-09-08 | 2021-01-22 | 航天科工空间工程发展有限公司 | 弹道式再入起旋角速度计算方法、装置、存储介质和设备 |
CN112607064A (zh) * | 2020-12-25 | 2021-04-06 | 上海交通大学 | 避免进入自旋状态的微纳卫星磁阻尼控制方法 |
CN113624256A (zh) * | 2021-08-06 | 2021-11-09 | 中国人民解放军63691部队 | 船载天线前馈陀螺在线性能分析方法及*** |
Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100575878C (zh) * | 2008-11-18 | 2009-12-30 | 航天东方红卫星有限公司 | 一种卫星姿态快速挽救方法 |
-
2013
- 2013-01-30 CN CN2013100363829A patent/CN103112603B/zh active Active
Patent Citations (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN100575878C (zh) * | 2008-11-18 | 2009-12-30 | 航天东方红卫星有限公司 | 一种卫星姿态快速挽救方法 |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105883006A (zh) * | 2015-01-23 | 2016-08-24 | 北京空间飞行器总体设计部 | 一种深空再入返回服务平台和返回器分离姿态设计方法 |
CN105197261A (zh) * | 2015-08-24 | 2015-12-30 | 哈尔滨工业大学 | 面向在轨服务的快速翻滚目标消旋细胞帆及其工作方法 |
CN106379560A (zh) * | 2016-08-30 | 2017-02-08 | 上海航天控制技术研究所 | 基于四元数信息的喷气控制方法 |
CN106379560B (zh) * | 2016-08-30 | 2018-12-11 | 上海航天控制技术研究所 | 基于四元数信息的喷气控制方法 |
CN106494643A (zh) * | 2016-10-10 | 2017-03-15 | 北京控制工程研究所 | 一种基于地心矢量信息的卫星姿态异常恢复控制方法 |
CN108639385B (zh) * | 2018-05-15 | 2021-04-13 | 浙江大学 | 一种无基准最简姿控***快速稳定控制的实现方法 |
CN108639385A (zh) * | 2018-05-15 | 2018-10-12 | 浙江大学 | 一种无基准最简姿控***快速稳定控制的实现方法 |
CN109625330A (zh) * | 2018-12-12 | 2019-04-16 | 上海航天控制技术研究所 | 一种基于角动量信息重复使用的卫星姿态控制方法 |
CN109625330B (zh) * | 2018-12-12 | 2021-09-03 | 上海航天控制技术研究所 | 一种基于角动量信息重复使用的卫星姿态控制方法 |
CN110543181A (zh) * | 2019-08-26 | 2019-12-06 | 北京电子工程总体研究所 | 一种欠驱动角度解耦姿态控制方法及*** |
CN110543181B (zh) * | 2019-08-26 | 2022-08-30 | 北京电子工程总体研究所 | 一种欠驱动角度解耦姿态控制方法及*** |
CN111532456A (zh) * | 2020-05-15 | 2020-08-14 | 清华大学 | 一种控制方法和装置 |
CN111532456B (zh) * | 2020-05-15 | 2021-11-12 | 清华大学 | 一种控制方法和装置 |
CN112257222A (zh) * | 2020-09-08 | 2021-01-22 | 航天科工空间工程发展有限公司 | 弹道式再入起旋角速度计算方法、装置、存储介质和设备 |
CN112257222B (zh) * | 2020-09-08 | 2023-09-29 | 航天科工空间工程发展有限公司 | 弹道式再入起旋角速度计算方法、装置、存储介质和设备 |
CN112607064B (zh) * | 2020-12-25 | 2021-08-06 | 上海交通大学 | 避免进入自旋状态的微纳卫星磁阻尼控制方法 |
CN112607064A (zh) * | 2020-12-25 | 2021-04-06 | 上海交通大学 | 避免进入自旋状态的微纳卫星磁阻尼控制方法 |
CN113624256A (zh) * | 2021-08-06 | 2021-11-09 | 中国人民解放军63691部队 | 船载天线前馈陀螺在线性能分析方法及*** |
CN113624256B (zh) * | 2021-08-06 | 2023-08-25 | 中国人民解放军63691部队 | 船载天线前馈陀螺在线性能分析方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN103112603B (zh) | 2013-11-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103112603B (zh) | 欠驱动高速自旋卫星建立正常姿态的方法 | |
CN103092209B (zh) | 一种基于动量轮控制的全姿态捕获方法 | |
CN104527994B (zh) | 异面交叉快变轨道固定时间稳定姿态指向跟踪控制方法 | |
CN105700536B (zh) | 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法 | |
CN107797130B (zh) | 低轨航天器多点多参数轨道上行数据计算方法 | |
CN104898642A (zh) | 一种用于航天器姿态控制算法的集成测试仿真*** | |
Abdelrahman et al. | Simultaneous spacecraft attitude and orbit estimation using magnetic field vector measurements | |
CN101381004A (zh) | 基于大气阻力的微小卫星编队飞行控制方法及控制装置 | |
CN104656447A (zh) | 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法 | |
CN111061247A (zh) | 整星下飞轮角动量闭环控制的极性测试***及测试方法 | |
CN104570742A (zh) | 基于前馈pid控制的异面交叉快变轨道快速高精度相对指向控制方法 | |
CN104252574A (zh) | 一种基于空间系绳抓捕***的非合作目标质量辨识方法 | |
CN105629732A (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
Abdelrahman et al. | Sigma-point Kalman filtering for spacecraft attitude and rate estimation using magnetometer measurements | |
CN102004491B (zh) | 一种卫星初入轨段的初始太阳捕获方法 | |
CN108181916A (zh) | 小卫星相对姿态的控制方法及装置 | |
CN104309822A (zh) | 一种基于参数优化的航天器单脉冲水滴形绕飞轨迹悬停控制方法 | |
CN107132764A (zh) | 基于自抗扰控制技术的碎片抓捕后轨道转移控制方法 | |
CN109870273A (zh) | 基于动量守恒的航天器在轨质心辨识方法 | |
CN104192322A (zh) | 一种行星动力下降段轨迹在线生成的抗干扰制导控制方法 | |
Babcock | CubeSat attitude determination via Kalman filtering of magnetometer and solar cell data | |
CN106494643B (zh) | 一种基于地心矢量信息的卫星姿态异常恢复控制方法 | |
Anderson et al. | Attitude determination and control system simulation and analysis for low-cost micro-satellites | |
Hong et al. | Application of EKF for missile attitude estimation based on “SINS/CNS” integrated guidance system | |
Bayat et al. | A heuristic design method for attitude stabilization of magnetic actuated satellites |
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 |