CN104848862A - 一种环火探测器精密同步定位守时方法及*** - Google Patents
一种环火探测器精密同步定位守时方法及*** Download PDFInfo
- Publication number
- CN104848862A CN104848862A CN201510306661.1A CN201510306661A CN104848862A CN 104848862 A CN104848862 A CN 104848862A CN 201510306661 A CN201510306661 A CN 201510306661A CN 104848862 A CN104848862 A CN 104848862A
- Authority
- CN
- China
- Prior art keywords
- partiald
- pulsar
- clock
- equation
- detector
- 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
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/20—Instruments for performing navigational calculations
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Geophysics And Detection Of Objects (AREA)
Abstract
一种环火探测器精密同步定位守时方法及***,首先输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟;根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,得到探测器的轨道和钟差。本发明在建立X射线脉冲星观测模型基础上,将观测模型、探测器动力学模型和星载原子钟的钟差模型进行有机结合,同时估算了探测器的位置、速度和钟差参数,在实现钟差校正的同时也削弱了钟差对定位精度的影响,提高了自主定位精度。
Description
技术领域
本发明涉及火星探测技术领域,尤其涉及一种环火探测器精密同步定位守时方法及***。
背景技术
对于执行火星探索任务的火星轨道探测器而言,实时、高精度地获取探测器的位置、速度和姿态等相关信息,不仅是对探测器进行精密导航控制的基础,也是确保各种预定科学实验和探测任务顺利实施的决定性因素之一。
火星和地球之间的遥远距离和探测器所面临的复杂太空环境对基于地面测控通讯站的传统导航方法而言是一个巨大挑战,航天器的自主导航将是突破该瓶颈的关键技术之一。X射线脉冲星导航是一种新型自主导航方法,在火星探测器自主导航方面极具应用潜力。
在利用X射线脉冲星观测量对环火探测器进行定位时涉及到环火探测器的动力学模型和脉冲星观测模型,由环火探测器的动力学模型通过数值积分可以外推但仅能获得探测器的近似轨道信息,此外,由于技术条件限制,探测器的初始轨道状态也存在误差。
X射线脉冲星导航***中光子到达探测器的时间是由星载原子钟测量得到的,因此星载原子钟的精度及其稳定性直接关系到导航精度的高低。而由于火星探测器飞行时间长,探测器上搭载的原子钟,受到各种因素的限制,若不定期校正将难以长期保持较高精度,这样就回对导航***的精度造成损害。
目前已有的X射线脉冲星导航是一种新型自主导航方法,具备可靠性高、自主性强、精确性良好和使用范围广等特点,在深空探测器自主导航领域应用潜力巨大。目前国际上许多学者和专家都在这种新型自主导航方法进行研究和验证,国内外有大量的相关文献对其进行了介绍,Suneel I S.2005.The Use of Variable Celestial X-ray Sources for Spacecraft Navigation[D]:[Ph.D.].Maryland:Department of Aerospace Engineering University of Maryland.Wei Erhu,Jin Shuanggen,Zhang Qi,et al.2013Autonomous navigation of Mars probe using X-ray pulsars:Modeling and results[J].Advances in Space Research,51(2013):849–857.Emadzadeh A A,RobertA,Speyer J L,et al.2011.Relative Navigation between Two Spacecraft Using X-ray Pulsars[J].IEEE Transactions on Control Systems Technology,19(5):1021-1035.Yang Tinggao.2008.Determination of X-ray pulsar pulse time of arrival at spacecraft[J].Chin.J.Space Sci.,28(4):330-334.Chester T J,Butman S A.1981.Navigation Using X-ray Pulsars[R].NASATechnical Reports N81-27129,21-25.
利用X射线脉冲星观测量进行探测器自主定位的原理如图1所示。在基准点(太阳系质心SSB)坐标系中,空间飞行器Probe上的X射线探测设备接收脉冲信号,进而获得信号到达时间观测量,然后将其与基准点处的时间相位模型的计算值较差,差值τ反映了同一脉冲信号到达航天器和基准点处的时间延迟,τ与光速c的乘积为c·τ。该差分观测量可以表示为航天器位置矢量r的函数,在已知导航脉冲星方向矢量n的前提下,结合航天器的轨道动力学方程即可滤波估算出航天器在基准点坐标系中的位置向量。
通常情况下脉冲星时间相位模型通常建立在太阳系质心SSB处,在J2000.0太阳系质心坐标系中:
某一观测历元,脉冲星i的辐射信号至航天器SC和火星质心M的直接距离观测量ρSCi、ρMi为:
ρSCi=||rSC-Di||+dRel,SCi (1-1)
ρMi=||rM-Di||+dRel,Mi (1-2)
式中,rM和rSC分别表示火星质心和探测器的位置矢量;Di表示观测脉冲星的位置矢量;dRel,Mi和dRel,SCi分别表示相应的脉冲信号延迟观测误差。
式(1-2)减去(1-1)得到单差观测量δρi=ρMi-ρSCi和“单差测量方程”为:
δρi=(||rM-Di||-||rSC-Di||)+(dRel,Mi-dRel,SCi) (1-3)
因为脉冲星距离参考点的距离Di的量级远大于航天器参考点的距离,因此对式(1-3)进行展开,并忽略无穷小量以上的高阶项可得
δρi=ni·(rSC-rM)+(dRel,Mi-dRel,SCi) (1-4)
火星轨道探测器相对于火星质心的位置矢量rSC/M=rSC-rM,脉冲星的方向矢量为ni,则包含误差项的单差分观测方程为:
式中,单差改正量 和δrSC/M分别表示探测器相对于火星质心的位置向量及其改正数;tMi表示火星脉冲信号到达火星质心的时间;理想时钟读数为tSC;和δtSC分别为星载原子钟读出的时间和钟差改正量;c为光速;ηi代表随机测量噪声。
而在环火探测器自主定位中为了简化数据处理,通常用火星质心代替太阳系质心。
测量模型(1-5)中包含了原子钟的钟差参数,而研究分析表明0.5us的原子钟钟差会带来约300m的位置误差和0.03m/s的速度误差,而在目前的技术条件下应用于卫星和航天器的原子钟的理论稳定指标为应用于卫星和航天器的原子钟的理论稳定指标为5×10-12/s,对于任务周期较长的深空探测器来说,若不定期进行钟差校正,原子钟的钟差将累计至数十微秒甚至更多,这将给探测器的导航精度造成严重损害。
脉冲星与火星的距离遥远,脉冲信号微弱,X射线光子的累积一般需要8到10钟的时间,因此在新的观测数据未被采集期间,需要对探测器轨道进行精确预报。常用数值积分的方法进行探测器的轨道外推,该方法须要考虑探测器受到的中心引力和作用于探测器上的各项摄动力。
在J2000火星质心地球赤道坐标系SECI中,探测器的动力学模型可表示为:
式中,r=[x y z]T为探测器在SECI中的位置矢量,为其二阶导数,r=||r||;μM是火星引力常数;W为满足高斯分布的随机噪声;ar则代表探测器受到的各种摄动力所产生的摄动加速度总和。研究表明,对于中高轨道火星探测器而言火星非球形形状摄动中的J2项为最主要的影响。若仅考虑J2项摄动,则有:
式中
上式中,RM为火星平均半径。
若获得某一时刻的探测器轨道状态参数,便可利用建立的轨道动力学模型,通过数值积分的方法外推下一个时刻的轨道值。
综上所述,利用环火探测器轨道动力学模型进行轨道外推时,外推轨道的精度直接受轨道动力学模型的精确性和轨道积分方法的影响,此外初始轨道参数若存在误差,外推轨道将很快发散。从式(1-8)中可以看到,若不定期进行钟差校正,原子钟的钟差将对定位精度造成损害。
发明内容
针对以上问题,本发明在建立X射线脉冲星观测模型基础上,将观测模型、探测器动力学模型和星载原子钟的钟差模型进行有机结合,同时估算了探测器的位置、速度和钟差参数,在实现钟差校正的同时也削弱了钟差对定位精度的影响,提高了自主定位精度。
本发明的技术方案提供一种环火探测器精密同步定位守时方法,包括以下步骤,
步骤1,输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;
步骤2,进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟,
设导航脉冲星组合中包括p颗脉冲星,环火探测器的位置矢量r=[x y z]T、速度矢量v=[vx vy vz]T,加速度矢量a=[ax ay az]T,
所述脉冲星测量方程如下式,
其中,Δti表示第i颗脉冲星时延观测量,i的取值为1,2,…,p,p颗脉冲星观测量组成观测向量Z,η为测量噪声,H为观测方程系数矩阵,状态参数X=[x y z vx vy vz x1 x2 x3]T;
所述钟差模型如下式,
其中,ε为采样间隔,x1(tk)、x2(tk)和x3(tk)分别表示时刻tk原子钟的钟差、频率漂移和频率漂移变化率,组成了钟差参数[x1 x2 x3];W(tk)为时刻tk相应的***噪声,x1(tk+1)表示时刻tk+1原子钟的钟差;
步骤3,根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,
所述观测方程采用脉冲星测量方程,
设时刻t的状态参数X记为X(t),X(t)的一阶导数为所述滤波状态方程如下,
其中,W(t)为***状态噪声矩阵,
状态方程系数矩阵F(t)为,
步骤4,输出步骤3所得滤波结果,包括滤波所得探测器的轨道和钟差。
而且,步骤3进行自适应卡尔曼滤波的方式如下,
1)滤波的相关参数初始化,包括计算初始时刻的状态参数xk及其方差矩阵Pk,状态误差δxk;
2)进行一步预测值xk+1,k和修正值δxk+1,k计算如下,
xk+1,k=Φk+1,k·xk
δxk+1,k=0
其中,Φk+1,k为状态转移矩阵;
3)进行自适应因子λk+1的计算如下,
δzk+1=zk+1-Hk+1xk+1,k
式中,Hk+1表示观测方程系数矩阵;符号Mk+1和Nk+1用于计算自适应因子;zk+1为观测值向量;预测残差为δzk+1;Rk+1为观测值误差方差矩阵;sp(.)为求矩阵迹符号;
4)进行一步预测估计误差方差阵Pk+1,k的计算如下,
式中,Qk为***状态噪声方差矩阵;
5)进行滤波增益Kk+1的计算如下,
6)进行测量更新如下,
δxk+1=δxk+1,k+Kk+1[zk+1-Hk+1xk+1,k]
式中,Pk+1为滤波状态值xk+1的方差矩阵,I表示相应阶数的单位矩阵;
7)进行滤波结果xk+1输出如下,
xk+1=xk+1,k+δxk+1
而且,所述一步预测值xk+1,k由轨道积分器按滤波状态方程进行数值积分计算。
而且,预先根据脉冲星的可见性和优选指标值选择导航脉冲星组合。
而且,模拟的标称轨道根据STK仿真得到。
而且,将步骤3滤波所得探测器的轨道与模拟的标称轨道较差,将步骤3滤波所得钟差与步骤2模拟所得钟差较差,得到精度评定结果。
本发明还相应提供一种环火探测器精密同步定位守时***,包括以下模块,
输入模块,用于输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;
观测数据模拟模块,用于进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟,
设导航脉冲星组合中包括p颗脉冲星,环火探测器的位置矢量r=[x y z]T、速度矢量v=[vx vy vz]T,加速度矢量a=[ax ay az]T,
所述脉冲星测量方程如下式,
其中,Δti表示第i颗脉冲星时延观测量,i的取值为1,2,…,p,p颗脉冲星观测量组成观测向量Z,η为测量噪声,H为观测方程系数矩阵,状态参数X=[x y z vx vy vz x1 x2 x3]T;
所述钟差模型如下式,
其中,ε为采样间隔,x1(tk)、x2(tk)和x3(tk)分别表示时刻tk原子钟的钟差、频率漂移和频率漂移变化率,组成了钟差参数[x1 x2 x3];W(tk)为时刻tk相应的***噪声,x1(tk+1)表示时刻tk+1原子钟的钟差;
自适应滤波模块,用于根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,
所述观测方程采用脉冲星测量方程,
设时刻t的状态参数X记为X(t),X(t)的一阶导数为所述滤波状态方程如下,
其中,W(t)为***状态噪声矩阵,
状态方程系数矩阵F(t)为,
输出模块,用于输出自适应滤波模块所得滤波结果,包括滤波所得探测器的轨道和钟差。
本发明考虑利用X射线脉冲星观测量,结合探测器的轨道动力学模型和星载原子钟的钟差模型,通过自适应滤波快速、高精度地估算环火探测器的位置、速度和钟差参数,从而校正星载原子钟,削弱或消除钟差对定位精度的影响,实现环火探测器的精密同步定位和守时。本发明还改进了自适应滤波实现方式,进一步提高效率。本发明是在国家自然科学基金支持下完成的,具有重要的实际推广价值和应用前景,对国民经济的发展和人民生活水平的提高有不可忽视的作用。
附图说明
图1是现有技术利用X射线脉冲星观测量进行探测器自主定位的原理图;
图2是本发明实施例的流程图。
具体实施方式
以下结合附图和实施例对本发明技术方案进行具体描述。
本发明考虑,X射线脉冲星观测量的精度相对较高,若能通过滤波算法将动力学模型和测量模型结合起来,利用精度较高的X射线脉冲星观测量对轨道外推状态值进行实时修正,便可以高精度地估算环火探测器的轨道状态参数。
在环火探测器自主定位中,火星轨道探测器的动力学模型还不能精确建立,在数值积分进行轨道外推时一些摄动因素的影响通常被忽略,直接导致外推轨道精度较差,而且由于技术条件限制,初始轨道参数难以精确获得,这也会引起外推轨道的发散。如何利用精度较高的X射线脉冲星观测量,通过滤波算法实现探测器状态参数的快速、高精度估算是实现精密定位的首要问题之一。此外,由于火星探测器飞行时间长,其上所搭载的原子钟若不进行定期校正将难以保持较高的精度,由X射线脉冲星的测量模型可知,探测器的原子钟钟差对定位精度影响很大,因此如何有效地实现对钟差的估算,是保持原子钟精度和提高探测器自主定位精度所面临的有一个关键问题。本发明的解决方案就是建立了一种有效融合X射线脉冲星观测模型、探测器轨道动力学模型和钟差模型的综合模型,设计了一种自适应扩展卡尔曼滤波算法,实现探测器位置、速度和钟差参数的同步、快速、高精度解算。具体方案如下:(1)建立基于X射线脉冲星的环火探测器精密自主定位和守时模型,包括测量模型、探测器轨道动力学模型和星载原子钟的钟差模型。
结合环火探测器的具体情况,建立相应的测量模型;要分析环火探测器受力情况,在综合精度和计算效率的基础上对一些摄动因素进行取舍,然后确定探测器的轨道动力学模型;了解星载原子钟的工作原理和性能评估方法,在此基础上对钟差进行有效地建模。
(2)设计自适应扩展卡尔曼滤波算法,将测量模型、轨道动力学模型和原子钟的钟差模型有效地融合利用,将钟差模型参数引入到滤波算法中,同探测器的位置和速度参数同步解算,实现快速、高精度定位和守时。
(3)具体实现
包括观测数据模拟和自适应扩展卡尔曼滤波解算两大环节,具体设计如下:
具体实施时,可利用STK软件仿真环火探测器轨道作为“标称轨道”,并从导航脉冲星数据库中选择合适的导航星,根据轨道测量模型(1-5)式模拟脉冲星观测量,模拟过程中要顾及时钟误差、观测误差、相对论效应延迟等影响。
结合环火探测器的具体情况,建立探测器的X射线脉冲星观测方程。
在J2000火星质心地球赤道坐标系SECI中,若同一时段观测了p颗脉冲星,则环火探测器自主定位和守时***的测量方程为:
式中,Δti表示第i颗脉冲星时延观测量,i的取值为1,2,…,p,p颗脉冲星观测量组成观测向量Z;η为测量噪声;状态参数X=[x y z vx vy vz x1 x2 x3]T,观测方程系数矩阵H为:
式中,ni为第i颗脉冲星的方向矢量;c为光速值。
分析环火探测器的受力情况,确定定轨中要考虑的摄动因素,建立环火探测器的轨道动力学方程,并利用泰勒级数进行线性化展开。
在J2000火星质心地球赤道坐标系SECI中,设环火探测器的位置矢量r=[x y z]T、速度矢量v=[vx vy vz]T、加速度矢量a=[ax ay az]T;探测器的状态参数向量为x(t)=[x y z vx vy vz]T,x(t)的一阶导数为ω(t)为t时刻状态噪声,则t时刻它的动力学方程可表达为:
在仅考虑火星中心引力及J2项摄动的情况下该方程可作如下表示:
f(x(t),t)表示探测器动力学方程式,即探测器轨道模型,下文公式中简写为f。
式(2-4)为非线性***,需要在“平衡点”处通过泰勒级数展开进行线性化得:
公式(2-5)中t时刻雅克比矩阵G(t)简写为G,其计算方法:
式中,03×3表示零矩阵;I3×3表示单位矩阵。
建立原子钟的钟差模型,并将钟差状态方程与动力学方程结合组成滤波状态方程,将钟差模型参数与探测器的位置、速度参数作为滤波参数。
一般地,原子钟的时间偏差可以用一个二阶多项式表示:
式中,ε为采样间隔,x1(tk)、x2(tk)和x3(tk)分别表示tk时刻原子钟的钟差、频率漂移和频率漂移变化率,它们组成了钟差参数[x1 x2 x3];W(tk)为tk时刻相应的***噪声,属于有色噪声;x1(tk+1)表示tk+1时刻原子钟的钟差。
由式(2-10)可得,以时钟钟差x1(tk)、时钟频率漂移x2(tk)和频率漂移变化率x3(tk)组成状态量 则钟差模型为:
式中,Φk+1,k为状态转移矩阵,该矩阵与采样间隔τ有关,表达式为:
式中,ωk为tk时刻钟差噪声向量。
设时刻t的状态参数X=[x y z vx vy vz x1 x2 x3]T记为X(t),X(t)的一阶导数为结合环火探测器轨道动力学方程(2-4)和钟差模型(2-11)可得环火探测器脉冲星自主定位和守时***的状态方程为:
式中,W(t)为***状态噪声矩阵,状态方程系数矩阵F(t)为:
设计自适应扩展卡尔曼滤波器,利用X射线脉冲星观测量修正滤波状态参数预估值,快速、高精度地解算探测器的位置、速度参数和钟差模型参数。
通过公式(2-1)到公式(2-14)建立了环火探测器自主定位和守时的滤波状态方程和观测方程,接着需要采用自适应扩展卡尔曼滤波器,进行相关的滤波计算。本发明进一步提出,在现有自适应扩展卡尔曼滤波器(AEKF滤波器)基础上,还可以改进自适应因子和误差方差阵的计算方式,以提高滤波收敛速度,抑制滤波发散,参见以下公式(2-18)到公式(2-22)。
线性化后***状态转移矩阵Φk+1,k,观测方程矩阵Hk+1,状态方程和观测方程分别为:
其中k、k+1对应离散化之前的tk和tk+1时刻。
实施例自适应扩展卡尔曼滤波器计算过程设计如下:
●滤波参数初始化
根据现有的技术条件,给出计算初始时刻的状态参数xk及其方差矩阵Pk,状态误差为δxk。
●一步预测值xk+1,k和修正值δxk+1,k计算
xk+1,k=Φk+1,k·xk (2-16)
δxk+1,k=0 (2-17)
●自适应因子λk+1的计算
δzk+1=zk+1-Hk+1xk+1,k (2-19)
式中,Hk+1表示观测方程系数矩阵;符号Mk+1和Nk+1用于计算自适应因子;zk+1为观测值向量;预测残差为δzk+1;Rk+1为观测值误差方差矩阵;sp(.)为求矩阵迹符号。
●一步预测估计误差方差阵Pk+1,k的计算
式中,Qk为***状态噪声方差矩阵。
●滤波增益Kk+1的计算
●测量更新
δxk+1=δxk+1,k+Kk+1[zk+1-Hk+1xk+1,k] (2-24)
式中,Pk+1为滤波状态值xk+1的方差矩阵,I表示相应阶数的单位矩阵。
●滤波结果xk+1输出
xk+1=xk+1,k+δxk+1 (2-26)
在给定探测器初始状态和初始钟差参数的情况下,便可利用上述自适应扩展卡尔曼滤波器进行定位和守时参数的计算。
本发明所提供方法可采用软件方式实现自动运行。参见图2,实施例的实现流程如下:步骤1,输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数。
模拟的标称轨道可根据STK仿真得到,具体实施时,可以预先准备好STK仿真的环火探测器轨道数据文件,以作为初始轨道参数供STK模拟得到标称轨道。还可以预先准备候选脉冲星参数文件,根据导航脉冲星个数,利用现有脉冲星优选程序根据脉冲星的可见性和优选指标值选择最适合的导航脉冲星组合。
步骤2,进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟。
根据脉冲星测量方程(2-1)式模拟脉冲星观测量,该观测量一般要加入随机观测误差、钟差、Roemer延迟和Shapiro延迟,其中钟差由钟差模型(2-10)式模拟,基于预设的时刻tk的钟差初始参数,即可模拟时刻tk+1原子钟的钟差。其他误差可根据现有技术预设。
步骤3,根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波。
然后进入自适应卡尔曼滤波和精度评定模块,滤波状态方程和观测方程分别为式(2-13)和(2-1),具体滤波流程按公式(2-16)~(2-26)进行,其中一步预测值的计算(2-16)式可由轨道积分器按式(2-13)进行数值积分计算,获得测数据预报。轨道积分器可采用现有技术,本发明不予赘述。
滤波完成后可将计算得到的探测器的轨道与①中STK模拟的标称轨道较差,滤波计算得到的钟差与③中模拟的钟差较差,完成精度评定。
步骤4,输出滤波结果,包括滤波所得探测器的轨道和钟差。
具体实施时,还可将步骤3滤波所得探测器的轨道与模拟的标称轨道较差,将步骤3滤波所得钟差与步骤2模拟所得钟差较差,得到精度评定结果。
具体实施时,也可以采用模块化方式提供一种环火探测器精密同步定位守时***,实施例所提供***包括以下模块:
输入模块,用于输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;
观测数据模拟模块,用于进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟,
设导航脉冲星组合中包括p颗脉冲星,环火探测器的位置矢量r=[x y z]T、速度矢量v=[vx vy vz]T,加速度矢量a=[ax ay az]T,
所述脉冲星测量方程如下式,
其中,Δti表示第i颗脉冲星时延观测量,i的取值为1,2,…,p,p颗脉冲星观测量组成观测向量Z,η为测量噪声,H为观测方程系数矩阵,状态参数X=[x y z vx vy vz x1 x2 x3]T;
所述钟差模型如下式,
其中,ε为采样间隔,x1(tk)、x2(tk)和x3(tk)分别表示时刻tk原子钟的钟差、频率漂移和频率漂移变化率,组成了钟差参数[x1 x2 x3];W(tk)为时刻tk相应的***噪声,x1(tk+1)表示时刻tk+1原子钟的钟差;
自适应滤波模块,用于根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,
所述观测方程采用脉冲星测量方程,
设时刻t的状态参数X记为X(t),X(t)的一阶导数为所述滤波状态方程如下,
其中,W(t)为***状态噪声矩阵,
状态方程系数矩阵F(t)为,
输出模块,用于输出自适应滤波模块所得滤波结果,包括滤波所得探测器的轨道和钟差。
各模块具体实现与方法步骤相应,本发明不予赘述。
以上实施例仅供说明本发明之用,而非对本发明的限制,有关技术领域的技术人员,在不脱离本发明的精神和范围的情况下,还可以作出各种变换或变型,因此所有等同的技术方案也应该属于本发明的范畴之内,应由各权利要求限定。
Claims (7)
1.一种环火探测器精密同步定位守时方法,其特征在于:包括以下步骤,
步骤1,输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;
步骤2,进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟,
设导航脉冲星组合中包括p颗脉冲星,环火探测器的位置矢量r=[x y z]T、速度矢量v=[vx vy vz]T,加速度矢量a=[ax ay az]T,
所述脉冲星测量方程如下式,
其中,Δti表示第i颗脉冲星时延观测量,i的取值为1,2,…,p,p颗脉冲星观测量组成观测向量Z,η为测量噪声,H为观测方程系数矩阵,状态参数X=[x y z vx vy vz x1x2x3]T;
所述钟差模型如下式,
其中,ε为采样间隔,x1(tk)、x2(tk)和x3(tk)分别表示时刻tk原子钟的钟差、频率漂移和频率漂移变化率,组成了钟差参数[x1 x2 x3];W(tk)为时刻tk相应的***噪声,x1(tk+1)表示时刻tk+1原子钟的钟差;
步骤3,根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,
所述观测方程采用脉冲星测量方程,
设时刻t的状态参数X记为X(t),X(t)的一阶导数为所述滤波状态方程如下,
其中,W(t)为***状态噪声矩阵,
状态方程系数矩阵F(t)为,
步骤4,输出步骤3所得滤波结果,包括滤波所得探测器的轨道和钟差。
2.根据权利要求1所述环火探测器精密同步定位守时方法,其特征在于:步骤3进行自适应卡尔曼滤波的方式如下,
1)滤波的相关参数初始化,包括计算初始时刻的状态参数xk及其方差矩阵Pk,状态误差δxk;
2)进行一步预测值xk+1,k和修正值δxk+1,k计算如下,
xk+1,k=Φk+1,k·xk
δxk+1,k=0
其中,Φk+1,k为状态转移矩阵;
3)进行自适应因子λk+1的计算如下,
δzk+1=zk+1-Hk+1xk+1,k
式中,Hk+1表示观测方程系数矩阵;符号Mk+1和Nk+1用于计算自适应因子;zk+1为观测值向量;预测残差为δzk+1;Rk+1为观测值误差方差矩阵;sp(.)为求矩阵迹符号;
4)进行一步预测估计误差方差阵Pk+1,k的计算如下,
式中,Qk为***状态噪声方差矩阵;
5)进行滤波增益Kk+1的计算如下,
6)进行测量更新如下,
δxk+1=δxk+1,k+Kk+1[zk+1-Hk+1xk+1,k]
式中,Pk+1为滤波状态值xk+1的方差矩阵,I表示相应阶数的单位矩阵;
7)进行滤波结果xk+1输出如下,
xk+1=xk+1,k+δxk+1。
3.根据权利要求2所述环火探测器精密同步定位守时方法,其特征在于:所述一步预测值xk+1,k由轨道积分器按滤波状态方程进行数值积分计算。
4.根据权利要求1或2或3所述环火探测器精密同步定位守时方法,其特征在于:预先根据脉冲星的可见性和优选指标值选择导航脉冲星组合。
5.根据权利要求1或2或3所述环火探测器精密同步定位守时方法,其特征在于:模拟的标称轨道根据STK仿真得到。
6.根据权利要求1或2或3所述环火探测器精密同步定位守时方法,其特征在于:将步骤3滤波所得探测器的轨道与模拟的标称轨道较差,将步骤3滤波所得钟差与步骤2模拟所得钟差较差,得到精度评定结果。
7.一种环火探测器精密同步定位守时***,其特征在于:包括以下模块,
输入模块,用于输入初始数据,包括模拟的标称轨道和用于滤波初始化的相关参数;
观测数据模拟模块,用于进行观测数据模拟,根据脉冲星测量方程模拟脉冲星观测量,该观测量涉及的测量噪声包括钟差,其中钟差由钟差模型模拟,
设导航脉冲星组合中包括p颗脉冲星,环火探测器的位置矢量r=[x y z]T、速度矢量v=[vx vy vz]T,加速度矢量a=[ax ay az]T,
所述脉冲星测量方程如下式,
其中,Δti表示第i颗脉冲星时延观测量,i的取值为1,2,…,p,p颗脉冲星观测量组成观测向量Z,η为测量噪声,H为观测方程系数矩阵,状态参数X=[x y z vx vy vz x1 x2 x3]T;
所述钟差模型如下式,
其中,ε为采样间隔,x1(tk)、x2(tk)和x3(tk)分别表示时刻tk原子钟的钟差、频率漂移和频率漂移变化率,组成了钟差参数[x1 x2 x3];W(tk)为时刻tk相应的***噪声,x1(tk+1)表示时刻tk+1原子钟的钟差;
自适应滤波模块,用于根据环火探测器自主定位和守时的滤波状态方程和观测方程,进行自适应卡尔曼滤波,
所述观测方程采用脉冲星测量方程,
设时刻t的状态参数X记为X(t),X(t)的一阶导数为所述滤波状态方程如下,
其中,W(t)为***状态噪声矩阵,
状态方程系数矩阵F(t)为,
输出模块,用于输出自适应滤波模块所得滤波结果,包括滤波所得探测器的轨道和钟差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510306661.1A CN104848862B (zh) | 2015-06-05 | 2015-06-05 | 一种环火探测器精密同步定位守时方法及*** |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510306661.1A CN104848862B (zh) | 2015-06-05 | 2015-06-05 | 一种环火探测器精密同步定位守时方法及*** |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104848862A true CN104848862A (zh) | 2015-08-19 |
CN104848862B CN104848862B (zh) | 2016-09-14 |
Family
ID=53848688
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510306661.1A Active CN104848862B (zh) | 2015-06-05 | 2015-06-05 | 一种环火探测器精密同步定位守时方法及*** |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104848862B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106679675A (zh) * | 2016-12-29 | 2017-05-17 | 北京理工大学 | 一种基于相对测量信息的火星最终接近段自主导航方法 |
CN107589441A (zh) * | 2017-09-07 | 2018-01-16 | 成都理工大学 | 基于卡尔曼滤波器通道的脉冲堆积修正方法 |
CN109283556A (zh) * | 2018-09-13 | 2019-01-29 | 垣纬多媒体卫星通信(上海)有限公司 | 一种不中断导航服务的低轨导航卫星时钟调整方法 |
CN110823257A (zh) * | 2019-12-16 | 2020-02-21 | 中国人民解放军63921部队 | 深空多普勒测量数据时标偏差的自校准方法 |
CN111142358A (zh) * | 2020-01-20 | 2020-05-12 | 山东科技大学 | 一种基于自然x射线源观测的深空自主守时方法 |
CN113074741A (zh) * | 2021-03-18 | 2021-07-06 | 中国人民解放***箭军工程大学 | 一种脉冲星方位误差估计的增广状态算法 |
CN113137975A (zh) * | 2020-05-28 | 2021-07-20 | 西安天和防务技术股份有限公司 | 天文惯性组合导航的惯性校正方法、装置及电子设备 |
WO2022001458A1 (zh) * | 2020-06-29 | 2022-01-06 | 北京东方计量测试研究所 | 广域空间内统一时间的方法和空间守时***、存储介质 |
CN114415488A (zh) * | 2021-12-31 | 2022-04-29 | 北京无线电计量测试研究所 | 一种原子钟钟差数据异常检测及修正方法和*** |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101799658A (zh) * | 2010-02-24 | 2010-08-11 | 华中科技大学 | 一种gps校准的守时钟 |
US20120046863A1 (en) * | 2010-08-12 | 2012-02-23 | The Government Of The Us, As Represented By The Secretary Of The Navy | Orbit covariance, estimation and analysis tool |
CN103176190A (zh) * | 2013-03-06 | 2013-06-26 | 西北工业大学 | 基于卫星导航和Kalman滤波的高精度授时***及方法 |
CN103454905A (zh) * | 2013-09-13 | 2013-12-18 | 烟台东方英达康自动化技术有限公司 | 一种时间同步方法 |
-
2015
- 2015-06-05 CN CN201510306661.1A patent/CN104848862B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101799658A (zh) * | 2010-02-24 | 2010-08-11 | 华中科技大学 | 一种gps校准的守时钟 |
US20120046863A1 (en) * | 2010-08-12 | 2012-02-23 | The Government Of The Us, As Represented By The Secretary Of The Navy | Orbit covariance, estimation and analysis tool |
CN103176190A (zh) * | 2013-03-06 | 2013-06-26 | 西北工业大学 | 基于卫星导航和Kalman滤波的高精度授时***及方法 |
CN103454905A (zh) * | 2013-09-13 | 2013-12-18 | 烟台东方英达康自动化技术有限公司 | 一种时间同步方法 |
Non-Patent Citations (3)
Title |
---|
王奕迪: "《深空探测中的X射线脉冲星导航方法研究》", 《国防科学技术大学研究生院硕士学位论文》, 31 December 2011 (2011-12-31), pages 23 - 30 * |
王奕迪等: "《基于单探测器的同步定位/守时算法研究》", 《第三届中国卫星导航学术年会电子文集》, 31 December 2012 (2012-12-31) * |
赵文骏 等: "基于自适应滤波的微弱GPS信号跟踪方法", 《计算机仿真》 * |
Cited By (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106679675B (zh) * | 2016-12-29 | 2019-10-29 | 北京理工大学 | 一种基于相对测量信息的火星最终接近段自主导航方法 |
CN106679675A (zh) * | 2016-12-29 | 2017-05-17 | 北京理工大学 | 一种基于相对测量信息的火星最终接近段自主导航方法 |
CN107589441A (zh) * | 2017-09-07 | 2018-01-16 | 成都理工大学 | 基于卡尔曼滤波器通道的脉冲堆积修正方法 |
CN107589441B (zh) * | 2017-09-07 | 2019-08-02 | 成都理工大学 | 基于卡尔曼滤波器通道的脉冲堆积修正方法 |
CN109283556A (zh) * | 2018-09-13 | 2019-01-29 | 垣纬多媒体卫星通信(上海)有限公司 | 一种不中断导航服务的低轨导航卫星时钟调整方法 |
CN109283556B (zh) * | 2018-09-13 | 2021-09-07 | 上海垣信卫星科技有限公司 | 一种不中断导航服务的低轨导航卫星时钟调整方法 |
CN110823257B (zh) * | 2019-12-16 | 2021-07-16 | 中国人民解放军63921部队 | 深空多普勒测量数据时标偏差的自校准方法 |
CN110823257A (zh) * | 2019-12-16 | 2020-02-21 | 中国人民解放军63921部队 | 深空多普勒测量数据时标偏差的自校准方法 |
CN111142358A (zh) * | 2020-01-20 | 2020-05-12 | 山东科技大学 | 一种基于自然x射线源观测的深空自主守时方法 |
CN113137975A (zh) * | 2020-05-28 | 2021-07-20 | 西安天和防务技术股份有限公司 | 天文惯性组合导航的惯性校正方法、装置及电子设备 |
CN113137975B (zh) * | 2020-05-28 | 2024-03-19 | 西安天和防务技术股份有限公司 | 天文惯性组合导航的惯性校正方法、装置及电子设备 |
WO2022001458A1 (zh) * | 2020-06-29 | 2022-01-06 | 北京东方计量测试研究所 | 广域空间内统一时间的方法和空间守时***、存储介质 |
CN113074741A (zh) * | 2021-03-18 | 2021-07-06 | 中国人民解放***箭军工程大学 | 一种脉冲星方位误差估计的增广状态算法 |
CN114415488A (zh) * | 2021-12-31 | 2022-04-29 | 北京无线电计量测试研究所 | 一种原子钟钟差数据异常检测及修正方法和*** |
CN114415488B (zh) * | 2021-12-31 | 2024-04-02 | 北京无线电计量测试研究所 | 一种原子钟钟差数据异常检测及修正方法和*** |
Also Published As
Publication number | Publication date |
---|---|
CN104848862B (zh) | 2016-09-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104848862B (zh) | 一种环火探测器精密同步定位守时方法及*** | |
CN100575877C (zh) | 基于多信息融合的航天器组合导航方法 | |
CN103674032B (zh) | 融合脉冲星辐射矢量和计时观测的卫星自主导航***及方法 | |
CN102879014B (zh) | 深空探测接近过程的光学成像自主导航半物理仿真试验*** | |
CN107421550B (zh) | 一种基于星间测距的地球-Lagrange联合星座自主定轨方法 | |
CN101216319B (zh) | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 | |
CN103674034B (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN104236546A (zh) | 一种卫星星光折射导航误差确定与补偿方法 | |
CN101672651B (zh) | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 | |
CN103017760B (zh) | 一种大椭圆轨道火星探测器自主对火定向方法 | |
CN102313905B (zh) | 基于星间速度插值原理的地球重力反演方法 | |
CN102878997B (zh) | 一种大偏心率轨道的星上快速高精度外推方法 | |
CN103591956B (zh) | 一种基于可观测性分析的深空探测器自主导航方法 | |
CN103047986B (zh) | 一种大尺度时空及在轨动态效应模拟方法 | |
Liu et al. | Analytical investigations of quasi-circular frozen orbits in the Martian gravity field | |
De Marchi et al. | Constraining the Nordtvedt parameter with the BepiColombo Radioscience experiment | |
CN105487405A (zh) | 低低跟踪重力测量卫星半物理仿真*** | |
CN108959665B (zh) | 适用于低轨卫星的轨道预报误差经验模型生成方法及*** | |
CN101608921B (zh) | 一种脉冲星/cns组合导航方法 | |
Jiancheng et al. | Installation direction analysis of star sensors by hybrid condition number | |
CN104408326B (zh) | 一种对深空探测自主导航滤波算法的评估方法 | |
CN103364836A (zh) | 月球探测器落点预报方法 | |
Kuang et al. | GPS-based attitude determination of gyrostat satellite by quaternion estimation algorithms | |
Tombasco et al. | Specialized coordinate representation for dynamic modeling and orbit estimation of geosynchronous orbits | |
CN104713561A (zh) | 一种月球探测器精密定轨方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |