CN102607564B - 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 - Google Patents
一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 Download PDFInfo
- Publication number
- CN102607564B CN102607564B CN201210062041.4A CN201210062041A CN102607564B CN 102607564 B CN102607564 B CN 102607564B CN 201210062041 A CN201210062041 A CN 201210062041A CN 102607564 B CN102607564 B CN 102607564B
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mover
- msubsup
- overbar
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 27
- 238000005259 measurement Methods 0.000 claims abstract description 79
- 230000004927 fusion Effects 0.000 claims abstract description 12
- 230000005358 geomagnetic field Effects 0.000 claims description 59
- 239000011159 matrix material Substances 0.000 claims description 31
- 238000006243 chemical reaction Methods 0.000 claims description 7
- 238000001914 filtration Methods 0.000 claims description 7
- 238000007781 pre-processing Methods 0.000 claims description 6
- 238000004422 calculation algorithm Methods 0.000 claims description 5
- 238000013461 design Methods 0.000 claims description 5
- 230000005484 gravity Effects 0.000 claims description 5
- 101100110009 Caenorhabditis elegans asd-2 gene Proteins 0.000 claims description 4
- 238000012937 correction Methods 0.000 claims description 4
- 230000015572 biosynthetic process Effects 0.000 claims description 3
- 238000003786 synthesis reaction Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims 1
- 238000009795 derivation Methods 0.000 claims 1
- 230000007547 defect Effects 0.000 abstract description 2
- 230000008901 benefit Effects 0.000 description 5
- 230000008569 process Effects 0.000 description 3
- 241000764238 Isis Species 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000011161 development Methods 0.000 description 1
- 230000005672 electromagnetic field Effects 0.000 description 1
- 230000005855 radiation Effects 0.000 description 1
- 230000004083 survival effect Effects 0.000 description 1
Landscapes
- Navigation (AREA)
Abstract
本发明提出一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法,属于组合导航技术领域。该自主导航***包括星敏感器测量***、地磁场测量***、轨道确定***和姿态确定***;该导航方法包括:导航***状态方程的建立、导航***的量测方程建立和基于UKF的组合导航***信息融合。本发明利用大视场星敏感器同时观测多颗导航星的星光矢量信息,弥补因磁强计测量噪声过大引起的缺陷,从而获得较高的导航精度。且本发明充分利用磁强计和星敏感器的测量值中包含的轨道和姿态信息,综合考虑各种因素的影响建立***的量测方程,提高了滤波器对测量噪声的适应能力和稳定性,适用于对于采用小型廉价自主导航***的低轨小卫星的导航。
Description
技术领域
本发明涉及一种基于星光/地磁组合信息的小卫星自主导航方案设计***及其导航方法,属于组合导航技术领域。
背景技术
卫星自主导航是指卫星在不依赖地面站的条件下,仅依靠卫星上的测量设备实时地确定卫星的位置、速度和姿态,在轨完成飞行任务所要求的功能或操作。当前卫星主要依靠地面站进行跟踪与定轨,但由于小卫星组网中卫星数目较多,利用地面设备对卫星组网进行定位存在着测量弧段较短和测量目标较多的困难,而且随着中低轨道小卫星的不断增加,传统的地面测控设备难以满足实际应用需要。小卫星实现自主导航一方面有助于提高卫星自身的生存能力;另一方面,还可以大大降低地面测控***的成本。鉴于依赖地面站卫星导航的局限性和卫星自主导航技术明显的优势,自主导航已成为卫星设计中的一个重要课题。
考虑到小卫星的特点,需要采用体积小、重量轻、低成本、可靠性高的导航***实现其轨道和姿态的确定。三轴磁强计具有自主性强、体积小、重量轻、成本低、性能可靠、没有地域限制等优点,并能够提供全天侯、实时连续的导航信息。自Pasiaki等人提出利用磁强计进行卫星自主导航以来,当前许多航天器都选用磁强计用于姿态的确定和控制。但是,由于地磁场模型及磁强计测量的误差较大,目前单纯使用磁强计的地磁导航***精度较低,因此,需要利用其他的自主导航手段来弥补地磁导航的不足。
天文导航是利用天体敏感器对飞行器进行自主导航的一种方法,它具有隐蔽性好、定向精度高、不受人工和自然电磁场的干扰、不向外辐射电磁波等优点,目前已经成功地应用在各种航天器的自主导航***中。星敏感器作为当前应用最广泛的天体敏感器,它是天文导航***的重要组成部分,它具有体积小、精度高、功耗低等特点,是理想的小型自主导航设备之一,新型大视场星敏感器的出现,使得同时获取三颗及三颗以上导航星的星光矢量信息成为可能,在不需要任何外部基准信息的前提下,即可实现高精度的自主导航,并且测量误差不随时间积累。
目前地磁导航***(GNS)能够提供的导航数据比较全面,不仅能够提供载体的位置信息,而且能够提供载体的姿态信息,且数据输出率高,但地磁导航的精度较低,不能满足航天器高精度的导航性能要求;天文导航(CNS)和地磁导航同属环境敏感导航***,天文导航虽数据率低,但其误差不随时间增加。因此,采用基于星光/地磁组合信息的导航方案(CNS/GNS)可以满足小卫星自主导航的性能要求。
发明内容
针对现有技术中存在的问题,本发明提出一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法,解决了磁强计测量精度较低而导致的地磁导航误差过大的问题,分析地磁导航以及基于星敏感器的天文导航的特点和局限性,充分利用大视场星敏感器提供的多颗导航星的星光矢量信息和三轴磁强计获得地球周围的地磁场信息,实现了二者的优势互补,并通过UKF滤波方法进行信息融合,在提高精度的同时也提高了可靠性。
本发明提出一种基于星光/地磁组合信息的小卫星自主导航***,包括星敏感器测量***、地磁场测量***、轨道确定***和姿态确定***;
星敏感器测量***包括大视场星敏感器、数据采集单元、星图识别单元、导航星历和星光矢量获取单元;大视场星敏感器将测量得到的星光矢量信息提供给数据采集单元和星光矢量获取单元;数据采集单元对来自大视场星敏感器的星光矢量信息进行数据预处理,将预处理信息发送至星图识别单元;星图识别单元根据来自数据采集单元的预处理信息和导航星历提供的参考信息进行星图匹配,获得星光矢量在惯性坐标系下的分量并将其提供给星光矢量获取单元;星光矢量获取单元将大视场星敏感器测得星光矢量和星光矢量在惯性坐标系下的分量提供给轨道确定***和姿态确定***;
地磁场测量***包括三轴磁强计、国际地磁场模型和地磁矢量误差获取单元,三轴磁强计通过测量地球表面以及近地空间的地磁场,获得当地地磁场矢量在卫星本体坐标系中的分量,地磁场矢量的测量值;国际地磁场模型提供地磁场矢量的估计值;地磁矢量误差获取单元利用三轴磁强计测得的地磁场矢量的测量值和国际地磁场模型得到的估计值计算二者的地磁场矢量误差,并将其提供给轨道确定***和姿态确定***;
轨道确定***包括卫星轨道动力学模型单元、β角获取单元、UKF滤波器A单元以及卫星轨道信息获取单元;轨道确定***根据轨道动力学模型单元建立用于轨道确定的状态方程,并将该状态方程发送至UKF滤波器A单元;β角获取单元利用得到的地磁场矢量的测量值和星光矢量信息计算二者之间的夹角,并将其作为观测量提供给UKF滤波器A单元;UKF滤波器A单元根据得到的观测量和用于轨道确定的状态方程,进行信息融合,实时估计并校正卫星的轨道参数误差,并将获得的轨道参数提供给卫星轨道信息获取单元;卫星轨道信息获取单元将得到的轨道参数提供给卫星,完成卫星的轨道确定;
姿态确定***包括卫星姿态动力学模型单元、UKF滤波器B单元、姿态预估单元、姿态误差估计单元和卫星姿态信息获取单元,姿态确定***根据姿态动力学模型单元建立用于姿态确定的状态方程;UKF滤波器B单元根据得到的测量信息和用于姿态确定的状态方程,进行信息融合;姿态预估单元根据姿态动力学模型单元获得的姿态信息对卫星姿态进行预估计,得到姿态预估信息;姿态误差估计单元根据来自UKF滤波器B单元的信息估计卫星的姿态误差;姿态预估单元和姿态误差估计单元通过信息交流实现姿态校正,姿态预估单元将校正后的姿态信息提供给卫星姿态信息获取单元;卫星姿态信息获取单元将得到的姿态信息提供给卫星,实现卫星的姿态确定。
本发明提出一种基于星光/地磁组合信息的自主导航方法,具体包括以下步骤:
步骤一:导航***状态方程的建立
定义导航***的状态变量为
式中,δx、δy、δz、δvx、δvy、δvz分别表示卫星的位置和速度误差在惯性坐标系中的分量,是轨道确定***的状态量;为卫星本体坐标系相对于惯性空间的角速度误差;为误差四元数矢量部分,和为姿态确定***的状态量;
选取历元地心赤道惯性坐标系,考虑地球质心引力和J2项非球形摄动的影响,将其它摄动因素等效为高斯白噪声,卫星轨道动力学模型单元提供的轨道动力学模型为
其中,x、y、z分别表示卫星惯性坐标系中的位置;vx、vy、vz分别表示卫星惯性坐标系中的速度;为卫星到地心的距离;Re为地球半径;μ为地心引力常数;J2为地球非球形二阶带谐引力摄动系数;ωx、ωy、ωz分别为***位置信息噪声;ωvx、ωvy、ωvz分别为***速度信息噪声;
定义卫星的轨道状态为公式(2)简化为其中,t表示时间;是轨道状态和时间t的函数;为***噪声;
定义导航***的位置和速度误差变量为
其中,为的估计值;
则***轨道确定部分的状态方程表示为
其中, 为的微分;为相应的***噪声;
采用四元数表示卫星姿态,则卫星姿态运动学模型单元提供的姿态动力学模型为
其中,为卫星的控制力矩;为卫星的干扰力矩;为卫星的三轴转动惯量;为卫星本体坐标系相对于轨道坐标系的角速度矢量;为卫星轨道角速度矢量,wo为卫星轨道角速率;为卫星相对于惯性空间的绝对角速度;q为卫星的姿态四元数;分别为和q的微分;为四元数表示下的姿态矩阵;
根据四元数合成法则,并对公式(5)进行线性化,得到姿态确定***的状态方程为
其中,表示卫星相对于惯性空间的绝对角速度,为其估计值;为卫星控制力矩的误差;为卫星干扰力矩的误差;为卫星的三轴转动惯量;为卫星本体坐标系相对于惯性空间的角速度误差,其微分为为误差四元数矢量部分,其微分为
根据公式(4)和(6)分别给出的轨道确定***和姿态确定***的状态方程,得到导航***的状态方程;
步骤二:导航***的量测方程建立
分别选取大视场星敏感器测得的星光矢量信息、地磁矢量误差获取单元得到的地磁矢量误差值以及三轴磁强计测得的地磁场矢量测量值与星光矢量信息的夹角作为***观测量,建立量测方程;
a、基于星光矢量信息的量测方程建立
星敏感器测量***的星光矢量获取单元同时输出多颗导航星的星光矢量信息,姿态确定***利用来自星光矢量获取单元的两颗导航恒星的星光矢量信息Lm1、Lm2进行卫星的姿态确定;大视场星敏感器测得的星光矢量信息Lm可表示为
式中,Li为星光矢量在惯性系中的分量,利用星图识别单元和导航星历获取;υL为星敏感器测量误差;为四元数表示下的姿态矩阵;为惯性系到轨道坐标系的转换矩阵;q表示卫星的姿态四元数;结合公式(7)表示为
(8)
式中,为星光矢量在本体坐标系中的估计值;为估计姿态四元数下的姿态矩阵;为误差四元数下的姿态矩阵;I3×3表示单位矩阵;为误差四元数的矢量部分;
得到基于星光矢量的量测方程Z1为
其中,为导航星1的星光矢量在本体坐标系中的估计值;υL1为导航星1的星光矢量的测量误差;为导航星2的星光矢量在本体坐标系中的估计值;υL2为导航星2的星光矢量的测量误差;
b、基于地磁矢量误差的量测方程建立
三轴磁强计输出的地磁场在卫星本体系下的分量Bm可表示为
其中,Bn为地磁场矢量在地理坐标系中的真实值;分别为地理系到惯性系的转换矩阵、惯性系到本体系的转换矩阵;υB1为三轴磁强计的地磁场矢量测量误差;
地磁场矢量的估计值在本体系中的分量为
其中,为Bn的估计值,根据国际参考地磁场(IGRF)模型求得;分别为和的估计值;υB2为地磁场模型误差;
则地磁矢量误差获取单元获得的观测量ΔB为
定义 υB=υB2-υB1,则公式(12)简化为
根据微分运算法则,公式(13)右端第一项表示为
根据地磁场矢量在地理坐标系中的分量Bn的定义,建立同轨道误差状态的关系表达式Ho的表达式为
其中,
公式(14)右端第二项改写为
其中,Bi为真实的地磁场矢量在惯性系中的分量;是由卫星的姿态误差引起,其表达式为
根据姿态四元数为小量,可以得到
其中,I3×3表示单位矩阵;为误差四元数的矢量部分;
将式(18)带入式(16得到
其中,Bb为真实的地磁场矢量在体坐标系中的分量;
根据公式(13)~(19),公式(12)表示为
由于Bb为未知量,采用三轴磁强计的测量值Bm代替;则导航***的观测方程Z2为
其中,Ho表示轨道误差状态的量测矩阵;υB为相应的量测噪声;
c、基于星光矢量与地磁矢量夹角的量测方程建立
β角获取单元选取磁强计测得的地磁矢量Bm与星敏感器测量得到的星光矢量Lm3之间的夹角作为观测量,相应的量测方程Z3为
其中,||Bm||为Bm的模;υβ夹角的测量误差;
根据公式(9)、(21)以及(22)得到导航***的量测方程;
步骤三:基于UKF的组合导航***信息融合
UKF滤波器A单元利用轨道动力学模型单元建立轨道确定***的状态方程,将来自地磁矢量误差获取单元的地磁矢量误差ΔB和β角获取单元获得的夹角β作为观测量,在UKF滤波的框架下对卫星的轨道误差状态进行实时估计,并将其发送给卫星轨道信息获取单元,对卫星的轨道参数进行校正,实现轨道确定;
UKF滤波器B单元利用姿态动力学模型单元建立姿态确定***的状态方程,将来自地磁矢量误差获取单元的地磁矢量误差ΔB和星光矢量获取单元的星光矢量信息Lm1和Lm2作为观测量,在UKF滤波的框架下对卫星的姿态误差状态进行估计,并将其提供给姿态误差估计单元;姿态预估单元利用来自姿态动力学模型单元的信息进行姿态预估,并通过信息交换与姿态误差估计单元一起进行姿态校正,把校正后姿态信息输入到姿态信息获取单元中,从而完成卫星的姿态确定。
本发明的优点在于:
(1)本发明提出一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法,利用大视场星敏感器同时观测多颗导航星的星光矢量信息,弥补因磁强计测量噪声过大引起的缺陷,从而获得较高的导航精度;
(2)本发明提出一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法,充分利用磁强计和星敏感器的测量值中包含的轨道和姿态信息,综合考虑各种因素的影响建立***的量测方程,提高了滤波器对测量噪声的适应能力和稳定性;
(3)本发明提出一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法,根据卫星的轨道和姿态动力学模型,推导并建立了能够同时完成轨道和姿态确定的***状态方程,并通过UKF算法进行信息融合完成轨道和姿态的确定;
(4)本发明提出一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法,具有结构简单、体积小、***可靠性高等特点,能够满足低轨小卫星自主导航要求,对于采用小型廉价自主导航***的低轨小卫星而言,是一种非常有发展前景的卫星自主导航方法。
附图说明
图1为本发明提出的一种基于星光/地磁组合信息的小卫星自主导航***结构示意图;
图2为本发明中地磁场球面坐标系及各地磁要素之间的关系图;
图中:
1-星敏感器测量*** 2-地磁场测量*** 3-轨道确定*** 4-姿态确定***
101-大视场星敏感器 201-三轴磁强计 301-轨道动力学 401-姿态动力学模
模型单元 型单元
102-数据采集单元 202-国际地磁场 302-β角获取单 402-UKF滤波器B
(IGRF)模型 元 单元
103-星图识别单元 203-地磁矢量误差 303-UKF滤波器 403-姿态预估单元
获取单元 A单元
304-卫星轨道信 404-姿态误差估计
104-导航星历
息获取单元 单元
105-星光矢量获取单元 405-卫星姿态信息
获取单元
具体实施方式
下面将结合附图对本发明作进一步的详细说明。
本发明提出一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法,如图1所示,该自主导航***的设计分为轨道确定和姿态确定两部分。根据卫星的轨道动力学模型和姿态动力学模型建立***状态方程;以星敏感器测得的星光矢量(Lm1、Lm2和Lm3)、星光矢量与磁强计测得的地磁矢量(Bm)之间的夹角(β)、地磁矢量的测量值(Bm)与估计值之差(ΔB)作为***观测量;利用UKF滤波算法估计卫星的轨道和姿态参数,实现小卫星的自主导航。
本发明提出的一种基于星光/地磁组合信息的小卫星自主导航***,包括星敏感器测量***1、地磁场测量***2、轨道确定***3和姿态确定***4。
星敏感器测量***1主要包括大视场星敏感器101、数据采集单元102、星图识别单元103、导航星历104和星光矢量获取单元105。大视场星敏感器101能在同一时刻观测得到三颗以上导航恒星的星光矢量信息,并将测量得到的星光矢量信息提供给数据采集单元102和星光矢量获取单元105;数据采集单元102对来自大视场星敏感器101的星光矢量信息进行数据预处理,将预处理信息发送至星图识别单元103;星图识别单元103根据来自数据采集单元102的预处理信息和导航星历104提供的参考信息进行星图匹配,获得星光矢量在惯性坐标系下的分量并将其提供给星光矢量获取单元105;星光矢量获取单元105将大视场星敏感器101测得星光矢量和星光矢量在惯性坐标系下的分量提供给轨道确定***3和姿态确定***4。
地磁场测量***2主要包括三轴磁强计201、国际地磁场(IGRF)模型202和地磁矢量误差获取单元203。在轨道确定和姿态确定过程中,三轴磁强计201通过测量地球表面以及近地空间的地磁场,获得当地地磁场矢量在卫星本体坐标系中的分量,即地磁场矢量的测量值;国际地磁场(IGRF)模型202可以提供地磁场矢量的估计值;地磁矢量误差获取单元203利用三轴磁强计201测得的地磁场矢量的测量值和国际地磁场(IGRF)模型202得到的估计值计算二者的地磁场矢量误差,并将其提供给轨道确定***3和姿态确定***4。
轨道确定***3包括卫星轨道动力学模型单元301、β角获取单元302、UKF滤波器A单元303以及卫星轨道信息获取单元304。在轨道确定过程中,轨道确定***3根据轨道动力学模型单元301建立用于轨道确定的状态方程,并将该状态方程发送至UKF滤波器A单元303;β角获取单元302利用得到的地磁场矢量的测量值和星光矢量信息计算二者之间的夹角,并将其作为观测量提供给UKF滤波器A单元303;UKF滤波器A单元303根据得到的观测量和用于轨道确定的状态方程,进行信息融合,实时估计并校正卫星的轨道参数误差,并将获得的轨道参数提供给卫星轨道信息获取单元304;卫星轨道信息获取单元304将得到的轨道参数提供给卫星,完成卫星的轨道确定。
姿态确定***4主要包括卫星姿态动力学模型单元401、UKF滤波器B单元402、姿态预估单元403、姿态误差估计单元404和卫星姿态信息获取单元405。在姿态确定过程中,姿态确定***4根据姿态动力学模型单元401建立用于姿态确定的状态方程;UKF滤波器B单元402根据得到的测量信息和用于姿态确定的状态方程,进行信息融合;姿态预估单元403根据姿态动力学模型单元401获得的姿态信息对卫星姿态进行预估计,得到姿态预估信息;姿态误差估计单元404根据来自UKF滤波器B单元402的信息估计卫星的姿态误差;姿态预估单元403和姿态误差估计单元404通过信息交流实现姿态校正,姿态预估单元403将校正后的姿态信息提供给卫星姿态信息获取单元405;卫星姿态信息获取单元405将得到的姿态信息提供给卫星,实现卫星的姿态确定。
本发明提出一种基于星光/地磁组合信息的自主导航方法,具体包括以下步骤:
步骤一:导航***状态方程的建立
定义导航***的状态变量为
式中,δx、δy、δz、δvx、δvy、δvz分别表示卫星的位置和速度误差在惯性坐标系中的分量,是轨道确定***3的状态量;为卫星本体坐标系相对于惯性空间的角速度误差;为误差四元数矢量部分,和为姿态确定***4的状态量。
选取历元(J2000.0)地心赤道惯性坐标系,主要考虑地球质心引力和J2项非球形摄动的影响,将其它摄动因素(指除了地球质心引力和J2项非球形摄动以外的摄动)等效为高斯白噪声,则卫星轨道动力学模型单元301提供的轨道动力学模型为
式中,x、y、z分别表示卫星惯性坐标系中的位置;vx、vy、vz分别表示卫星惯性坐标系中的速度;为卫星到地心的距离;Re为地球半径;μ为地心引力常数;J2为地球非球形二阶带谐引力摄动系数;ωx、ωy、ωz分别为***位置信息噪声;ωvx、ωvy、ωvz分别为***速度信息噪声。
定义卫星的轨道状态为公式(2)可以简写为其中,t表示时间;是轨道状态和时间t的函数;为***噪声。
定义导航***的位置和速度误差变量为
式中,为的估计值。
则***轨道确定部分3的状态方程可表示为
式中, 为的微分;为相应的***噪声。
采用四元数表示卫星姿态,则卫星姿态运动学模型单元401提供的姿态动力学模型为
式中,为卫星的控制力矩;为卫星的干扰力矩;为卫星的三轴转动惯量;为卫星本体坐标系相对于轨道坐标系的角速度矢量;为卫星轨道角速度矢量,wo为卫星轨道角速率;为卫星相对于惯性空间的绝对角速度;q为卫星的姿态四元数;分别为和q的微分;为四元数表示下的姿态矩阵。
根据四元数合成法则,并对表达式(5)进行线性化可以得到姿态确定***4的状态方程为
其中,表示卫星相对于惯性空间的绝对角速度,为其估计值;为卫星控制力矩的误差;为卫星干扰力矩的误差;为卫星的三轴转动惯量;为卫星本体坐标系相对于惯性空间的角速度误差,其微分为为误差四元数矢量部分,其微分为
由上式可知,误差四元数自然降阶为四元数矢量部分,从而避免了由于四元数正交性约束所造成的奇异性问题。卫星的自主导航分为设计分为轨道确定和姿态确定两部分,根据式(4)和(6)分别给出的轨道确定***和姿态确定***的状态方程,即可得到导航***的状态方程。
步骤二:导航***的量测方程建立
分别选取大视场星敏感器101测得的星光矢量信息、地磁矢量误差获取单元203得到的地磁矢量误差值以及三轴磁强计201测得的地磁场矢量测量值与星光矢量信息的夹角作为***观测量,建立量测方程。
a、基于星光矢量信息的量测方程建立
根据图1可知,星敏感器测量***1的星光矢量获取单元105可以同时输出多颗导航星的星光矢量信息。姿态确定***4利用来自星光矢量获取单元105的两颗导航恒星(导航星1和导航星2)的星光矢量信息(Lm1、Lm2)进行卫星的姿态确定。大视场星敏感器101测得的星光矢量信息Lm可表示为
式中,Li为星光矢量在惯性系中的分量,可利用星图识别单元103和导航星历104获取;υL为星敏感器测量误差;为四元数表示下的姿态矩阵;为惯性系到轨道坐标系的转换矩阵;q表示卫星的姿态四元数;结合式(7)可表示为
(8)
式中,为星光矢量在本体坐标系中的估计值;为估计姿态四元数下的姿态矩阵;为误差四元数下的姿态矩阵;I3×3表示单位矩阵;为误差四元数的矢量部分。
得到基于星光矢量的量测方程Z1为
其中,为导航星1的星光矢量在本体坐标系中的估计值;υL1为导航星1的星光矢量的测量误差;为导航星2的星光矢量在本体坐标系中的估计值;υL2为导航星2的星光矢量的测量误差。
b、基于地磁矢量误差的量测方程建立
三轴磁强计201输出的地磁场在卫星本体系下的分量Bm可表示为
式中,Bn为地磁场矢量在地理坐标系中的真实值;分别为地理系到惯性系的转换矩阵、惯性系到本体系的转换矩阵;υB1为三轴磁强计201的地磁场矢量测量误差。
地磁场矢量的估计值在本体系中的分量为
其中,为Bn的估计值,可根据国际参考地磁场(IGRF)模型202求得;分别为和的估计值;υB2为地磁场模型误差。
则地磁矢量误差获取单元203获得的观测量ΔB为
定义 υB=υB2-υB1,则式(12)可简化为
根据微分运算法则,式(13)右端第一项可以表示为
图2给出了地磁场球面坐标系及各地磁要素之间的关系图。图中,OiXiYiZi表示地心惯性系;OeXeYeZe表示地球坐标系;G为Greenwich子午线赤经;Br、Bθ、Bλ为地磁场矢量在地磁场球面坐标系三个轴上的分量;r为卫星距地心的距离,λ为地理经度,θ为地心余纬;ONET表示当地地理坐标系,O为卫星的质心,ON指向地理北,OE指向地理东,OT垂直于ONE平面且指向地心。Bn为地磁场矢量在地理坐标系中的分量,BH为Bn在ONE平面内的分量,称为水平分量;X为BH在ON轴上的分量,称为北向分量;Y为BH在OE轴上的分量,称为东向分量;Z为Bn在OT轴上的分量,称为垂直强度或垂直分量;D为BH偏离地理北的角度,称为磁偏角,向东偏为正;I为Bn与水平面ONE之间的夹角,称为磁倾角,向下倾为正。
根据图2给出的地磁场矢量在地理坐标系中的分量Bn的定义可知,地理系到惯性系的转换矩阵Bn与卫星的位置信息(卫星的地心距r、地理经度λ和地心余纬θ)有关,即等式(14)右端第一项主要由轨道参数误差引起。因此,可以建立同轨道误差状态的关系表达式Ho的表达式为
其中,
式(14)右端第二项与卫星的姿态测量矩阵有关,其可改写为
其中,Bi为真实的地磁场矢量在惯性系中的分量;主要是由卫星的姿态误差引起,其表达式为
根据姿态四元数为小量,可以得到
其中,I3×3表示单位矩阵;为误差四元数的矢量部分。
将式(18)带入式(16),可得
其中,Bb为真实的地磁场矢量在体坐标系中的分量。
根据式(13)~(19),式(12)可表示为
由于Bb为未知量,在实际过程中可采用三轴磁强计201的测量值Bm代替。则导航***的观测方程Z2为
其中,Ho表示轨道误差状态的量测矩阵;υB为相应的量测噪声。
c、基于星光矢量与地磁矢量夹角的量测方程建立
β角获取单元302选取磁强计201测得的地磁矢量Bm与星敏感器101测量得到的星光矢量Lm3之间的夹角作为观测量,相应的量测方程Z3为
其中,||Bm||为Bm的模;υβ夹角的测量误差。
根据式(9)、(21)以及(22),即可得到导航***的量测方程。
步骤三:基于UKF的组合导航***信息融合
在基于星光/地磁组合信息的自主导航***中,三轴磁强计201和大视场星敏感器101的测量信息均与卫星的轨道和姿态信息有关,因此导航***可以利用UKF滤波算法同时实现卫星的轨道确定和姿态确定。
UKF滤波器A单元303利用轨道动力学模型单元301建立轨道确定***的状态方程,将来自地磁矢量误差获取单元203的地磁矢量误差ΔB和β角获取单元302获得的夹角β作为观测量,在UKF滤波的框架下对卫星的轨道误差状态进行实时估计,并将其发送给卫星轨道信息获取单元304,对卫星的轨道参数进行校正,实现轨道确定。
UKF滤波器B单元402利用姿态动力学模型单元401建立姿态确定***的状态方程,将来自地磁矢量误差获取单元203的地磁矢量误差ΔB和星光矢量获取单元105的星光矢量信息(Lm1、Lm2)作为观测量,在UKF滤波的框架下对卫星的姿态误差状态进行估计,并将其提供给姿态误差估计单元404;姿态预估单元403利用来自姿态动力学模型单元401的信息进行姿态预估,并通过信息交换与姿态误差估计单元404一起进行姿态校正,把校正后姿态信息输入到姿态信息获取单元405中,从而完成卫星的姿态确定。
Claims (3)
1.一种基于星光/地磁组合信息的小卫星自主导航***,其特征在于:包括星敏感器测量***、地磁场测量***、轨道确定***和姿态确定***;
星敏感器测量***包括大视场星敏感器、数据采集单元、星图识别单元、导航星历和星光矢量获取单元;大视场星敏感器将测量得到的星光矢量信息提供给数据采集单元和星光矢量获取单元;数据采集单元对来自大视场星敏感器的星光矢量信息进行数据预处理,将预处理信息发送至星图识别单元;星图识别单元根据来自数据采集单元的预处理信息和导航星历提供的参考信息进行星图匹配,获得星光矢量在惯性坐标系下的分量并将其提供给星光矢量获取单元;星光矢量获取单元将大视场星敏感器测得星光矢量和星光矢量在惯性坐标系下的分量提供给轨道确定***和姿态确定***;
地磁场测量***包括三轴磁强计、国际地磁场模型和地磁矢量误差获取单元,三轴磁强计通过测量地球表面以及近地空间的地磁场,获得当地地磁场矢量在卫星本体坐标系中的分量,地磁场矢量的测量值;国际地磁场模型提供地磁场矢量的估计值;地磁矢量误差获取单元利用三轴磁强计测得的地磁场矢量的测量值和国际地磁场模型得到的估计值计算二者的地磁场矢量误差,并将其提供给轨道确定***和姿态确定***;
轨道确定***包括卫星轨道动力学模型单元、β角获取单元、UKF滤波器A单元以及卫星轨道信息获取单元;轨道确定***根据轨道动力学模型单元建立用于轨道确定的状态方程,并将该状态方程发送至UKF滤波器A单元;β角获取单元利用得到的地磁场矢量的测量值和星光矢量信息计算二者之间的夹角,并将其作为观测量提供给UKF滤波器A单元;UKF滤波器A单元根据得到的观测量和用于轨道确定的状态方程,进行信息融合,实时估计并校正卫星的轨道参数误差,并将获得的轨道参数提供给卫星轨道信息获取单元;卫星轨道信息获取单元将得到的轨道参数提供给卫星,完成卫星的轨道确定;
姿态确定***包括卫星姿态动力学模型单元、UKF滤波器B单元、姿态预估单元、姿态误差估计单元和卫星姿态信息获取单元,姿态确定***根据姿态动力学模型单元建立用于姿态确定的状态方程;UKF滤波器B单元根据得到的测量信息和用于姿态确定的状态方程,进行信息融合;姿态预估单元根据姿态动力学模型单元获得的姿态信息对卫星姿态进行预估计,得到姿态预估信息;姿态误差估计单元根据来自UKF滤波器B单元的信息估计卫星的姿态误差;姿态预估单元和姿态误差估计单元通过信息交流实现姿态校正,姿态预估单元将校正后的姿态信息提供给卫星姿态信息获取单元;卫星姿态信息获取单元将得到的姿态信息提供给卫星,实现卫星的姿态确定。
2.应用权利要求1所述的基于星光/地磁组合信息的小卫星自主导航***的一种基于星光/地磁组合信息的自主导航方法,其特征在于:具体包括以下步骤:
步骤一:导航***状态方程的建立
定义导航***的状态变量为
式中,δx、δy、δz、δvx、δvy、δvz分别表示卫星的位置和速度误差在惯性坐标系中的分量,是轨道确定***的状态量;为卫星本体坐标系相对于惯性空间的角速度误差;为误差四元数矢量部分,和为姿态确定***的状态量;
选取历元地心赤道惯性坐标系,考虑地球质心引力和J2项非球形摄动的影响,将其它摄动因素等效为高斯白噪声,卫星轨道动力学模型单元提供的轨道动力学模型为
其中,x、y、z分别表示卫星惯性坐标系中的位置;vx、vy、vz分别表示卫星惯性坐标系中的速度;为卫星到地心的距离;Re为地球半径;μ为地心引力常数;J2为地球非球形二阶带谐引力摄动系数;ωx、ωy、ωz分别为***位置信息噪声;ωvx、ωvy、ωvz分别为***速度信息噪声;
定义卫星的轨道状态为 公式(2)简化为 其中,t表示时间;是轨道状态和时间t的函数;为***噪声;
定义导航***的位置和速度误差变量为
其中,为的估计值;
则***轨道确定部分的状态方程表示为
其中, 为的微分;为相应的***噪声;
采用四元数表示卫星姿态,则卫星姿态运动学模型单元提供的姿态动力学模型为
其中,为卫星的控制力矩;为卫星的干扰力矩;为卫星的三轴转动惯量;为卫星本体坐标系相对于轨道坐标系的角速度矢量; 为卫星轨道角速度矢量,wo为卫星轨道角速率;为卫星相对于惯性空间的绝对角速度;q为卫星的姿态四元数;分别为和q的微分;为四元数表示下的姿态矩阵;
根据四元数合成法则,并对公式(5)进行线性化,得到姿态确定***的状态方程为
其中,表示卫星相对于惯性空间的绝对角速度,为其估计值;为卫星控制力矩的误差;为卫星干扰力矩的误差;为卫星的三轴转动惯量;为卫星本体坐标系相对于惯性空间的角速度误差,其微分为 为误差四元数矢量部分,其微分为
根据公式(4)和(6)分别给出的轨道确定***和姿态确定***的状态方程,得到导航***的状态方程;
步骤二:导航***的量测方程建立
分别选取大视场星敏感器测得的星光矢量信息、地磁矢量误差获取单元得到的地磁矢量误差值以及三轴磁强计测得的地磁场矢量测量值与星光矢量信息的夹角作为***观测量,建立量测方程;
a、基于星光矢量信息的量测方程建立
星敏感器测量***的星光矢量获取单元同时输出多颗导航星的星光矢量信息,姿态确定***利用来自星光矢量获取单元的两颗导航恒星的星光矢量信息Lm1、Lm2进行卫星的姿态确定;大视场星敏感器测得的星光矢量信息Lm可表示为
式中,Li为星光矢量在惯性系中的分量,利用星图识别单元和导航星历获取;υL为星敏感器测量误差;为四元数表示下的姿态矩阵;为惯性系到轨道坐标系的转换矩阵;q表示卫星的姿态四元数;结合公式(7)表示为
式中,为星光矢量在本体坐标系中的估计值;为估计姿态四元数下的姿态矩阵;为误差四元数下的姿态矩阵;I3×3表示单位矩阵;为误差四元数的矢量部分;
得到基于星光矢量的量测方程Z1为
其中,为导航星1的星光矢量在本体坐标系中的估计值;为导航星1的星光矢量的测量误差;为导航星2的星光矢量在本体坐标系中的估计值;为导航星2的星光矢量的测量误差;
b、基于地磁矢量误差的量测方程建立
三轴磁强计输出的地磁场在卫星本体系下的分量Bm可表示为
其中,Bn为地磁场矢量在地理坐标系中的真实值;分别为地理系到惯性系的转换矩阵、惯性系到本体系的转换矩阵;υB1为三轴磁强计的地磁场矢量测量误差;
地磁场矢量的估计值在本体系中的分量为
其中,为Bn的估计值,根据国际参考地磁场(IGRF)模型求得;分别为和的估计值;υB2为地磁场模型误差;
则地磁矢量误差获取单元获得的观测量ΔB为
定义 则公式(12)简化为
根据微分运算法则,公式(13)右端第一项表示为
根据地磁场矢量在地理坐标系中的分量Bn的定义,建立同轨道误差状态的关系表达式Ho的表达式为
其中,
θ、λ分别表示余纬度和经度;表示求偏导计算;
公式(14)右端第二项改写为
其中,Bi为真实的地磁场矢量在惯性系中的分量;是由卫星的姿态误差引起,其表达式为
根据姿态四元数为小量,可以得到
其中,I3×3表示单位矩阵;为误差四元数的矢量部分;
将式(18)带入式(16得到
其中,Bb为真实的地磁场矢量在体坐标系中的分量;
根据公式(13)~(19),公式(12)表示为
由于Bb为未知量,采用三轴磁强计的测量值Bm代替;则导航***的观测方程Z2为
其中,Ho表示轨道误差状态的量测矩阵;υB为相应的量测噪声;
c、基于星光矢量与地磁矢量夹角的量测方程建立
β角获取单元选取磁强计测得的地磁矢量Bm与星敏感器测量得到的星光矢量Lm3之间的夹角作为观测量,相应的量测方程Z3为
其中,||Bm||为Bm的模;υβ夹角的测量误差;
根据公式(9)、(21)以及(22)得到导航***的量测方程;
步骤三:基于UKF的组合导航***信息融合
UKF滤波器A单元利用轨道动力学模型单元建立轨道确定***的状态方程,将来自地磁矢量误差获取单元的地磁矢量误差ΔB和β角获取单元获得的夹角β作为观测量,在UKF滤波的框架下对卫星的轨道误差状态进行实时估计,并将其发送给卫星轨道信息获取单元,对卫星的轨道参数进行校正,实现轨道确定;
UKF滤波器B单元利用姿态动力学模型单元建立姿态确定***的状态方程,将来自地磁矢量误差获取单元的地磁矢量误差ΔB和星光矢量获取单元的星光矢量信息Lm1和Lm2作为观测量,在UKF滤波的框架下对卫星的姿态误差状态进行估计,并将其提供给姿态误差估计单元;姿态预估单元利用来自姿态动力学模型单元的信息进行姿态预估,并通过信息交换与姿态误差估计单元一起进行姿态校正,把校正后姿态信息输入到姿态信息获取单元中,从而完成卫星的姿态确定。
3.根据权利要求2所述的一种基于星光/地磁组合信息的自主导航方法,其特征在于:所述的步骤一中其它摄动因素为除了地球质心引力和J2项非球形摄动以外的摄动。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210062041.4A CN102607564B (zh) | 2012-03-09 | 2012-03-09 | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210062041.4A CN102607564B (zh) | 2012-03-09 | 2012-03-09 | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102607564A CN102607564A (zh) | 2012-07-25 |
CN102607564B true CN102607564B (zh) | 2014-12-17 |
Family
ID=46525166
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210062041.4A Expired - Fee Related CN102607564B (zh) | 2012-03-09 | 2012-03-09 | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102607564B (zh) |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2776096C1 (ru) * | 2021-11-18 | 2022-07-13 | Федеральное государственное унитарное предприятие "Центральный научно-исследовательский институт химии и Механики (ФГУП "ЦНИИХМ") | Способ автономной навигации и ориентации космических аппаратов |
Families Citing this family (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103063217B (zh) * | 2013-01-08 | 2015-04-29 | 北京航空航天大学 | 一种基于星历修正的深空探测器天文/无线电组合导航方法 |
CN103454665A (zh) * | 2013-08-26 | 2013-12-18 | 哈尔滨工程大学 | 一种双差gps/sins组合导航姿态测量方法 |
CN103645489A (zh) * | 2013-11-22 | 2014-03-19 | 航天恒星科技有限公司 | 一种航天器gnss单天线定姿方法 |
CN103954286B (zh) * | 2014-04-24 | 2016-08-24 | 南京航空航天大学 | 微小卫星磁传感器多误差模型在轨迭代标定方法 |
CN105425764B (zh) * | 2014-09-17 | 2018-08-24 | 上海新跃仪表厂 | 一种基于动态地磁场模拟的三轴磁强计闭环测试***及方法 |
CN105424048B (zh) * | 2015-11-03 | 2018-12-21 | 北京空间飞行器总体设计部 | 一种基于周期变星的航天器自主导航方法 |
CN105486312B (zh) * | 2016-01-30 | 2018-05-15 | 武汉大学 | 一种星敏感器与高频角位移传感器组合定姿方法及*** |
CN106556852A (zh) * | 2016-11-21 | 2017-04-05 | 重庆卓观科技有限公司 | 一种基于定位姿态信息模拟磁罗盘的方法与磁强计模拟器 |
CN106707321B (zh) * | 2016-12-30 | 2019-05-17 | 中国科学院长春光学精密机械与物理研究所 | 一种极光测量仪器控制方法及*** |
CN106908818B (zh) * | 2017-02-28 | 2020-01-17 | 哈尔滨工业大学深圳研究生院 | 一种卫星联合导航方法 |
CN107621262B (zh) * | 2017-08-21 | 2020-06-16 | 中国科学院长春光学精密机械与物理研究所 | 一种星光导航方法 |
CN108279010A (zh) * | 2017-12-18 | 2018-07-13 | 北京时代民芯科技有限公司 | 一种基于多传感器的微小卫星姿态确定方法 |
CN108871301B (zh) * | 2018-07-18 | 2021-03-23 | 哈尔滨工业大学 | 磁场方位测量方法 |
CN110470297A (zh) * | 2019-03-11 | 2019-11-19 | 北京空间飞行器总体设计部 | 一种空间非合作目标的姿态运动与惯性参数估计方法 |
CN110146082B (zh) * | 2019-05-05 | 2021-03-19 | 中国人民解放军63921部队 | 利用测速数据实时估计航天器异常姿态的方法和设备 |
CN110986961A (zh) * | 2019-11-01 | 2020-04-10 | 上海卫星工程研究所 | 磁光矩阵标定装置及磁光矩阵标定方法 |
CN110849391B (zh) * | 2019-11-01 | 2021-07-13 | 上海卫星工程研究所 | 矢量磁力仪与星敏感器非正交安装矩阵标定***及方法 |
CN111060111A (zh) * | 2019-12-23 | 2020-04-24 | 北京国电高科科技有限公司 | 一种低轨卫星入轨初期定轨方法 |
CN116430290B (zh) * | 2023-03-28 | 2024-03-26 | 长光卫星技术股份有限公司 | 一种对地三轴稳定观测卫星的磁强计在轨标定***及标定方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101000245A (zh) * | 2007-01-10 | 2007-07-18 | 北京航空航天大学 | 一种sins/gps/磁罗盘组合导航***的数据融合方法 |
CN101788296A (zh) * | 2010-01-26 | 2010-07-28 | 北京航空航天大学 | 一种sins/cns深组合导航***及其实现方法 |
-
2012
- 2012-03-09 CN CN201210062041.4A patent/CN102607564B/zh not_active Expired - Fee Related
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101000245A (zh) * | 2007-01-10 | 2007-07-18 | 北京航空航天大学 | 一种sins/gps/磁罗盘组合导航***的数据融合方法 |
CN101788296A (zh) * | 2010-01-26 | 2010-07-28 | 北京航空航天大学 | 一种sins/cns深组合导航***及其实现方法 |
Non-Patent Citations (1)
Title |
---|
《捷联惯性/天文组合导航信息融合方法研究》;张魁等;《航空兵器》;20090831(第4期);第12-16页 * |
Cited By (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
RU2776096C1 (ru) * | 2021-11-18 | 2022-07-13 | Федеральное государственное унитарное предприятие "Центральный научно-исследовательский институт химии и Механики (ФГУП "ЦНИИХМ") | Способ автономной навигации и ориентации космических аппаратов |
Also Published As
Publication number | Publication date |
---|---|
CN102607564A (zh) | 2012-07-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102607564B (zh) | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 | |
CN106708066B (zh) | 基于视觉/惯导的无人机自主着陆方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN101216319B (zh) | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 | |
CN102809377B (zh) | 飞行器惯性/气动模型组合导航方法 | |
CN101825467B (zh) | 捷联惯性导航***与天文导航***实现组合导航的方法 | |
CN101893440B (zh) | 基于星敏感器的天文自主导航方法 | |
Ning et al. | A two-mode INS/CNS navigation method for lunar rovers | |
CN107655485B (zh) | 一种巡航段自主导航位置偏差修正方法 | |
CN105716615A (zh) | 火星探测器自主导航方法 | |
CN103968844B (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN100533065C (zh) | 基于多天体路标的星际巡航自主导航方法 | |
CN106643741A (zh) | 一种卫星相对小行星视觉自主导航方法 | |
CN105737858A (zh) | 一种机载惯导***姿态参数校准方法与装置 | |
CN103278165B (zh) | 基于剩磁标定的磁测及星光备份的自主导航方法 | |
CN111427002A (zh) | 地面测控天线指向卫星的方位角计算方法 | |
CN100442015C (zh) | 一种航天器天文/多普勒组合导航方法 | |
Xinlong et al. | An autonomous navigation scheme based on geomagnetic and starlight for small satellites | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN103512574A (zh) | 一种基于小行星序列图像的深空探测器光学导航方法 | |
Ning et al. | A new autonomous celestial navigation method for the lunar rover | |
CN111207773A (zh) | 一种用于仿生偏振光导航的姿态无约束优化求解方法 | |
Cai et al. | A polar rapid transfer alignment assisted by the improved polarized-light navigation | |
CN109099911B (zh) | 一种航空***导航定位的方法及*** | |
Paluszek et al. | Optical navigation system |
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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20141217 Termination date: 20160309 |
|
CF01 | Termination of patent right due to non-payment of annual fee |