一种基于磁强计和太阳敏感器的对日定向方法与流程

文档序号:11153541阅读:来源:国知局

技术特征:

1.一种基于磁强计和太阳敏感器的对日定向方法,其特征在于,适用于中低轨道卫星对日定向控制,包含以下步骤:

S1、计算太阳矢量方位信息,包括在卫星轨道系下和卫星本体系下的坐标分量;以及计算太阳敏感器测得的两维姿态角;

S2、计算地磁场矢量方位信息,包括在卫星轨道系下和卫星本体系下的坐标分量;

S3、对日轴姿态计算,根据太阳和地磁场的双矢量定姿,得到对日状态下卫星本体系相对卫星轨道系的俯仰姿态;

S4、以太阳敏感器测得的两维姿态角和双矢量定姿得到的俯仰姿态,作为姿态控制基准,实现对地三轴的姿态稳定控制。

2.如权利要求1所述的基于磁强计和太阳敏感器的对日定向方法,其特征在于,所述的S1中,太阳敏感器安装在卫星的对日面上,使得太阳敏感器上的电池阵面对日设置;该电池阵面包括四片电池片。

3.如权利要求2所述的基于磁强计和太阳敏感器的对日定向方法,其特征在于,所述的S1中,具体包含以下步骤:

S11、根据星历信息,推算太阳矢量在卫星轨道系下的坐标分量:

Suno=[Sox,Soy,Soz]T

将所述的太阳矢量在卫星轨道系下的坐标分量记为v1

S12、根据太阳敏感器信息,计算太阳矢量在卫星本体系下的坐标分量。

4.如权利要求3所述的基于磁强计和太阳敏感器的对日定向方法,其特征在于,所述的S12中,具体包含以下步骤:

S121、计算太阳敏感器测得的两维姿态角:

<mrow> <msub> <mi>&phi;</mi> <mi>s</mi> </msub> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mi>c</mi> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>i</mi> <mi>c</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>d</mi> </msub> <mo>-</mo> <msub> <mi>i</mi> <mi>a</mi> </msub> <mo>-</mo> <msub> <mi>i</mi> <mi>b</mi> </msub> </mrow> <mrow> <msub> <mi>i</mi> <mi>a</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>b</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>c</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>d</mi> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

<mrow> <msub> <mi>&psi;</mi> <mi>s</mi> </msub> <mo>=</mo> <mi>a</mi> <mi>r</mi> <mi>c</mi> <mi>t</mi> <mi>a</mi> <mi>n</mi> <mrow> <mo>(</mo> <mfrac> <mrow> <msub> <mi>i</mi> <mi>b</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>c</mi> </msub> <mo>-</mo> <msub> <mi>i</mi> <mi>a</mi> </msub> <mo>-</mo> <msub> <mi>i</mi> <mi>d</mi> </msub> </mrow> <mrow> <msub> <mi>i</mi> <mi>a</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>b</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>c</mi> </msub> <mo>+</mo> <msub> <mi>i</mi> <mi>d</mi> </msub> </mrow> </mfrac> <mo>)</mo> </mrow> <mo>;</mo> </mrow>

其中,ia、ib、ic、id分别为电池片a、电池片b、电池片c和电池片d受太阳光照射所产生的电流大小;

S122、计算太阳矢量在卫星本体系下的坐标分量:

将所述的太阳矢量在卫星本体系下的坐标分量记为r1

5.如权利要求4所述的基于磁强计和太阳敏感器的对日定向方法,其特征在于,所述的S2中,具体包含以下步骤:

S21、根据星历信息,通过磁场公式推算地磁场矢量在卫星轨道系下的坐标分量Bo,记为v2

S22、根据磁强计信息,计算地磁场矢量在卫星本体系下的坐标分量Bb,记为r2

6.如权利要求5所述的基于磁强计和太阳敏感器的对日定向方法,其特征在于,所述的S3中,具体包含以下步骤:

S31、根据太阳矢量在卫星本体系下的坐标分量r1,以及地磁场矢量在卫星本体系下的坐标分量r2,建立坐标系:

<mrow> <mtable> <mtr> <mtd> <mrow> <mi>R</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>R</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mi>R</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mi>R</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>R</mi> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>r</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>R</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>r</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>r</mi> <mn>2</mn> </msub> </mrow> <mrow> <mo>|</mo> <msub> <mi>r</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>r</mi> <mn>2</mn> </msub> <mo>|</mo> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>R</mi> <mn>3</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>r</mi> <mn>1</mn> </msub> <mo>&times;</mo> <mrow> <mo>(</mo> <msub> <mi>r</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>r</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <mo>|</mo> <msub> <mi>r</mi> <mn>1</mn> </msub> <mo>&times;</mo> <mrow> <mo>(</mo> <msub> <mi>r</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>r</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>|</mo> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>

S32、根据太阳矢量在卫星轨道系下的坐标分量v1,以及地磁场矢量在卫星轨道系下的坐标分量v2,建立坐标系:

<mrow> <mtable> <mtr> <mtd> <mrow> <mi>V</mi> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <msub> <mi>V</mi> <mn>1</mn> </msub> </mtd> <mtd> <msub> <mi>V</mi> <mn>2</mn> </msub> </mtd> <mtd> <msub> <mi>V</mi> <mn>3</mn> </msub> </mtd> </mtr> </mtable> </mfenced> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>V</mi> <mn>1</mn> </msub> <mo>=</mo> <msub> <mi>v</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>V</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>v</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>v</mi> <mn>2</mn> </msub> </mrow> <mrow> <mo>|</mo> <msub> <mi>v</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>v</mi> <mn>2</mn> </msub> <mo>|</mo> </mrow> </mfrac> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <msub> <mi>V</mi> <mn>3</mn> </msub> <mo>=</mo> <mfrac> <mrow> <msub> <mi>v</mi> <mn>1</mn> </msub> <mo>&times;</mo> <mrow> <mo>(</mo> <msub> <mi>v</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>v</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> </mrow> <mrow> <mo>|</mo> <msub> <mi>v</mi> <mn>1</mn> </msub> <mo>&times;</mo> <mrow> <mo>(</mo> <msub> <mi>v</mi> <mn>1</mn> </msub> <mo>&times;</mo> <msub> <mi>v</mi> <mn>2</mn> </msub> <mo>)</mo> </mrow> <mo>|</mo> </mrow> </mfrac> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>

S33、计算卫星本体系相对卫星轨道系的姿态矩阵Ab←o

Ab←o=RVT

S34、计算俯仰姿态角θcal

θcal=arctan(-Axz,Azz);

其中,Axz和Azz分别为姿态矩阵Ab←o中的第一行第三个元素和第三行第三个元素。

7.如权利要求6所述的基于磁强计和太阳敏感器的对日定向方法,其特征在于,所述的S4中,将太阳敏感器测得的两维姿态角ψs,以及通过双矢量定姿得到的俯仰姿态角θcal作为控制系统的姿态基准角度输入项,实现对地三轴的姿态稳定控制。

当前第2页1 2 3 
网友询问留言 已有0条留言
  • 还没有人留言评论。精彩留言会获得点赞!
1