CN107215482A - 利用磁强计信息实现喷气速率阻尼的方法 - Google Patents
利用磁强计信息实现喷气速率阻尼的方法 Download PDFInfo
- Publication number
- CN107215482A CN107215482A CN201710418922.8A CN201710418922A CN107215482A CN 107215482 A CN107215482 A CN 107215482A CN 201710418922 A CN201710418922 A CN 201710418922A CN 107215482 A CN107215482 A CN 107215482A
- Authority
- CN
- China
- Prior art keywords
- mtd
- msub
- mrow
- satellite
- jet
- 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.)
- Pending
Links
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/26—Guiding or controlling apparatus, e.g. for attitude control using jets
-
- 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/242—Orbits and trajectories
Abstract
本发明涉及一种利用磁强计信息实现喷气速率阻尼的方法,包含:S1、采用磁强计测量得到地磁场强度B,计算地磁场强度B的矢量在体坐标系中对时间的微分构造地磁场强度B的斜对称矩阵并求解该斜对称矩阵的伪逆矩阵S2、根据公式计算得到卫星本体坐标系相对惯性系的角速率矢量,即卫星角速率ω;S3、根据解算得到的卫星角速率ω,控制推力器的喷气宽度,对卫星进行喷气速率阻尼,将卫星角速率ω降低并控制在敏感器可工作的速率范围内。本发明采用磁强计测得的地磁场强度信息,来解算卫星角速率,并以此实现卫星的喷气速率阻尼;无需依赖陀螺组合信息,工作简单可靠,价格低廉。
Description
技术领域
本发明涉及一种卫星速率阻尼的方法,具体是指当卫星失稳进入全姿态捕获模式后,利用磁强计信息控制喷气实现卫星速率阻尼的方法。
背景技术
当卫星失稳进入全姿态捕获模式后,首先要对其进行速率阻尼,用于将卫星的角速率控制到敏感器可工作的速率范围内,以便进入捕获太阳和对日定向等后续工作模式。传统的速率阻尼方法是采用陀螺组合测得卫星角速率来控制推力器喷气输出,从而将卫星角速率阻尼在一定范围内。然而,陀螺组合的寿命一直是制约卫星寿命的主要部件之一,且陀螺组合的成本昂贵。因此,寻求一种不依赖陀螺组合的速率阻尼方法是当前非常必要的。
发明内容
本发明的目的是提供一种利用磁强计信息实现喷气速率阻尼的方法,采用磁强计测得的地磁场强度信息,来解算卫星角速率,并以此实现卫星的喷气速率阻尼;无需依赖陀螺组合信息,工作简单可靠,价格低廉。
为实现上述目的,本发明提供一种利用磁强计信息实现喷气速率阻尼的方法,包含以下步骤:
S1、采用磁强计测量得到地磁场强度B,计算地磁场强度B的矢量在体坐标系中对时间的微分构造地磁场强度B的斜对称矩阵并求解该斜对称矩阵的伪逆矩阵
S2、根据公式计算得到卫星本体坐标系相对惯性系的角速率矢量,即卫星角速率ω;
S3、根据解算得到的卫星角速率ω,控制推力器的喷气宽度,对卫星进行喷气速率阻尼,将卫星角速率ω降低并控制在敏感器可工作的速率范围内。
所述的S1中,具体包含以下步骤:
S11、利用磁强计测量得到地磁场强度B:
S12、计算地磁场强度B的矢量在体坐标系中对时间的微分
S13、构造地磁场强度B的斜对称矩阵
并求解斜对称矩阵的伪逆矩阵
所述的S2中,具体包含以下步骤:
S21、地磁场的变化表示为:
令
得
其中,为地磁场强度B的矢量在惯性系中对时间的微分,记为为地磁场强度B的矢量在体坐标系中对时间的微分,记为
S22、地磁场强度B的矢量在卫星轨道平面内的周期性变化,相对于卫星角速率ω可忽略不计,即
S23、根据S21和S22可得:
以矩阵表示可解得:
所述的S3中,具体包含以下步骤:
S31、设定三轴喷气规律:
设置三档卫星角速率阈值ωx1、ωx2、ωx3,且ωx1<ωx2<ωx3;并限定:
当ω>ωx3时,设置推力器的喷气宽度为-T3;
当ωx2<ω<ωx3时,设置推力器的喷气宽度为-T2;
当ωx1<ω<ωx2时,设置推力器的喷气宽度为-T1;
S32、在对卫星进行喷气速率阻尼时,根据解算得到的卫星角速率ω,按照三轴喷气规律设定推力器的喷气宽度,使卫星角速率ω逐渐减小;在减小过程中,当卫星角速率ω经过阈值ωx1、ωx2、ωx3时,按照三轴喷气规律对应调整推力器的喷气宽度。
所述的S31中,喷气宽度满足T1≤T2≤T3≤T,其中,T为控制周期,T1需大于推力器的最小稳定喷气宽度。
所述的S31中,三档卫星角速率阈值中的最小值ωx1由T1喷气量产生的卫星角速度决定。
综上所述,本发明所提供的利用磁强计信息实现喷气速率阻尼的方法,采用磁强计测得的地磁场强度信息,来解算卫星角速率,并将其作为控制输入来实现卫星的喷气速率阻尼。因此,本发明无需依赖陀螺组合信息,工作简单可靠,价格低廉。或者,本发明也能够作为陀螺组合故障情况下的备份方案,以进一步保障卫星运行的可靠性。
附图说明
图1为本发明中的利用磁强计信息实现喷气速率阻尼的方法示意图。
具体实施方式
以下结合图1,详细说明本发明的一个优选实施例。
如图1所示,为本发明所提供的利用磁强计信息实现喷气速率阻尼的方法,包含以下步骤:
S1、采用磁强计测量得到地磁场强度B,计算地磁场强度B的矢量在体坐标系中对时间的微分构造地磁场强度B的斜对称矩阵并求解该斜对称矩阵的伪逆矩阵
S2、根据公式计算得到卫星本体坐标系相对惯性系的角速率矢量,即卫星角速率ω;
S3、根据解算得到的卫星角速率ω,控制推力器的喷气宽度,对卫星进行喷气速率阻尼,将卫星角速率ω降低并控制在敏感器可工作的速率范围内。
所述的S1中,具体包含以下步骤:
S11、利用磁强计测量得到地磁场强度B:
S12、计算地磁场强度B的矢量在体坐标系中对时间的微分
S13、构造地磁场强度B的斜对称矩阵
并求解斜对称矩阵的伪逆矩阵
所述的S2中,具体包含以下步骤:
S21、地磁场的变化表示为:
令
得
其中,为地磁场强度B的矢量在惯性系中对时间的微分,记为 为地磁场强度B的矢量在体坐标系中对时间的微分,记为
S22、地磁场强度B的矢量在卫星轨道平面内以2ω0的角频率作周期性变化,其中ω0为卫星轨道角速度,但相对于卫星角速率ω而言非常小,小到可忽略不计,即可认为
S23、根据S21和S22可得:
以矩阵表示可解得:
如图1所示,所述的S3中,根据解算得到的卫星角速率ω、卫星质量特性和推力器特性,设计三轴喷气规律以实现喷气速率阻尼;具体包含以下步骤:
S31、设置三档卫星角速率阈值ωx1、ωx2、ωx3,且ωx1<ωx2<ωx3;并进一步限定:
当ω>ωx3时,设置推力器的喷气宽度为-T3;
当ωx2<ω<ωx3时,设置推力器的喷气宽度为-T2;
当ωx1<ω<ωx2时,设置推力器的喷气宽度为-T1;
其中,喷气宽度即为喷气的持续时间,表明喷气量的强度;当卫星角速率为正时,喷气宽度取负,表示其需要减小卫星角速率ω的值,相反当卫星角速率为负时,喷气宽度需要取正;
S32、在对卫星进行喷气速率阻尼时,根据解算得到的卫星角速率ω,按照上述的三轴喷气规律设定推力器的喷气宽度,使卫星角速率ω逐渐减小,在卫星角速率ω减小的过程中,一旦经过阈值ωx1、ωx2、ωx3时,需要及时按照三轴喷气规律调整推力器的喷气宽度。也就是说,当卫星角速率ω由大(ωx3)经过中(ωx2)再变小(ωx1)的过程中,推力器的喷气宽度也由大(-T3)经过中(-T2)再变小(-T1)。
所述的S31中,设定的喷气宽度需要满足T1≤T2≤T3≤T,T为控制周期,T1受推力器的性能制约,需要稍大于推力器的最小稳定喷气宽度。
所述的S31中,三档卫星角速率阈值中的最小值ωx1由T1喷气量产生的卫星角速度决定。
本发明中,虽然利用磁强计信息解算得到的卫星角速率存在有一定的误差,但这并不妨碍将其用于卫星的喷气速率阻尼。一般只要将卫星角速率阻尼至0.2°/s以下,就可满足包括星敏感器在内的绝大多数敏感器的工作要求。
综上所述,本发明所提供的利用磁强计信息实现喷气速率阻尼的方法,采用磁强计测得的地磁场强度信息,来解算卫星角速率,并将其作为控制输入来实现卫星的喷气速率阻尼。因此,本发明无需依赖陀螺组合信息,工作简单可靠,价格低廉。进一步,本发明也能够作为陀螺组合故障情况下的备份方案,以进一步保障卫星运行的可靠性。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。
Claims (6)
1.一种利用磁强计信息实现喷气速率阻尼的方法,其特征在于,包含以下步骤:
S1、采用磁强计测量得到地磁场强度B,计算地磁场强度B的矢量在体坐标系中对时间的微分构造地磁场强度B的斜对称矩阵并求解该斜对称矩阵的伪逆矩阵
S2、根据公式计算得到卫星本体坐标系相对惯性系的角速率矢量,即卫星角速率ω;
S3、根据解算得到的卫星角速率ω,控制推力器的喷气宽度,对卫星进行喷气速率阻尼,将卫星角速率ω降低并控制在敏感器可工作的速率范围内。
2.如权利要求1所述的利用磁强计信息实现喷气速率阻尼的方法,其特征在于,所述的S1中,具体包含以下步骤:
S11、利用磁强计测量得到地磁场强度B:
<mrow>
<mi>B</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>B</mi>
<mi>x</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>B</mi>
<mi>y</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>B</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
S12、计算地磁场强度B的矢量在体坐标系中对时间的微分
<mrow>
<mover>
<mi>B</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mover>
<mi>B</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>x</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>B</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>y</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mover>
<mi>B</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
S13、构造地磁场强度B的斜对称矩阵
<mrow>
<mover>
<mi>B</mi>
<mo>~</mo>
</mover>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>B</mi>
<mi>z</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>B</mi>
<mi>y</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>B</mi>
<mi>z</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>B</mi>
<mi>x</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>B</mi>
<mi>y</mi>
</msub>
</mrow>
</mtd>
<mtd>
<msub>
<mi>B</mi>
<mi>x</mi>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>;</mo>
</mrow>
并求解斜对称矩阵的伪逆矩阵
3.如权利要求1所述的利用磁强计信息实现喷气速率阻尼的方法,其特征在于,所述的S2中,具体包含以下步骤:
S21、地磁场的变化表示为:
<mrow>
<mfrac>
<mrow>
<mi>d</mi>
<mi>B</mi>
</mrow>
<mrow>
<mi>d</mi>
<mi>t</mi>
</mrow>
</mfrac>
<mo>=</mo>
<mfrac>
<mrow>
<mo>&part;</mo>
<mi>B</mi>
</mrow>
<mrow>
<mo>&part;</mo>
<mi>t</mi>
</mrow>
</mfrac>
<mo>+</mo>
<mi>&omega;</mi>
<mo>&times;</mo>
<mi>B</mi>
<mo>;</mo>
</mrow>
令
得
其中,为地磁场强度B的矢量在惯性系中对时间的微分,记为 为地磁场强度B的矢量在体坐标系中对时间的微分,记为
S22、地磁场强度B的矢量在卫星轨道平面内的周期性变化,相对于卫星角速率ω可忽略不计,即
S23、根据S21和S22可得:
<mrow>
<mover>
<mi>B</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>B</mi>
<mo>&times;</mo>
<mi>&omega;</mi>
<mo>;</mo>
</mrow>
以矩阵表示可解得:
<mrow>
<mi>&omega;</mi>
<mo>=</mo>
<msup>
<mover>
<mi>B</mi>
<mo>~</mo>
</mover>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>&CenterDot;</mo>
<mover>
<mi>B</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msup>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>x</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>y</mi>
</msub>
</mtd>
<mtd>
<msub>
<mi>&omega;</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>T</mi>
</msup>
<mo>.</mo>
</mrow>
4.如权利要求3所述的利用磁强计信息实现喷气速率阻尼的方法,其特征在于,所述的S3中,具体包含以下步骤:
S31、设定三轴喷气规律:
设置三档卫星角速率阈值ωx1、ωx2、ωx3,且ωx1<ωx2<ωx3;并限定:
当ω>ωx3时,设置推力器的喷气宽度为-T3;
当ωx2<ω<ωx3时,设置推力器的喷气宽度为-T2;
当ωx1<ω<ωx2时,设置推力器的喷气宽度为-T1;
S32、在对卫星进行喷气速率阻尼时,根据解算得到的卫星角速率ω,按照三轴喷气规律设定推力器的喷气宽度,使卫星角速率ω逐渐减小;在减小过程中,当卫星角速率ω经过阈值ωx1、ωx2、ωx3时,按照三轴喷气规律对应调整推力器的喷气宽度。
5.如权利要求4所述的利用磁强计信息实现喷气速率阻尼的方法,其特征在于,所述的S31中,喷气宽度满足T1≤T2≤T3≤T,其中,T为控制周期,T1大于推力器的最小稳定喷气宽度。
6.如权利要求4所述的利用磁强计信息实现喷气速率阻尼的方法,其特征在于,所述的S31中,三档卫星角速率阈值中的最小值ωx1由T1喷气量产生的卫星角速度决定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710418922.8A CN107215482A (zh) | 2017-06-06 | 2017-06-06 | 利用磁强计信息实现喷气速率阻尼的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710418922.8A CN107215482A (zh) | 2017-06-06 | 2017-06-06 | 利用磁强计信息实现喷气速率阻尼的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN107215482A true CN107215482A (zh) | 2017-09-29 |
Family
ID=59947914
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710418922.8A Pending CN107215482A (zh) | 2017-06-06 | 2017-06-06 | 利用磁强计信息实现喷气速率阻尼的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107215482A (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109489693A (zh) * | 2018-12-12 | 2019-03-19 | 上海航天控制技术研究所 | 闭环极性测试方法及测试系统 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02159590A (ja) * | 1988-12-12 | 1990-06-19 | Japan Radio Co Ltd | 自己位置測位装置 |
CN101934863A (zh) * | 2010-09-29 | 2011-01-05 | 哈尔滨工业大学 | 基于磁力矩器和飞轮的卫星姿态全方位控制方法 |
CN102591349A (zh) * | 2012-03-12 | 2012-07-18 | 北京控制工程研究所 | 高轨道卫星大初始角速率情况的无陀螺太阳捕获控制方法 |
CN105966639A (zh) * | 2016-05-11 | 2016-09-28 | 上海微小卫星工程中心 | 一种卫星对日自旋稳定控制系统及方法 |
CN106494646A (zh) * | 2016-11-21 | 2017-03-15 | 上海航天控制技术研究所 | 一种磁阻尼重捕地球控制方法及系统 |
CN106647793A (zh) * | 2017-02-20 | 2017-05-10 | 上海航天控制技术研究所 | 一种基于磁强计和太阳敏感器的对日定向方法 |
-
2017
- 2017-06-06 CN CN201710418922.8A patent/CN107215482A/zh active Pending
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JPH02159590A (ja) * | 1988-12-12 | 1990-06-19 | Japan Radio Co Ltd | 自己位置測位装置 |
CN101934863A (zh) * | 2010-09-29 | 2011-01-05 | 哈尔滨工业大学 | 基于磁力矩器和飞轮的卫星姿态全方位控制方法 |
CN102591349A (zh) * | 2012-03-12 | 2012-07-18 | 北京控制工程研究所 | 高轨道卫星大初始角速率情况的无陀螺太阳捕获控制方法 |
CN105966639A (zh) * | 2016-05-11 | 2016-09-28 | 上海微小卫星工程中心 | 一种卫星对日自旋稳定控制系统及方法 |
CN106494646A (zh) * | 2016-11-21 | 2017-03-15 | 上海航天控制技术研究所 | 一种磁阻尼重捕地球控制方法及系统 |
CN106647793A (zh) * | 2017-02-20 | 2017-05-10 | 上海航天控制技术研究所 | 一种基于磁强计和太阳敏感器的对日定向方法 |
Non-Patent Citations (1)
Title |
---|
钱勇,周凤岐,周军: "基于磁强计卫星初始入轨速率阻尼控制", 《航天控制》 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109489693A (zh) * | 2018-12-12 | 2019-03-19 | 上海航天控制技术研究所 | 闭环极性测试方法及测试系统 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103092209B (zh) | 一种基于动量轮控制的全姿态捕获方法 | |
CN103587681B (zh) | 抑制侧滑角信号常值偏差影响的高超声速飞行器控制方法 | |
CN104596546B (zh) | 一种单轴旋转惯导系统的姿态输出补偿方法 | |
CN101246011B (zh) | 一种基于凸优化算法的多目标多传感器信息融合方法 | |
CN104698485B (zh) | 基于bd、gps及mems的组合导航系统及导航方法 | |
CN107450588A (zh) | 一种挠性航天器姿态控制系统的强抗扰控制方法 | |
CN104176275B (zh) | 一种使用动量轮与磁力矩器联合的速率阻尼方法 | |
CN107797130A (zh) | 低轨航天器多点多参数轨道上行数据计算方法 | |
CN101381004A (zh) | 基于大气阻力的微小卫星编队飞行控制方法及控制装置 | |
CN103712598B (zh) | 一种小型无人机姿态确定方法 | |
CN105066994A (zh) | 一种嵌入式大气数据系统与惯性导航系统的数据融合方法 | |
CN106494646B (zh) | 一种磁阻尼重捕地球控制方法及系统 | |
CN104960674A (zh) | 一种运动目标的指向跟踪控制方法 | |
CN108181916A (zh) | 小卫星相对姿态的控制方法及装置 | |
CN103453907B (zh) | 基于分层大气模型的行星进入段导航滤波方法 | |
CN104656447A (zh) | 一种航天器抗干扰姿态跟踪的微分几何非线性控制方法 | |
CN102001453B (zh) | 一种增加前馈补偿改善磁控能力的方法 | |
CN106647793A (zh) | 一种基于磁强计和太阳敏感器的对日定向方法 | |
CN110058288A (zh) | 无人机ins/gnss组合导航系统航向误差修正方法及系统 | |
CN102435193B (zh) | 一种捷联惯性导航系统的高精度初始对准方法 | |
CN102582850A (zh) | 提高卫星磁控精度的方法 | |
CN104085539A (zh) | 成像定标的姿态控制方法 | |
CN107215482A (zh) | 利用磁强计信息实现喷气速率阻尼的方法 | |
CN105277210B (zh) | 一种任意安装多轴陀螺组合标定方法 | |
CN108583938A (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20170929 |
|
WD01 | Invention patent application deemed withdrawn after publication |