CN115593657A - 一种卫星剩磁在轨标定方法 - Google Patents
一种卫星剩磁在轨标定方法 Download PDFInfo
- Publication number
- CN115593657A CN115593657A CN202211240115.9A CN202211240115A CN115593657A CN 115593657 A CN115593657 A CN 115593657A CN 202211240115 A CN202211240115 A CN 202211240115A CN 115593657 A CN115593657 A CN 115593657A
- Authority
- CN
- China
- Prior art keywords
- satellite
- moment
- residual magnetism
- calibrated
- residual
- 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
- 230000005389 magnetism Effects 0.000 title claims abstract description 41
- 238000000034 method Methods 0.000 title claims abstract description 34
- 238000005259 measurement Methods 0.000 claims description 48
- 230000007613 environmental effect Effects 0.000 claims description 30
- 239000011159 matrix material Substances 0.000 claims description 22
- 238000004364 calculation method Methods 0.000 claims description 12
- 230000008569 process Effects 0.000 claims description 8
- 230000009286 beneficial effect Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 238000013459 approach Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000005358 geomagnetic field Effects 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
- 230000008707 rearrangement Effects 0.000 description 1
- 238000005070 sampling Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/24—Guiding or controlling apparatus, e.g. for attitude control
- B64G1/244—Spacecraft control systems
- B64G1/245—Attitude control algorithms for spacecraft attitude control
Landscapes
- Engineering & Computer Science (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Chemical & Material Sciences (AREA)
- Combustion & Propulsion (AREA)
- Radar, Positioning & Navigation (AREA)
- Aviation & Aerospace Engineering (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种卫星剩磁在轨标定方法,利用卫星总角动量、卫星本体相对惯性系角速度、卫星磁控力矩以及卫星受到的环境干扰力矩建立卫星姿态动力学模型,将卫星受到的剩磁力矩近似等于环境干扰力矩,再利用三轴磁强计测量的磁场数据,反算出整星剩磁,便于后续利用磁力矩器对剩磁量进行在轨补偿,进而提高姿态控制精度。
Description
技术领域
本发明涉及航天器控制技术领域,尤其涉及一种卫星剩磁在轨标定方法。
背景技术
磁强计是以地球磁场为基准,测量卫星姿态最常用的敏感器,因具有价格低廉、质量轻、体积小、采样电路简单、性能稳定等优点,在卫星中得到广泛应用。为了降低卫星本体扰动磁场对磁强计测量值的影响,卫星通常将磁强计通过长杆伸出到卫星外部,由于磁场强度与磁体距离的三次方呈反比,因此增加距离可以降低磁场强度,从而提高磁强计的测量精度。但是微纳卫星由于收到体积、质量的限制,通常只能将磁强计安装在微纳卫星的星体内部,与其他部组件之间的距离较近。因此,当星体内的其他组件工作产生磁场时,会严重影响磁强计的测量精度。当磁强计测量的地磁场与真实磁场存在较大偏差,基于该测量值计算的卫星姿态精度较低。进一步地,对于微纳卫星体积很小,且卫星在低轨飞行,所受到的环境干扰主要是由剩磁引起的,因此如何对整星剩磁进行标定,利用磁力矩器对剩磁量进行在轨补偿,进而提高姿态控制精度也是需要解决的问题。
发明内容
本发明针对上述问题,提供了一种卫星剩磁在轨标定方法,利用陀螺和三轴磁强计在轨测量得到的数据,通过递推最小二乘估计对整星剩磁进行标定,便于利用磁力矩器对剩磁量进行在轨补偿,进而提高姿态控制精度。
本发明的一种卫星剩磁在轨标定方法,包括以下步骤:
步骤1、利用卫星总角动量、卫星本体相对惯性系角速度、卫星磁控力矩以及卫星受到的环境干扰力矩建立卫星姿态动力学模型;
步骤2、基于卫星的剩磁干扰力矩等于环境干扰力矩建立卫星t1时刻受到的环境干扰力矩与卫星三轴剩磁、t1时刻三轴磁强计测量的本体系下磁场量测矩阵之间的关系;
步骤3、建立待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的磁场量测矩阵之间的关系;
步骤4、利用待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的量测矩阵之间的关系,通过递推最小二乘法估计出待标定参数向量,即可得到卫星三轴剩磁距。
本发明的进一步技术方案为:随着测量次数的增加,在估计出待标定参数向量相对稳定后通过计算一段时间内待标定参数向量的标准差用于评估估计的稳定性。
本发明的进一步技术方案为:通过计算待标定参数向量估计值与实际剩磁矩之间的偏差占比确定估计值的准确性。
本发明的进一步技术方案为:所述卫星姿态动力学模型为:其中,H为卫星总角动量,等于卫星本体角动量Hb和飞轮角动量Hwb之和,ωbi为卫星本体相对惯性系角速度,Tm为卫星磁控力矩,Td为卫星受到的环境干扰力矩。
本发明的进一步技术方案为:步骤2中基于卫星的剩磁干扰力矩等于环境干扰力矩建立卫星t1时刻受到的环境干扰力矩与卫星三轴剩磁、t1时刻三轴磁强计测量的本体系下磁场量测矩阵之间的关系,具体表达式为:Td(t1)=mb×Bb(t1),其中Td(t1)为卫星t1时刻受到的环境干扰力矩,mb为卫星三轴剩磁矩,Bb(t1)为t1时刻三轴磁强计测量得到的本体系下磁场量测矩阵。
本发明的进一步技术方案为:步骤3中建立待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的磁场量测矩阵之间的关系,具体表达式为:Zi=HiX,其中,Zi表示第i次计算得到的环境干扰力矩,Hi为第i次测量的磁场量测矩阵,X表示待标定参数向量卫星三轴剩磁矩。
本发明的进一步技术方案为:所述递推最小二乘估计过程为:
本发明提供的一种卫星剩磁在轨标定方法,其产生的有益效果有:相对于现有技术,将卫星受到的剩磁力矩近似等于环境干扰力矩,再利用三轴磁强计测量的磁场数据,反算出整星剩磁,便于后续利用磁力矩器对剩磁量进行在轨补偿,进而提高姿态控制精度。
附图说明
图1是本发明实施例中卫星剩磁在轨标定方法流程图。
具体实施方式
下面结合附图和实施例对本发明作进一步的详细说明。可以理解的是,此处所描述的具体实施例仅仅用于解释本发明,而非对本发明的限定。另外还需要说明的是,为了便于描述,附图中仅出示了与本发明相关的部分而非全部。
在更加详细地讨论示例性实施例之前应当提到的是,一些示例性实施例被描述成作为流程图描绘的处理或方法。虽然流程图将各步骤描述成顺序的处理,但是其中的许多步骤可以被并行地、并发地或者同时实施。此外,各步骤的顺序可以被重新安排。当其操作完成时所述处理可以被终止,但是还可以具有未包括在附图中的附加步骤。所述处理可以对应于方法、函数、规程、子例程、子程序等等。
本发明实施例针对一种卫星剩磁在轨标定方法,方法利用陀螺确定的卫星本体相对惯性系角速度,通过刚体卫星姿态动力学方程反算出卫星所受到的空间环境干扰力矩,由于卫星体积很小,且卫星在低轨飞行,所受到的环境干扰主要是由剩磁引起的,因此将卫星受到的剩磁力矩近似等于总环境干扰力矩,再利用三轴磁强计测量的磁场数据,可以反算出整星剩磁。参见图1,包括以下步骤:
步骤1、利用卫星总角动量、卫星本体相对惯性系角速度、卫星磁控力矩以及卫星受到的环境干扰力矩建立卫星姿态动力学模型;
刚体卫星的姿态动力学方程即所述卫星姿态动力学模型为:其中,H为卫星总角动量,等于卫星本体角动量Hb和飞轮角动量Hwb之和,ωbi为卫星本体相对惯性系角速度,Tm为卫星磁控力矩,Td为卫星受到的环境干扰力矩。
具体地,卫星本体角动量Hb=Jωbi,式中J为卫星转动惯量矩阵,飞轮总角动量为:
式中,Cmw为飞轮的安装矩阵,Jw为飞轮转动惯量,ωWX、ωWY、ωWZ和ωWS分别为飞轮X、Y、Z和S的转速,其中X、Y、Z和S表示飞轮的编号,卫星配置4个飞轮,对于三正交加一斜装的构型方案,飞轮X、Y和Z代表正交安装的飞轮,飞轮S代表斜装的飞轮;对于其它构型方案,飞轮S表示第4个飞轮。
卫星总角动量变化率可由角动量差分近似得到
卫星姿态动力学方程变为
(Jωbi(t2)+Hwb(t2))-(Jωbi(t1)+Hwb(t1))+ωbi×(Jωbi(t1)+Hwb(t1))≈Tm(t1)+Td(t1)
因此有
Td(t1)=(Jωbi(t2)+Hwb(t2))-(Jωbi(t1)+Hwb(t1))+ωbi×(Jωbi(t1)+Hwb(t1))-Tm(t1)。
步骤2、基于卫星的剩磁干扰力矩等于环境干扰力矩建立卫星t1时刻受到的环境干扰力矩与卫星三轴剩磁、t1时刻三轴磁强计测量的本体系下磁场量测矩阵之间的关系;
卫星受到的剩磁干扰力矩近似等于总环境干扰力矩,具体表达式为:Td(t1)=mb×Bb(t1),其中Td(t1)为卫星t1时刻受到的环境干扰力矩,mb为卫星三轴剩磁矩,Bb(t1)为t1时刻三轴磁强计测量得到的本体系下磁场量测矩阵。
具体地,设Td(t1)=[Tdx Tdy Tdz]T,Bb(t1)=[Bbx Bby Bbz]T,mb=[mbx mby mbz]T,则有
防止进行递推最小二乘估计时发生奇异,左侧和右侧分别乘以同一较大正数p,优选为1×105,则有
步骤3、建立待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的磁场量测矩阵之间的关系;
具体地,X=mb=[mbx mby mbz]T为代标定的参数向量,第i次量测方程,具体表达式为:Zi=HiX,其中,Zi表示第i次计算得到的环境干扰力矩,Hi为第i次测量的磁场量测矩阵,X表示待标定参数向量卫星三轴剩磁矩。
步骤4、利用待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的量测矩阵之间的关系,通过递推最小二乘法估计出待标定参数向量,即可得到卫星三轴剩磁距。
具体地,递推最小二乘估计过程为:
进一步地,随着测量次数的增加,在估计出待标定参数向量相对稳定后通过计算一段时间内待标定参数向量的标准差用于评估估计的稳定性。
进一步地,通过计算待标定参数向量估计值与实际剩磁矩之间的偏差占比确定估计值的准确性。
具体实施过程中,由步骤1至步骤4可得到X在任意时刻的最小二乘估计,随着量测次数的增加,初值影响逐渐消失,估计值逐渐趋于稳定而逼近被估计值。只要有量测数据,可以继续进行计算,没有量测数据时则暂停计算。相对稳定后通过计算一段时间内X的标准差可以评估估计的稳定性。本估计方法获得的次数越多,修正的次数也越多,估计的精度也越高。
基于上述实施例的仿真实验
卫星质量为13kg,运行在轨道高度为500km降交点地方时为10:30AM的太阳同步轨道上,卫星对地三轴稳定,三轴剩磁假设为[0.1 0.1 0.1]TAm2。三轴磁强计的测量误差[8080 80]nT,零偏取值为[400 -300 500]nT;MEMS陀螺常值漂移[5 -5 5 -5]°/h,零偏稳定性为[10 -15 15 -10]°/h;卫星转动惯量偏差10%。仿真中同时考虑了剩磁干扰力矩、气动干扰力矩、太阳光压力矩和重力梯度力矩。
计算运行2000s时,本方法计算所得的三轴剩磁矩与实际剩磁矩[0.1 0.1 0.1]TAm2的偏差降到3%以下,趋于稳定。运行8000s后,X轴剩磁最大偏差值为0.0016Am2,偏差占比1.6%(偏差除以实际剩磁矩),Y轴剩磁最大偏差为0.0023Am2,偏差占比2.3%,Z轴剩磁最大偏差为0.0022Am2,偏差占比2.2%,可认为估计值已经稳定,估计精度为2.3%。
综合上述实施例提供的一种卫星剩磁在轨标定方法,其产生的有益效果有:相对于现有技术,将卫星受到的剩磁力矩近似等于环境干扰力矩,再利用三轴磁强计测量的磁场数据,反算出整星剩磁,便于后续利用磁力矩器对剩磁量进行在轨补偿,进而提高姿态控制精度。
注意,上述仅为本发明的较佳实施例及所运用技术原理。本领域技术人员会理解,本发明不限于这里所述的特定实施例,对本领域技术人员来说能够进行各种明显的变化、重新调整和替代而不会脱离本发明的保护范围。因此,虽然通过以上实施例对本发明进行了较为详细的说明,但是本发明不仅仅限于以上实施例,在不脱离本发明构思的情况下,还可以包括更多其他等效实施例,而本发明的范围由所附的权利要求范围决定。
Claims (7)
1.一种卫星剩磁在轨标定方法,其特征在于,所述方法包括以下步骤:
步骤1、利用卫星总角动量、卫星本体相对惯性系角速度、卫星磁控力矩以及卫星受到的环境干扰力矩建立卫星姿态动力学模型;
步骤2、基于卫星的剩磁干扰力矩等于环境干扰力矩建立卫星t1时刻受到的环境干扰力矩与卫星三轴剩磁、t1时刻三轴磁强计测量的本体系下磁场量测矩阵之间的关系;
步骤3、建立待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的磁场量测矩阵之间的关系;
步骤4、利用待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的量测矩阵之间的关系,通过递推最小二乘法估计出待标定参数向量,即可得到卫星三轴剩磁距。
2.根据权利要求1所述的卫星剩磁在轨标定方法,其特征在于,随着测量次数的增加,在估计出待标定参数向量相对稳定后通过计算一段时间内待标定参数向量的标准差用于评估估计的稳定性。
3.根据权利要求2所述的卫星剩磁在轨标定方法,其特征在于,通过计算待标定参数向量估计值与实际剩磁矩之间的偏差占比确定估计值的准确性。
5.根据权利要求1所述的卫星剩磁在轨标定方法,其特征在于,步骤2中基于卫星的剩磁干扰力矩等于环境干扰力矩建立卫星t1时刻受到的环境干扰力矩与卫星三轴剩磁、t1时刻三轴磁强计测量的本体系下磁场量测矩阵之间的关系,具体表达式为:Td(t1)=mb×Bb(t1),其中Td(t1)为卫星t1时刻受到的环境干扰力矩,mb为卫星三轴剩磁矩,Bb(t1)为t1时刻三轴磁强计测量得到的本体系下磁场量测矩阵。
6.根据权利要求1所述的卫星剩磁在轨标定方法,其特征在于,步骤3中建立待标定参数向量卫星三轴剩磁矩与第i次计算得到的环境干扰力矩、第i次测量的磁场量测矩阵之间的关系,具体表达式为:Zi=HiX,其中,Zi表示第i次计算得到的环境干扰力矩,Hi为第i次测量的磁场量测矩阵,X表示待标定参数向量卫星三轴剩磁矩。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211240115.9A CN115593657B (zh) | 2022-10-11 | 2022-10-11 | 一种卫星剩磁在轨标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202211240115.9A CN115593657B (zh) | 2022-10-11 | 2022-10-11 | 一种卫星剩磁在轨标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115593657A true CN115593657A (zh) | 2023-01-13 |
CN115593657B CN115593657B (zh) | 2024-07-23 |
Family
ID=84846898
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202211240115.9A Active CN115593657B (zh) | 2022-10-11 | 2022-10-11 | 一种卫星剩磁在轨标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115593657B (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5702067A (en) * | 1994-09-10 | 1997-12-30 | Daimler-Benz Aerospace Ag | Method and apparatus for determining the angular momentum vector of a satellite |
WO2017041325A1 (zh) * | 2015-09-07 | 2017-03-16 | 中国科学院地质与地球物理研究所 | 一种基于磁场的微振动测量装置及其测量方法 |
CN108802653A (zh) * | 2018-06-15 | 2018-11-13 | 上海卫星工程研究所 | 基于地磁场特性的卫星磁强计磁环境分析方法 |
CN112319857A (zh) * | 2020-10-12 | 2021-02-05 | 中山大学 | 一种用于远距离分布式卫星的组合姿态控制方法及*** |
-
2022
- 2022-10-11 CN CN202211240115.9A patent/CN115593657B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US5702067A (en) * | 1994-09-10 | 1997-12-30 | Daimler-Benz Aerospace Ag | Method and apparatus for determining the angular momentum vector of a satellite |
WO2017041325A1 (zh) * | 2015-09-07 | 2017-03-16 | 中国科学院地质与地球物理研究所 | 一种基于磁场的微振动测量装置及其测量方法 |
CN108802653A (zh) * | 2018-06-15 | 2018-11-13 | 上海卫星工程研究所 | 基于地磁场特性的卫星磁强计磁环境分析方法 |
CN112319857A (zh) * | 2020-10-12 | 2021-02-05 | 中山大学 | 一种用于远距离分布式卫星的组合姿态控制方法及*** |
Non-Patent Citations (3)
Title |
---|
WILLIAM J. WEBSTER; PATRICK T. TAYLOR; CHARLES C. SCHNETZLER; ROBERT A. LANGEL: "The Magnetic Field of the Earth: Performance Considerations for Space-Based Observing Systems", 《IEEE TRANSACTIONS ON GEOSCIENCE AND REMOTE SENSING》, 31 July 1985 (1985-07-31) * |
许永生;郑靖;王涛;李春;黄维达;吕红强: "空间站在轨组装的微纳卫星模块化设计与集成方法", 《航天器工程》, 15 February 2022 (2022-02-15) * |
郁丰;刘建业;熊智: "微小卫星剩磁在轨标定技术研究", 《航空学报》, 15 September 2007 (2007-09-15) * |
Also Published As
Publication number | Publication date |
---|---|
CN115593657B (zh) | 2024-07-23 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Searcy et al. | Magnetometer-only attitude determination using novel two-step Kalman filter approach | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN103630146B (zh) | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 | |
CN107024674A (zh) | 一种基于递推最小二乘法的磁强计现场快速标定方法 | |
CN105509769B (zh) | 一种运载火箭捷联惯导全自主对准方法 | |
CN103076025B (zh) | 一种基于双解算程序的光纤陀螺常值误差标定方法 | |
CN104764463B (zh) | 一种惯性平台调平瞄准误差的自检测方法 | |
CN104483973A (zh) | 基于滑模观测器的低轨挠性卫星姿态跟踪控制方法 | |
CN110296719B (zh) | 一种在轨标定方法 | |
Abdelrahman et al. | Sigma-point Kalman filtering for spacecraft attitude and rate estimation using magnetometer measurements | |
Li et al. | Low-cost MEMS sensor-based attitude determination system by integration of magnetometers and GPS: A real-data test and performance evaluation | |
CN110285815A (zh) | 一种可在轨全程应用的微纳卫星多源信息姿态确定方法 | |
CN107246883A (zh) | 一种高精度星敏感器安装矩阵在轨实时校准方法 | |
CN111189474A (zh) | 基于mems的marg传感器的自主校准方法 | |
CN112461262A (zh) | 一种校正三轴磁强计误差的装置和方法 | |
CN115754861A (zh) | 一种卫星磁强计在轨标定方法 | |
Chen et al. | Research on the calibration method of MEMS accelerometer based on recursive least squares | |
CN110375773B (zh) | Mems惯导***姿态初始化方法 | |
Ticona et al. | Attitude determination and control system for nadir pointing and detumbling using magnetorquer for 1u bolivian cubesat | |
CN115593657B (zh) | 一种卫星剩磁在轨标定方法 | |
Ahn et al. | Gyroless attitude estimation of sun-pointing satellites using magnetometers | |
CN112034402B (zh) | 微纳卫星的剩磁和剩磁矩联合标定方法 | |
CN115931001A (zh) | 惯性测量单元标定方法、装置、计算机设备及存储介质 | |
CN111649738B (zh) | 微重力场下的加速度计初始姿态解算方法 | |
CN108871312A (zh) | 一种重力梯度仪及星敏感器的联合定姿方法 |
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 |