CN107024211B - 一种深空探测器测角/差分测速/差分测距组合导航方法 - Google Patents
一种深空探测器测角/差分测速/差分测距组合导航方法 Download PDFInfo
- Publication number
- CN107024211B CN107024211B CN201710478722.1A CN201710478722A CN107024211B CN 107024211 B CN107024211 B CN 107024211B CN 201710478722 A CN201710478722 A CN 201710478722A CN 107024211 B CN107024211 B CN 107024211B
- Authority
- CN
- China
- Prior art keywords
- measurement
- model
- spacecraft
- moment
- arrival time
- 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.)
- Active
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/24—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种深空探测器测角/差分测速/差分测距组合导航方法。首先根据轨道动力学建立航天器的状态模型,再分别利用测角敏感器获得星光角距量测量,利用X射线脉冲星探测器获得脉冲到达时间量测量,利用光谱仪获得天文多普勒速度量测量,之后根据这些量测量分别建立星光角距量测模型、差分脉冲到达时间量测模型及差分天文多普勒速度量测模型。离散化后使用UKF滤波估计航天器的位置和速度。本发明属于航天器自主导航领域,本发明估计精度高,对航天器自主导航具有重要的实际意义。
Description
技术领域
本发明属于航天器自主导航领域,涉及一种基于星光角距、差分脉冲到达时间、差分天文多普勒速度等量测量的自主天文导航方法。
背景技术
我国计划于2020年发射一颗火星探测器,因此火星探测将吸引越来越多的关注。对于深空探测任务而言,导航精度对于任务的成败有着重要影响。目前主要通过地面测控站为航天器提供导航信息。随着航天器与地球之间距离的增加,通过地面测控站进行信号传输的双程时延将越来越大。另外,日凌将造成信号中断。因此,需要提高航天器的自主导航能力。
可用于深空探测器的自主导航方法主要有天文测角导航方法、X射线脉冲星测距导航方法及天文多普勒测速导航方法。天文测角导航方法通过测量航天器与近天体及导航恒星之间的夹角获得航天器的位置信息。但是,这种方法的导航精度随着航天器与近天体间距离的增加而下降。X射线脉冲星测距导航可以提供高精度的位置信息,且导航精度不受航天器与天体间位置的影响。但是,由于X射线脉冲星的信号比较微弱,通常需要通过较长时间的历元折叠以得到量测量。另外,脉冲星角位置误差及星载原子钟钟差将影响导航精度。天文多普勒测速导航通过测量由航天器与恒星间径向运动造成的光谱频移获得航天器的速度信息。但是,这种方法无法提供位置信息,且恒星光谱的动态变化将影响其导航精度。
发明内容
本发明提出一种深空探测器测角/差分测速/差分测距组合导航方法,利用星光角距量测量提供绝对位置信息,利用时间差分X射线脉冲星脉冲到达时间量测量减弱***误差的影响,提供相对位置信息,利用时间差分天文多普勒速度量测量减弱恒星光谱动态变化的影响,提供速度信息。将三种量测量通过UKF滤波组合,为深空探测器提供高精度的导航信息。
本发明解决其技术问题所采用的技术方案为:根据轨道动力学建立航天器的状态模型,利用测角敏感器获得星光角距量测量,利用X射线脉冲星探测器获得脉冲到达时间量测量,利用光谱仪获得天文多普勒速度量测量,根据这些量测量分别建立星光角距量测模型、差分脉冲到达时间量测模型及差分天文多普勒速度量测模型。离散化后使用UKF滤波估计航天器的位置和速度。
具体包括以下步骤:
1.建立基于轨道动力学的***状态模型
将航天器在火星接近段的运动描述为以太阳为中心天体的受摄三体模型,将其他扰动视为过程噪声。在太阳中心惯性坐标系(J2000.0)下的动力学模型可写为:
其中||·||表示矢量的2范数,||·||3表示||·||的立方,r和v是航天器相对太阳的位置和速度。μs和μm分别是太阳和火星的引力常数,rm是火星相对太阳的位置矢量,rsm=r-rm是航天器相对火星的位置矢量。w是各种扰动造成的过程噪声。可由上式得到状态模型如下:
其中状态量X=[r,v]T为航天器在太阳惯性坐标系下的位置及速度,为状态量X的导数,为时刻t的f(X(t),t)为***非线性连续状态转移函数,w为过程噪声,w(t)为时刻t的w。
2.判断是否有脉冲到达时间量测量
由于脉冲信号需要的观测周期较长,固与星光角距量测量及天文多普勒速度量测量相比,脉冲到达时间量测量的采样周期较长。因此,以星光角距量测量和天文多普勒速度量测量的采样周期作为滤波周期。当滤波时刻没有脉冲到达时间量测量时,对由状态模型及星光角距量测模型、差分天文多普勒速度量测模型构成的***模型通过UKF滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差。当滤波时刻有脉冲到达时间量测量时,对由状态模型及星光角距量测模型、差分天文多普勒速度量测模型、差分脉冲到达时间量测模型构成的***模型通过UKF滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差。
3.建立星光角距的量测模型
利用测角敏感器获得航天器与火卫一、火卫二及其背景恒星间的星光角距,以这些星光角距作为量测量建立量测模型:
其中αp1及αp2分别是航天器与火卫一及两颗背景恒星间的星光角距,αd1及αd2分别是航天器与火卫二及两颗背景恒星间的星光角距,rsp、rsd分别是火卫一、火卫二相对于航天器的位置矢量,s1、s2分别是惯性系下两颗恒星的方向矢量,rp、rd分别是火卫一、火卫二相对于太阳的位置矢量。
把这些星光角距作为量测量Z1=[αp1,αp2,αd1,αd2]T,可建立星光角距量测模型的表达式:
Z1=[αp1,αp2,αd1,αd2]T=h1[X(t),t]+v1(t) (4)
其中h1(·)表示星光角距的非线性连续量测函数,v1(t)表示t时刻星光角距的量测噪声。
4.建立差分天文多普勒速度的量测模型
利用光谱仪获得太阳光谱频移,并根据频移获得航天器相对太阳的径向速度,以此作为量测量建立量测模型:
其中vr表示航天器相对太阳的径向速度量测量,vrt表示航天器相对太阳的径向速度真实值,υp表示由于太阳光谱频率波动造成的扰动项,υm表示天文多普勒速度量测噪声。
建立差分天文多普勒速度的量测模型:
其中vr(t)及vr(t-1)分别是t时刻及t-1时刻航天器相对太阳的径向速度量测量,vrt(t)及vrt(t-1)分别是t时刻及t-1时刻航天器相对太阳的径向速度真实值,υp(t)及υp(t-1)分别是t时刻及t-1时刻太阳光谱频率波动造成的扰动项,υm(t)及υm(t-1)分别是t时刻及t-1时刻的量测噪声,△υp(t)=υp(t)-υp(t-1)是差分后υp的残差,△υm(t)=υm(t)-υm(t-1)是差分后υm的残差。
把差分天文多普勒速度作为量测量Z2=[vr(t)-vr(t-1)],可建立差分天文多普勒速度量测模型的表达式:
Z2=[vr(t)-vr(t-1)]=h2[X(t),X(t-1)]+v2(t) (7)
其中h2(·)表示差分天文多普勒速度的非线性连续量测函数,v2(t)表示t时刻差分天文多普勒速度的量测误差。用t-1时刻的后验状态估计代替X(t-1),则差分脉冲到达时间量测模型的表达式可写为:
Z2=h2[X(t),t]+v2(t) (8)
5.建立差分脉冲到达时间的量测模型
利用X射线脉冲星探测器获得脉冲到达时间量测量,以脉冲到达时间作为量测量建立量测模型:
其中tb表示脉冲星脉冲到达太阳系质心的时间,tSC表示脉冲星脉冲到达航天器的时间,rS表示航天器相对太阳系质心的位置矢量,c表示光速,n表示脉冲星在惯性系下的方向矢量,D0表示脉冲星到太阳系质心的距离,b表示太阳系质心相对太阳的位置矢量。
建立差分脉冲到达时间的量测模型:
其中τ(t)表示t时刻的差分脉冲到达时间,tb(t)及tb(t-1)分别表示t时刻及t-1时刻脉冲星脉冲到达太阳系质心的时间,tSC(t)及tSC(t-1)分别表示t时刻及t-1时刻脉冲星脉冲到达航天器的时间。
把差分脉冲到达时间作为量测量Z3=[τ(t)],可建立差分脉冲到达时间量测模型的表达式:
Z3=[τ(t)]=h3[X(t),X(t-1)]+v3(t) (11)
其中h3(·)表示差分脉冲到达时间的非线性连续量测函数,v3(t)表示t时刻差分脉冲到达时间的量测噪声。用t-1时刻的后验状态估计代替X(t-1),则差分脉冲到达时间量测模型的表达式可写为:
Z3=h3[X(t),t]+v3(t) (12)
6.进行离散化
当滤波时刻没有脉冲到达时间量测量时,设此时导航***的量测量Z12=[Z1,Z2]T,量测噪声v12=[v1,v2]T,导航***模型为:
其中h12(·)表示没有脉冲到达时间量测量时导航***的非线性连续量测函数。对式(13)进行离散化:
其中Xk及Z12k分别表示k时刻***的状态量及没有脉冲到达时间量测量时***的量测量,F(Xk-1,k-1)为f(X(t),t)离散后的非线性状态转移函数,H12(Xk,k)为h12[X(t),t]离散化后的非线性量测函数,Wk及V12k分别表示w(t)及v12(t)离散后的等效噪声。
当滤波时刻有脉冲到达时间量测量时,设此时导航***的量测量Z=[Z1,Z2,Z3]T,量测噪声v=[v1,v2,v3]T,导航***模型为:
其中h(·)表示有脉冲到达时间量测量时导航***的非线性连续量测函数。对式(15)进行离散化:
其中Zk表示k时刻***的量测量,H(Xk,k)为h[X(t),t]离散后的非线性量测函数,Vk表示v(t)离散后的等效噪声。
7.进行UKF滤波获得航天器的位置速度估计
当滤波时刻没有脉冲到达时间量测量时,对离散化后的***模型式(14)通过UKF进行滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差其中分别为第k时刻航天器相对太阳的位置、速度后验估计。当滤波时刻有脉冲到达时间量测量时,对离散化后的***模型式(16)通过UKF进行滤波获得及将及输出,同时将这些估计值返回滤波器,用于获得k+1时刻的输出。
本发明的原理是:利用星光角距获得完全可观测的航天器位置信息,但精度不高。利用前后时刻获得的脉冲到达时间量测量通过差分得到差分脉冲到达时间,减弱脉冲星角位置误差及星载原子钟钟差对导航精度的影响,获得高精度的位置信息。利用前后时刻获得的天文多普勒速度量测量通过差分得到差分天文多普勒速度,减弱恒星光谱动态变化对导航精度的影响,获得高精度的速度信息。根据轨道动力学建立航天器的状态模型,分别建立星光角距量测模型、差分脉冲到达时间量测模型及差分天文多普勒速度量测模型,离散化后使用UKF滤波得到航天器高精度的位置和速度。
本发明与现有技术相比的优点在于:(1)实现对航天器的高精度自主导航。(2)利用差分脉冲到达时间获得高精度的位置信息。(3)利用差分天文多普勒速度获得高精度的速度信息。
附图说明
图1为本发明中深空探测器测角/差分测速/差分测距组合导航方法流程图。
图2为本发明中星光角距量测模型示意图。
图3为本发明中X射线脉冲星测距导航原理示意图。
具体实施方式
图1给出了深空探测器测角/差分测速/差分测距组合导航方法***流程图。这里以火星探测接近段为例,详细说明本发明的具体实施过程:
1.建立基于轨道动力学的***状态模型
将航天器在火星接近段的运动描述为以太阳为中心天体的受摄三体模型,将其他扰动视为过程噪声。在太阳中心惯性坐标系(J2000.0)下的动力学模型可写为:
其中||·||表示矢量的2范数,||·||3表示||·||的立方,r和v是航天器相对太阳的位置和速度。μs和μm分别是太阳和火星的引力常数,rm是火星相对太阳的位置矢量,rsm=r-rm是航天器相对火星的位置矢量。w是各种扰动造成的过程噪声。可由上式得到状态模型如下:
其中状态量X=[r,v]T为航天器在太阳惯性坐标系下的位置及速度,为状态量X的导数,为时刻t的f(X(t),t)为***非线性连续状态转移函数,w为过程噪声,w(t)为时刻t的w。
2.判断是否有脉冲到达时间量测量
由于脉冲信号需要的观测周期较长,固与星光角距量测量及天文多普勒速度量测量相比,脉冲到达时间量测量的采样周期较长。因此,以星光角距量测量和天文多普勒速度量测量的采样周期作为滤波周期。当滤波时刻没有脉冲到达时间量测量时,对由状态模型及星光角距量测模型、差分天文多普勒速度量测模型构成的***模型通过UKF滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差。当滤波时刻有脉冲到达时间量测量时,对由状态模型及星光角距量测模型、差分天文多普勒速度量测模型、差分脉冲到达时间量测模型构成的***模型通过UKF滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差。
3.建立星光角距的量测模型
利用测角敏感器获得航天器与火卫一、火卫二及其背景恒星间的星光角距,以这些星光角距作为量测量建立量测模型。图2给出了星光角距量测模型示意图。其中rsp、rsd分别是火卫一、火卫二相对于航天器的位置矢量,s1、s2分别是惯性系下两颗恒星的方向矢量,rp、rd分别是火卫一、火卫二相对于太阳的位置矢量。星光角距量测模型可写为:
其中αp1及αp2分别是航天器与火卫一及两颗背景恒星间的星光角距,αd1及αd2分别是航天器与火卫二及两颗背景恒星间的星光角距。把这些星光角距作为量测量Z1=[αp1,αp2,αd1,αd2]T,可建立星光角距量测模型的表达式:
Z1=[αp1,αp2,αd1,αd2]T=h1[X(t),t]+v1(t) (4)
其中h1(·)表示星光角距的非线性连续量测函数,v1(t)表示t时刻星光角距的量测噪声。
4.建立差分天文多普勒速度的量测模型
利用光谱仪获得太阳光谱频移,并根据频移获得航天器相对太阳的径向速度,以此作为量测量建立量测模型:
其中vr表示航天器相对太阳的径向速度量测量,vrt表示航天器相对太阳的径向速度真实值,υp表示由于太阳光谱频率波动造成的扰动项,υm表示天文多普勒速度量测噪声。
建立差分天文多普勒速度的量测模型:
其中vr(t)及vr(t-1)分别是t时刻及t-1时刻航天器相对太阳的径向速度量测量,vrt(t)及vrt(t-1)分别是t时刻及t-1时刻航天器相对太阳的径向速度真实值,υp(t)及υp(t-1)分别是t时刻及t-1时刻太阳光谱频率波动造成的扰动项,υm(t)及υm(t-1)分别是t时刻及t-1时刻的量测噪声,△υp(t)=υp(t)-υp(t-1)是差分后υp的残差,△υm(t)=υm(t)-υm(t-1)是差分后υm的残差。
把差分天文多普勒速度作为量测量Z2=[vr(t)-vr(t-1)],可建立差分天文多普勒速度量测模型的表达式:
Z2=[vr(t)-vr(t-1)]=h2[X(t),X(t-1)]+v2(t) (7)
其中h2(·)表示差分天文多普勒速度的非线性连续量测函数,v2(t)表示t时刻差分天文多普勒速度的量测误差。用t-1时刻的后验状态估计代替X(t-1),则差分脉冲到达时间量测模型的表达式可写为:
Z2=h2[X(t),t]+v2(t) (8)
5.建立差分脉冲到达时间的量测模型
图3给出了X射线脉冲星测距导航原理示意图。其中tSC和tb分别表示第i颗脉冲星脉冲到达航天器和太阳系质心(SSB)的时间,n为日心惯性系下第i颗脉冲星的方向矢量,rS为探测器相对太阳系质心的位置矢量,可表示为rS=r-b,b为SSB相对太阳的位置矢量,c表示光速。由图可看出,c·(tb-tSC)可认为rS在n上的投影。考虑相对论效应和几何效应,时间转换模型可表示为:
其中D0表示脉冲星到太阳系质心的距离,等式右边第一项为几何距离产生的Doppler延迟,第二项表示X射线平行到达太阳系引起的时间延迟,通常把前两项统称为Roemer延迟,第三项表示在太阳引力场作用下光线弯曲产生的时间延迟,称为Shapiro延迟。
建立差分脉冲到达时间的量测模型:
其中τ(t)表示t时刻的差分脉冲到达时间,tb(t)及tb(t-1)分别表示t时刻及t-1时刻脉冲星脉冲到达太阳系质心的时间,tSC(t)及tSC(t-1)分别表示t时刻及t-1时刻脉冲星脉冲到达航天器的时间。
把差分脉冲到达时间作为量测量Z3=[τ(t)],可建立差分脉冲到达时间量测模型的表达式:
Z3=[τ(t)]=h3[X(t),X(t-1)]+v3(t) (11)
其中h3(·)表示差分脉冲到达时间的非线性连续量测函数,v3(t)表示t时刻差分脉冲到达时间的量测噪声。用t-1时刻的后验状态估计代替X(t-1),则差分脉冲到达时间量测模型的表达式可写为:
Z3=h3[X(t),t]+v3(t) (12)
6.进行离散化
当滤波时刻没有脉冲到达时间量测量时,设此时导航***的量测量Z12=[Z1,Z2]T,量测噪声v12=[v1,v2]T,导航***模型为:
其中h12(·)表示没有脉冲到达时间量测量时导航***的非线性连续量测函数。对式(13)进行离散化:
其中Xk及Z12k分别表示k时刻***的状态量及没有脉冲到达时间量测量时***的量测量,F(Xk-1,k-1)为f(X(t),t)离散后的非线性状态转移函数,H12(Xk,k)为h12[X(t),t]离散化后的非线性量测函数,Wk及V12k分别表示w(t)及v12(t)离散后的等效噪声。
当滤波时刻有脉冲到达时间量测量时,设此时导航***的量测量Z=[Z1,Z2,Z3]T,量测噪声v=[v1,v2,v3]T,导航***模型为:
其中h(·)表示有脉冲到达时间量测量时导航***的非线性连续量测函数。对式(15)进行离散化:
其中Zk表示k时刻***的量测量,H(Xk,k)为h[X(t),t]离散后的非线性量测函数,Vk表示v(t)离散后的等效噪声。
7.进行UKF滤波获得航天器的位置速度估计
对离散化后的***模型通过UKF进行滤波,具体步骤如下。
A.初始化状态量和状态误差方差阵P0
式中,是第0时刻(初始时刻)航天器位置及速度的估计值,X0是第0时刻航天器位置及速度的真实值。
B.选取sigma采样点
在附近选取一系列采样点,这些样本点的均值和协方差分别为和状态变量为6×1维,那么选取13个样本点及其权重w0,w1…,w12分别如下:
其中τ表示缩放参数,表示取平方根矩阵的第i行或列。
C.传递sigma采样点并获得先验估计及先验误差协方差
每个采样点的一步预测为:
合并所有获得先验状态估计为:
先验误差协方差为:
式中,Qk为k时刻状态模型噪声协方差阵。
D.量测更新
根据量测方程,计算每个采样点的预测量测量当滤波时刻没有脉冲到达时间量测量时:
当滤波时刻有脉冲到达时间量测量时:
合并所有获得预测量测Yk为:
计算预测量测协方差Pyy,k及互协方差Pxy,k:
其中Rk为k时刻***的量测噪声协方差阵。计算滤波增益Kk为:
计算后验状态估计
计算后验误差协方差
将及输出,同时将这些估计值返回滤波器,用于获得k+1时刻的输出。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (1)
1.一种深空探测器测角/差分测速/差分测距组合导航方法,其特征在于:根据轨道动力学建立航天器的状态模型,利用测角敏感器获得星光角距量测量,利用X射线脉冲星探测器获得脉冲到达时间量测量,利用光谱仪获得天文多普勒速度量测量,根据这些量测量分别建立星光角距量测模型、差分脉冲到达时间量测模型及差分天文多普勒速度量测模型;离散化后使用UKF滤波估计航天器的位置和速度;具体包括以下步骤:
①建立基于轨道动力学的***状态模型
将航天器在火星接近段的运动描述为以太阳为中心天体的受摄三体模型,将其他扰动视为过程噪声;在太阳中心惯性坐标系下的动力学模型可写为:
其中||·||表示矢量的2范数,||·||3表示||·||的立方,r和v是航天器相对太阳的位置和速度;μs和μm分别是太阳和火星的引力常数,rm是火星相对太阳的位置矢量,rsm=r-rm是航天器相对火星的位置矢量;w是各种扰动造成的过程噪声;可由上式得到状态模型如下:
其中状态量X=[r,v]T为航天器在太阳惯性坐标系下的位置及速度,为状态量X的导数,为时刻t的f(X(t),t)为***非线性连续状态转移函数,w为过程噪声,w(t)为时刻t的w;
②判断是否有脉冲到达时间量测量
由于脉冲信号需要的观测周期较长,固与星光角距量测量及天文多普勒速度量测量相比,脉冲到达时间量测量的采样周期较长;因此,以星光角距量测量和天文多普勒速度量测量的采样周期作为滤波周期;当滤波时刻没有脉冲到达时间量测量时,对由状态模型及星光角距量测模型、差分天文多普勒速度量测模型构成的***模型通过UKF滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差;当滤波时刻有脉冲到达时间量测量时,对由状态模型及星光角距量测模型、差分天文多普勒速度量测模型、差分脉冲到达时间量测模型构成的***模型通过UKF滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差;
③建立星光角距的量测模型
利用测角敏感器获得航天器与火卫一、火卫二及其背景恒星间的星光角距,以这些星光角距作为量测量建立量测模型:
其中αp1及αp2分别是航天器与火卫一及两颗背景恒星间的星光角距,αd1及αd2分别是航天器与火卫二及两颗背景恒星间的星光角距,rsp、rsd分别是火卫一、火卫二相对于航天器的位置矢量,s1、s2分别是惯性系下两颗恒星的方向矢量,rp、rd分别是火卫一、火卫二相对于太阳的位置矢量;
把这些星光角距作为量测量Z1=[αp1,αp2,αd1,αd2]T,可建立星光角距量测模型的表达式:
Z1=[αp1,αp2,αd1,αd2]T=h1[X(t),t]+v1(t) (4)
其中h1(·)表示星光角距的非线性连续量测函数,v1(t)表示t时刻星光角距的量测噪声;
④建立差分天文多普勒速度的量测模型
利用光谱仪获得太阳光谱频移,并根据频移获得航天器相对太阳的径向速度,以此作为量测量建立量测模型:
其中vr表示航天器相对太阳的径向速度量测量,vrt表示航天器相对太阳的径向速度真实值,υp表示由于太阳光谱频率波动造成的扰动项,υm表示天文多普勒速度量测噪声;
建立差分天文多普勒速度的量测模型:
其中vr(t)及vr(t-1)分别是t时刻及t-1时刻航天器相对太阳的径向速度量测量,vrt(t)及vrt(t-1)分别是t时刻及t-1时刻航天器相对太阳的径向速度真实值,υp(t)及υp(t-1)分别是t时刻及t-1时刻太阳光谱频率波动造成的扰动项,υm(t)及υm(t-1)分别是t时刻及t-1时刻的量测噪声,Δυp(t)=υp(t)-υp(t-1)是差分后υp的残差,Δυm(t)=υm(t)-υm(t-1)是差分后υm的残差;
把差分天文多普勒速度作为量测量Z2=[vr(t)-vr(t-1)],可建立差分天文多普勒速度量测模型的表达式:
Z2=[vr(t)-vr(t-1)]=h2[X(t),X(t-1)]+v2(t) (7)
其中h2(·)表示差分天文多普勒速度的非线性连续量测函数,v2(t)表示t时刻差分天文多普勒速度的量测误差;用t-1时刻的后验状态估计代替X(t-1),则差分脉冲到达时间量测模型的表达式可写为:
Z2=h2[X(t),t]+v2(t) (8)
⑤建立差分脉冲到达时间的量测模型
利用X射线脉冲星探测器获得脉冲到达时间量测量,以脉冲到达时间作为量测量建立量测模型:
其中tb表示脉冲星脉冲到达太阳系质心的时间,tSC表示脉冲星脉冲到达航天器的时间,rS表示航天器相对太阳系质心的位置矢量,c表示光速,n表示脉冲星在惯性系下的方向矢量,D0表示脉冲星到太阳系质心的距离,b表示太阳系质心相对太阳的位置矢量;
建立差分脉冲到达时间的量测模型:
其中τ(t)表示t时刻的差分脉冲到达时间,tb(t)及tb(t-1)分别表示t时刻及t-1时刻脉冲星脉冲到达太阳系质心的时间,tSC(t)及tSC(t-1)分别表示t时刻及t-1时刻脉冲星脉冲到达航天器的时间;
把差分脉冲到达时间作为量测量Z3=[τ(t)],可建立差分脉冲到达时间量测模型的表达式:
Z3=[τ(t)]=h3[X(t),X(t-1)]+v3(t) (11)
其中h3(·)表示差分脉冲到达时间的非线性连续量测函数,v3(t)表示t时刻差分脉冲到达时间的量测噪声;用t-1时刻的后验状态估计代替X(t-1),则差分脉冲到达时间量测模型的表达式可写为:
Z3=h3[X(t),t]+v3(t) (12)
⑥进行离散化
当滤波时刻没有脉冲到达时间量测量时,设此时导航***的量测量Z12=[Z1,Z2]T,量测噪声v12=[v1,v2]T,导航***模型为:
其中h12(·)表示没有脉冲到达时间量测量时导航***的非线性连续量测函数;对式进行离散化:
其中Xk及Z12k分别表示k时刻***的状态量及没有脉冲到达时间量测量时***的量测量,F(Xk-1,k-1)为f(X(t),t)离散后的非线性状态转移函数,H12(Xk,k)为h12[X(t),t]离散化后的非线性量测函数,Wk及V12k分别表示w(t)及v12(t)离散后的等效噪声;
当滤波时刻有脉冲到达时间量测量时,设此时导航***的量测量Z=[Z1,Z2,Z3]T,量测噪声v=[v1,v2,v3]T,导航***模型为:
其中h(·)表示有脉冲到达时间量测量时导航***的非线性连续量测函数;对式进行离散化:
其中Zk表示k时刻***的量测量,H(Xk,k)为h[X(t),t]离散后的非线性量测函数,Vk表示v(t)离散后的等效噪声;
⑦进行UKF滤波获得航天器的位置速度估计
当滤波时刻没有脉冲到达时间量测量时,对离散化后的***模型式通过UKF进行滤波获得惯性系下航天器相对太阳的后验状态估计以及后验误差协方差其中分别为第k时刻航天器相对太阳的位置、速度后验估计;当滤波时刻有脉冲到达时间量测量时,对离散化后的***模型式通过UKF进行滤波获得及将及输出,同时将这些估计值返回滤波器,用于获得k+1时刻的输出。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710478722.1A CN107024211B (zh) | 2017-06-22 | 2017-06-22 | 一种深空探测器测角/差分测速/差分测距组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710478722.1A CN107024211B (zh) | 2017-06-22 | 2017-06-22 | 一种深空探测器测角/差分测速/差分测距组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107024211A CN107024211A (zh) | 2017-08-08 |
CN107024211B true CN107024211B (zh) | 2019-10-29 |
Family
ID=59531918
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710478722.1A Active CN107024211B (zh) | 2017-06-22 | 2017-06-22 | 一种深空探测器测角/差分测速/差分测距组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107024211B (zh) |
Families Citing this family (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2019169638A1 (zh) * | 2018-03-09 | 2019-09-12 | Oppo广东移动通信有限公司 | 测量定时配置方法、终端设备及网络设备 |
CN110174850A (zh) * | 2019-04-30 | 2019-08-27 | 上海卫星工程研究所 | 测角测速组合导航半物理仿真验证***及其方法 |
CN110617820B (zh) * | 2019-09-29 | 2021-01-26 | 北京航空航天大学 | 一种基于太阳圆面速度差的自主天文导航方法 |
CN110940333B (zh) * | 2019-12-12 | 2021-07-13 | 中南大学 | 一种基于在线估计的深空探测器测角及时延组合导航方法 |
CN111551172B (zh) * | 2020-05-13 | 2022-05-10 | 北京航空航天大学 | 一种月球探测器测角/时间差分距离/速度组合导航方法 |
CN111623785B (zh) * | 2020-07-17 | 2022-02-15 | 中南大学 | 基于星间时间延迟量测的深空探测器自主导航方法 |
CN111947668B (zh) * | 2020-08-26 | 2022-03-18 | 中南大学 | 基于在线估计的木星探测器测角/测距组合导航方法 |
CN113551667B (zh) * | 2021-07-21 | 2024-05-24 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
CN113551668B (zh) * | 2021-07-21 | 2024-05-28 | 北京航空航天大学 | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101672651A (zh) * | 2009-09-25 | 2010-03-17 | 北京航空航天大学 | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 |
CN101692001A (zh) * | 2009-09-25 | 2010-04-07 | 北京航空航天大学 | 一种借力飞行轨道上深空探测器的自主天文导航方法 |
CN101876710A (zh) * | 2010-04-29 | 2010-11-03 | 北京航空航天大学 | 基于实时卫星信号模拟器同步增减可见卫星装置及构建法 |
CN103148856A (zh) * | 2013-03-04 | 2013-06-12 | 北京航空航天大学 | 一种基于自适应尺度变化的借力飞行探测器自主天文导航方法 |
CN104006813A (zh) * | 2014-04-03 | 2014-08-27 | 中国人民解放军国防科学技术大学 | 一种高轨卫星的脉冲星/星光角距组合导航方法 |
CN105203101A (zh) * | 2015-09-02 | 2015-12-30 | 北京航空航天大学 | 一种基于目标天体星历修正的深空探测器捕获段天文导航方法 |
CN106017480A (zh) * | 2016-05-20 | 2016-10-12 | 武汉科技大学 | 面向深空探测捕获段的深度组合导航方法 |
CN106204629A (zh) * | 2016-08-17 | 2016-12-07 | 西安电子科技大学 | 天基雷达与红外数据融合在轨动目标检测方法 |
CN106767845A (zh) * | 2017-02-20 | 2017-05-31 | 中国人民解放军国防科学技术大学 | 基于地球高轨‑地月平动点异构星座的航天器导航方法 |
-
2017
- 2017-06-22 CN CN201710478722.1A patent/CN107024211B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101672651A (zh) * | 2009-09-25 | 2010-03-17 | 北京航空航天大学 | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 |
CN101692001A (zh) * | 2009-09-25 | 2010-04-07 | 北京航空航天大学 | 一种借力飞行轨道上深空探测器的自主天文导航方法 |
CN101876710A (zh) * | 2010-04-29 | 2010-11-03 | 北京航空航天大学 | 基于实时卫星信号模拟器同步增减可见卫星装置及构建法 |
CN103148856A (zh) * | 2013-03-04 | 2013-06-12 | 北京航空航天大学 | 一种基于自适应尺度变化的借力飞行探测器自主天文导航方法 |
CN104006813A (zh) * | 2014-04-03 | 2014-08-27 | 中国人民解放军国防科学技术大学 | 一种高轨卫星的脉冲星/星光角距组合导航方法 |
CN105203101A (zh) * | 2015-09-02 | 2015-12-30 | 北京航空航天大学 | 一种基于目标天体星历修正的深空探测器捕获段天文导航方法 |
CN106017480A (zh) * | 2016-05-20 | 2016-10-12 | 武汉科技大学 | 面向深空探测捕获段的深度组合导航方法 |
CN106204629A (zh) * | 2016-08-17 | 2016-12-07 | 西安电子科技大学 | 天基雷达与红外数据融合在轨动目标检测方法 |
CN106767845A (zh) * | 2017-02-20 | 2017-05-31 | 中国人民解放军国防科学技术大学 | 基于地球高轨‑地月平动点异构星座的航天器导航方法 |
Non-Patent Citations (6)
Title |
---|
A Novel Differential Doppler Measurement-Aided Autonomous Celestial Navigation Method for Spacecraft During Approach Phase;XIAOLIN NING等;《IEEE TRANSACTIONS ON AEROSPACE AND ELECTROINC SYSTEMS》;20170430;第53卷(第2期);587-597 * |
Observability analysis of autonomous navigation for deep space exploration with LOSTOAvelocity measurements;Xin Ma等;《IEEE》;20161231;1-9 * |
基于X射线脉冲星的航天器自主导航方法研究;刘劲;《中国博士学位论文全文数据库工程科技II辑》;20110915(第9期);C032-8 * |
基于星光多普勒的脉冲星脉冲到达时间补偿;刘劲;《华中科技大学学报(自然科学版)》;20140131;第42卷(第1期);129-132 * |
脉冲多普勒导引头角跟踪***建模与仿真技术研究;王刚;《中国优秀硕士学位论文全文数据库工程科技II辑》;20060715(第7期);C032-20 * |
行星际间飞行的自主导航方法研究;何赟晟;《中国优秀硕士学问论文全文数据库工程科技II辑》;20120715(第7期);C031-416 * |
Also Published As
Publication number | Publication date |
---|---|
CN107024211A (zh) | 2017-08-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107024211B (zh) | 一种深空探测器测角/差分测速/差分测距组合导航方法 | |
CN107024212B (zh) | 一种深空探测器x射线脉冲星/时间差分天文多普勒组合导航方法 | |
CN105203101B (zh) | 一种基于目标天体星历修正的深空探测器捕获段天文导航方法 | |
CN103017774A (zh) | 单探测器脉冲星导航方法 | |
CN103063217B (zh) | 一种基于星历修正的深空探测器天文/无线电组合导航方法 | |
CN107421533B (zh) | 一种深空探测器x射线脉冲星toa/dtoa组合导航方法 | |
CN104296752B (zh) | 航天器天文测角测速组合自主导航***及其导航方法 | |
CN102997922B (zh) | 一种利用光学导航信息的脉冲到达时间差确定方法 | |
CN104457705A (zh) | 基于天基自主光学观测的深空目标天体初定轨方法 | |
CN112161632B (zh) | 一种基于相对位置矢量测量的卫星编队初始定位方法 | |
CN103217161B (zh) | 一种脉冲星导航位置和速度联合估计方法 | |
CN104316048B (zh) | 一种普适性的脉冲星自主导航测量模型构建方法 | |
CN110940333B (zh) | 一种基于在线估计的深空探测器测角及时延组合导航方法 | |
CN109443188A (zh) | 一种双层多维滑坡监测方法 | |
Sneeuw et al. | Science requirements on future missions and simulated mission scenarios | |
CN104764449A (zh) | 一种基于星历修正的捕获段深空探测器自主天文导航方法 | |
CN103968834A (zh) | 一种近地停泊轨道上深空探测器的自主天文导航方法 | |
CN103900577A (zh) | 一种面向编队飞行的相对导航测速及组合导航方法 | |
CN113091731A (zh) | 一种基于恒星视线相对论效应的航天器自主导航方法 | |
CN113375659A (zh) | 一种基于星光角距测量信息的脉冲星导航方法 | |
CN105988129A (zh) | 一种基于标量估计算法的ins/gnss组合导航方法 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的*** | |
CN107084726B (zh) | 一种基于太阳震荡时间延迟的自主天文导航方法 | |
CN116698048A (zh) | 一种基于脉冲星/星间测距/陆标的组合导航方法 | |
CN107830856B (zh) | 面向编队飞行的太阳tdoa量测方法及组合导航方法 |
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 |