CN109489661A - 一种卫星初始入轨时陀螺组合常值漂移估计方法 - Google Patents
一种卫星初始入轨时陀螺组合常值漂移估计方法 Download PDFInfo
- Publication number
- CN109489661A CN109489661A CN201811302421.4A CN201811302421A CN109489661A CN 109489661 A CN109489661 A CN 109489661A CN 201811302421 A CN201811302421 A CN 201811302421A CN 109489661 A CN109489661 A CN 109489661A
- Authority
- CN
- China
- Prior art keywords
- constant value
- gyro
- value drift
- orbit
- satellite
- 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
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
- Gyroscopes (AREA)
Abstract
一种卫星初始入轨时陀螺组合常值漂移估计方法,涉及卫星姿态确定技术领域;包括如下步骤:步骤一、星体内部设置有陀螺组合和星敏感器;计算星体三轴姿态角速度估计值;步骤二、计算星体三轴姿态角速度常值漂移;步骤三、计算陀螺组合的常值漂移;步骤四、重复步骤一至步骤三n次,并计算n次陀螺组合常值漂移的均值;n为正整数,且3≤n≤5;本发明解决了卫星入轨后在系统还未稳定且以轨道罗盘为姿态基准时估计陀螺组合常值漂移的问题。
Description
技术领域
本发明涉及一种卫星姿态确定技术领域,特别是一种卫星初始入轨时陀螺组合常值漂移估计方法。
背景技术
陀螺用于敏感卫星的惯性角速度,是卫星姿态确定系统中主要的惯性测量部件。目前卫星上配置的陀螺类型主要有半液浮陀螺、液浮陀螺、光纤陀螺、半球谐振陀螺,无论哪种类型的陀螺,陀螺测量值中均存在常值漂移误差。该项误差是制约陀螺组合不能长时间单独作为姿态基准的重要因素。当陀螺组合结合地平仪构建轨道罗盘算法时,虽然算法稳定可以长时间作为姿态基准,但系统稳定后的姿态偏差仍然主要由陀螺组合的常值漂移决定。为了达到高精度姿态确定的目的,需要较为精确地估计出陀螺组合的常值漂移。
根据国内外已发表的相关文献可知,目前对于陀螺组合常值漂移的估计方法有:(1)卫星在地面测试时基于转台等方法估计陀螺组合的常值漂移;(2)卫星在轨系统稳定后基于星敏感器与陀螺构建kalman滤波算法等方式估计陀螺组合的常值漂移。
但是,上述方法均存在一定的局限性,比如转台测试的方法仅限于地面测试时使用,而根据历次飞行数据可知,卫星在主动段飞行时振动较大,陀螺组合的常值漂移会发生变化,因此地面测试中估计出的常值漂移与星上真实状态存在偏差。另一种方案中,虽然是根据在轨相关敏感器信息实时估计陀螺组合的常值漂移,但是该估计方式主要用于卫星已经稳定且当前姿态基准为星敏感器的工况下,不适合卫星在初始入轨系统还未稳定且姿态基准为轨道罗盘时使用。
发明内容
本发明的目的在于克服现有技术的上述不足,提供一种卫星初始入轨时陀螺组合常值漂移估计方法,解决了卫星入轨后在系统还未稳定且以轨道罗盘为姿态基准时估计陀螺组合常值漂移的问题。
本发明的上述目的是通过如下技术方案予以实现的:
一种卫星初始入轨时陀螺组合常值漂移估计方法,包括如下步骤:
步骤一、星体内部设置有陀螺组合和星敏感器;计算星体三轴姿态角速度估计值
步骤二、计算星体三轴姿态角速度常值漂移
步骤三、计算陀螺组合的常值漂移
步骤四、重复步骤一至步骤三n次,并计算n次陀螺组合常值漂移的均值n为正整数。
在上述的一种卫星初始入轨时陀螺组合常值漂移估计方法,所述步骤一中,星体三轴姿态角速度估计值的计算方法为:
其中,ωbi为卫星三轴惯性角速度,由陀螺组合测量得到;
ω0为轨道角速度,由轨道高度测量得到;
Ab←o为姿态方向余弦阵,由星敏感器测量得到。
在上述的一种卫星初始入轨时陀螺组合常值漂移估计方法,所述步骤二中,星体三轴姿态角速度常值漂移的计算方法为:
其中,ωST为星敏感器的伪速率。
在上述的一种卫星初始入轨时陀螺组合常值漂移估计方法,所述星敏感器的伪速率ωST的计算方法为:
其中,θ(k)为星敏感器当前时刻测量得到的三轴姿态角;
θ(k-1)为星敏感器上一时刻测量得到的三轴姿态角;
Tc为星载控制系统的控制周期。
在上述的一种卫星初始入轨时陀螺组合常值漂移估计方法,所述步骤三中,陀螺组合的常值漂移的计算方法为:
其中,As←b为陀螺组合的安装矩阵,使用前测得。
在上述的一种卫星初始入轨时陀螺组合常值漂移估计方法,所述步骤四中,常值漂移的均值的计算方法为:
在上述的一种卫星初始入轨时陀螺组合常值漂移估计方法,所述步骤四中,3≤n≤5。
本发明与现有技术相比具有如下优点:
(1)本发明根据在轨实测数据估计陀螺组合常值漂移,相对于地面测试结果更为准确;
(2)本发明的方法原理清晰,算法简单,应用场景更为广泛,既可应用于卫星入轨后在系统还未稳定且以轨道罗盘为姿态基准时的工况,也可应用于卫星系统稳定时的工况。
附图说明
图1为本发明常值漂移的估计流程图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步详细的描述:
本发明提供一种卫星初始入轨时陀螺组合常值漂移估计方法,基于星敏感器和陀螺的实时测量数据求解卫星运动学方程,解决了卫星入轨后在系统还未稳定且以轨道罗盘为姿态基准时估计陀螺组合常值漂移的问题。该方法原理清晰,算法简单,应用场景更为广泛。
本发明提供一种如图1所示为常值漂移的估计流程图,由图可知,一种卫星初始入轨时陀螺组合常值漂移估计方法,包括如下步骤:
步骤一、星体内部设置有陀螺组合和星敏感器;计算星体三轴姿态角速度估计值
星体三轴姿态角速度估计值的计算方法为:
其中,ωbi为卫星三轴惯性角速度,由陀螺组合测量得到;
ω0为轨道角速度,由轨道高度测量得到;
Ab←o为姿态方向余弦阵,由星敏感器测量得到。
步骤二、计算星体三轴姿态角速度常值漂移
星体三轴姿态角速度常值漂移的计算方法为:
其中,ωST为星敏感器的伪速率。
星敏感器的伪速率ωST的计算方法为:
其中,θ(k)为星敏感器当前时刻测量得到的三轴姿态角;
θ(k-1)为星敏感器上一时刻测量得到的三轴姿态角;
Tc为星载控制系统的控制周期。
步骤三、计算陀螺组合的常值漂移
陀螺组合的常值漂移的计算方法为:
其中,As←b为陀螺组合的安装矩阵,使用前测得。
步骤四、重复步骤一至步骤三n次,并计算n次陀螺组合常值漂移的均值n为正整数,且3≤n≤5。
常值漂移的均值的计算方法为:
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (7)
1.一种卫星初始入轨时陀螺组合常值漂移估计方法,其特征在于:包括如下步骤:
步骤一、星体内部设置有陀螺组合和星敏感器;计算星体三轴姿态角速度估计值
步骤二、计算星体三轴姿态角速度常值漂移
步骤三、计算陀螺组合的常值漂移
步骤四、重复步骤一至步骤三n次,并计算n次陀螺组合常值漂移的均值n为正整数。
2.根据权利要求1所述的一种卫星初始入轨时陀螺组合常值漂移估计方法,其特征在于:所述步骤一中,星体三轴姿态角速度估计值的计算方法为:
其中,ωbi为卫星三轴惯性角速度,由陀螺组合测量得到;
ω0为轨道角速度,由轨道高度测量得到;
Ab←o为姿态方向余弦阵,由星敏感器测量得到。
3.根据权利要求2所述的一种卫星初始入轨时陀螺组合常值漂移估计方法,其特征在于:所述步骤二中,星体三轴姿态角速度常值漂移的计算方法为:
其中,ωST为星敏感器的伪速率。
4.根据权利要求3所述的一种卫星初始入轨时陀螺组合常值漂移估计方法,其特征在于:所述星敏感器的伪速率ωST的计算方法为:
其中,θ(k)为星敏感器当前时刻测量得到的三轴姿态角;
θ(k-1)为星敏感器上一时刻测量得到的三轴姿态角;
Tc为星载控制系统的控制周期。
5.根据权利要求4所述的一种卫星初始入轨时陀螺组合常值漂移估计方法,其特征在于:所述步骤三中,陀螺组合的常值漂移的计算方法为:
其中,As←b为陀螺组合的安装矩阵,使用前测得。
6.根据权利要求5所述的一种卫星初始入轨时陀螺组合常值漂移估计方法,其特征在于:所述步骤四中,常值漂移的均值的计算方法为:
。
7.根据权利要求6所述的一种卫星初始入轨时陀螺组合常值漂移估计方法,其特征在于:所述步骤四中,3≤n≤5。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811302421.4A CN109489661B (zh) | 2018-11-02 | 2018-11-02 | 一种卫星初始入轨时陀螺组合常值漂移估计方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811302421.4A CN109489661B (zh) | 2018-11-02 | 2018-11-02 | 一种卫星初始入轨时陀螺组合常值漂移估计方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109489661A true CN109489661A (zh) | 2019-03-19 |
CN109489661B CN109489661B (zh) | 2020-06-09 |
Family
ID=65692104
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811302421.4A Active CN109489661B (zh) | 2018-11-02 | 2018-11-02 | 一种卫星初始入轨时陀螺组合常值漂移估计方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109489661B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110296719A (zh) * | 2019-08-07 | 2019-10-01 | 中南大学 | 一种在轨标定方法 |
CN110816889A (zh) * | 2019-11-14 | 2020-02-21 | 中国科学院微小卫星创新研究院 | 遥感微纳卫星系统 |
CN113008272A (zh) * | 2021-03-08 | 2021-06-22 | 航天科工空间工程发展有限公司 | 一种用于微小卫星的mems陀螺在轨常值漂移标定方法和系统 |
CN113432623A (zh) * | 2021-06-24 | 2021-09-24 | 中国船舶重工集团公司第七0七研究所 | 一种陀螺仪系统测试用漂移解算分析方法 |
Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0678732A1 (fr) * | 1992-10-29 | 1995-10-25 | AEROSPATIALE Société Nationale Industrielle | Procédé et appareil de calibration des gyromètres d'un satellite stabilisé 3-axes |
CN101196398A (zh) * | 2007-05-25 | 2008-06-11 | 北京航空航天大学 | 一种基于Euler-q算法和DD2滤波的航天器姿态确定方法 |
CN101214860A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 轨控过程中自主选取定姿方式的方法 |
CN102937450A (zh) * | 2012-10-31 | 2013-02-20 | 北京控制工程研究所 | 一种基于陀螺测量信息的相对姿态确定方法 |
CN103940451A (zh) * | 2014-04-30 | 2014-07-23 | 北京控制工程研究所 | 基于零空间向量自主优化选择的冗余陀螺故障定位方法 |
CN104833375A (zh) * | 2015-05-19 | 2015-08-12 | 北京控制工程研究所 | 一种借助星敏感器的imu两位置对准方法 |
CN106568436A (zh) * | 2016-10-26 | 2017-04-19 | 上海航天控制技术研究所 | 一种利用陀螺修正星敏感器轨道周期系统误差的方法 |
CN106767767A (zh) * | 2016-11-23 | 2017-05-31 | 上海航天控制技术研究所 | 一种微纳多模星敏感器系统及其数据融合方法 |
CN106989761A (zh) * | 2017-05-25 | 2017-07-28 | 北京航天自动控制研究所 | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 |
CN107228674A (zh) * | 2017-06-06 | 2017-10-03 | 上海航天控制技术研究所 | 一种针对星敏感器和陀螺联合滤波的改进方法 |
CN107702710A (zh) * | 2017-08-17 | 2018-02-16 | 上海航天控制技术研究所 | 一种多陀螺表头常值漂移实时估计方法 |
CN108225337A (zh) * | 2017-12-28 | 2018-06-29 | 西安电子科技大学 | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 |
-
2018
- 2018-11-02 CN CN201811302421.4A patent/CN109489661B/zh active Active
Patent Citations (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP0678732A1 (fr) * | 1992-10-29 | 1995-10-25 | AEROSPATIALE Société Nationale Industrielle | Procédé et appareil de calibration des gyromètres d'un satellite stabilisé 3-axes |
CN101196398A (zh) * | 2007-05-25 | 2008-06-11 | 北京航空航天大学 | 一种基于Euler-q算法和DD2滤波的航天器姿态确定方法 |
CN101214860A (zh) * | 2007-12-26 | 2008-07-09 | 北京控制工程研究所 | 轨控过程中自主选取定姿方式的方法 |
CN102937450A (zh) * | 2012-10-31 | 2013-02-20 | 北京控制工程研究所 | 一种基于陀螺测量信息的相对姿态确定方法 |
CN103940451A (zh) * | 2014-04-30 | 2014-07-23 | 北京控制工程研究所 | 基于零空间向量自主优化选择的冗余陀螺故障定位方法 |
CN104833375A (zh) * | 2015-05-19 | 2015-08-12 | 北京控制工程研究所 | 一种借助星敏感器的imu两位置对准方法 |
CN106568436A (zh) * | 2016-10-26 | 2017-04-19 | 上海航天控制技术研究所 | 一种利用陀螺修正星敏感器轨道周期系统误差的方法 |
CN106767767A (zh) * | 2016-11-23 | 2017-05-31 | 上海航天控制技术研究所 | 一种微纳多模星敏感器系统及其数据融合方法 |
CN106989761A (zh) * | 2017-05-25 | 2017-07-28 | 北京航天自动控制研究所 | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 |
CN107228674A (zh) * | 2017-06-06 | 2017-10-03 | 上海航天控制技术研究所 | 一种针对星敏感器和陀螺联合滤波的改进方法 |
CN107702710A (zh) * | 2017-08-17 | 2018-02-16 | 上海航天控制技术研究所 | 一种多陀螺表头常值漂移实时估计方法 |
CN108225337A (zh) * | 2017-12-28 | 2018-06-29 | 西安电子科技大学 | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 |
Non-Patent Citations (1)
Title |
---|
谢睿达: "基于星敏感器/陀螺的卫星姿态确定系统标定技术研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110296719A (zh) * | 2019-08-07 | 2019-10-01 | 中南大学 | 一种在轨标定方法 |
CN110296719B (zh) * | 2019-08-07 | 2020-07-14 | 中南大学 | 一种在轨标定方法 |
CN110816889A (zh) * | 2019-11-14 | 2020-02-21 | 中国科学院微小卫星创新研究院 | 遥感微纳卫星系统 |
CN110816889B (zh) * | 2019-11-14 | 2021-03-26 | 中国科学院微小卫星创新研究院 | 遥感微纳卫星系统 |
CN113008272A (zh) * | 2021-03-08 | 2021-06-22 | 航天科工空间工程发展有限公司 | 一种用于微小卫星的mems陀螺在轨常值漂移标定方法和系统 |
CN113008272B (zh) * | 2021-03-08 | 2022-04-19 | 航天科工空间工程发展有限公司 | 一种用于微小卫星的mems陀螺在轨常值漂移标定方法和系统 |
CN113432623A (zh) * | 2021-06-24 | 2021-09-24 | 中国船舶重工集团公司第七0七研究所 | 一种陀螺仪系统测试用漂移解算分析方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109489661B (zh) | 2020-06-09 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP1582840B1 (en) | Inertial navigation system error correction | |
CN109489661A (zh) | 一种卫星初始入轨时陀螺组合常值漂移估计方法 | |
CN104698486B (zh) | 一种分布式pos用数据处理计算机系统实时导航方法 | |
CN105371844B (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
CN105091907B (zh) | Sins/dvl组合中dvl方位安装误差估计方法 | |
CN110954102B (zh) | 用于机器人定位的磁力计辅助惯性导航系统及方法 | |
CN112432642B (zh) | 一种重力灯塔与惯性导航融合定位方法及系统 | |
CN103063216B (zh) | 一种基于星像坐标建模的惯性与天文组合导航方法 | |
CN104344837A (zh) | 一种基于速度观测的冗余惯导系统加速度计系统级标定方法 | |
CN109073388B (zh) | 旋磁地理定位系统 | |
CN105571578A (zh) | 一种利用伪观测取代精密转台的原地旋转调制寻北方法 | |
CN108627152A (zh) | 一种微型无人机基于多传感器数据融合的导航方法 | |
CN102052921A (zh) | 一种单轴旋转捷联惯导系统初始航向的确定方法 | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法 | |
CN103542853A (zh) | 一种估计加速度计漂移的绝对导航滤波方法 | |
CN107702710B (zh) | 一种多陀螺表头常值漂移实时估计方法 | |
Whittaker et al. | Inertial navigation employing common frame error representations | |
Whittaker et al. | Linearized analysis of inertial navigation employing common frame error representations | |
Avrutov | Autonomous determination of initial latitude with an inertial measuring unit | |
CN106643726B (zh) | 一种统一惯性导航解算方法 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 | |
CN105300407B (zh) | 一种用于单轴调制激光陀螺惯导系统的海上动态启动方法 | |
US5941935A (en) | Azimuth-axis drift rate determination in an inertial navigator | |
CN112697143B (zh) | 高精度载体动态姿态测量方法及系统 | |
CN107764268B (zh) | 一种机载分布式pos传递对准的方法和装置 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |