本发明涉及深空探测器导航方法,具体涉及一种用于深空探测器的高可观度光学脉冲星混合导航方法,其综合利用该天体的角度观测信息以及脉冲星距离观测信息,以计算深空探测器主精度导航信息。
背景技术:
地面无线电导航能力受限于测控站的分布、器地距离等因素的约束,难以为深探测器提供可负担的高精度实时导航信息。传统的惯性导航由于误差累积效应,并不适于作为主要导航手段。单目标的光学自主导航并非完全可观,此外其难以推广到整个飞行阶段。x射线脉冲星导航技术具有自主性强、抗干扰性好、可以支撑深空探测器全飞行阶段等特点。但脉冲星的x射线信号很弱,较为可行的敏感器方案仅能同时跟踪1~2颗导航脉冲星,只能采用动力学定轨法来确定探测器的轨道信息。由于仅有1个矢量,导致系统局部不可观。
技术实现要素:
本发明的目的是提供一种导航方法,其具有高可观性,能用于深空探测。
为了达到上述目的,本发明提供了一种用于深空探测器的高可观度光学脉冲星混合导航方法,该方法包括如下步骤:
步骤1:在深空探测器靠近大天体期间,引入对邻近天体的光学观测量作为补充,将脉冲星观测方程与光学观测方程混合,建立混合观测方程;
步骤2:使用深空探测器多体引力模型,以探测器的惯性位置及速度为状态量,建立探测器状态方程;
步骤3:根据步骤1的观测方程和步骤2的状态方程,构造扩展卡尔曼滤波对探测器的状态进行最优估计计算,得到精确的探测器惯性系下位置与速度;其中,扩展卡尔曼滤波的方程为:
k(k)=p(k,k-1)ht(k)[h(k)p(k,k-1)ht(k)+r(k)]-1
p(k,k-1)=φ(k,k-1)p(k-1)φt(k,k-1)+q(k-1)
其中,初始值为
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,所述的脉冲星观测方程为:
式中,δφi脉冲信号的观测相位差,
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,所述的光学观测方程为:
其中,p,1为目标天体的光心在相机像平面上的坐标,单位是毫米,rci为相机坐标系相对惯性坐标系的姿态转换矩阵,x,y,z为探测器在火星j2000惯性坐标系下的位置。
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,rci是利用相机坐标系相对本体坐标系转换矩阵和星敏感器确定的本体坐标系相对惯性坐标系的姿态转换矩阵确定。
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,所述的混合观测方程:
z=h(x)+v;其中,z代表p、l、△φi;v为测量噪声。
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,步骤2中,探测器状态方程为:
其中,状态变量
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,r的计算公式如下:
其中,rp为探测器相对大天体质心的位置矢量;μm、μs、μe、μj依次为大天体、太阳、地球、木星的引力常数;rmp,rsp,rep,rjp依次为大天体、太阳、地球、木星对探测器的位置矢量;rms,rme,rmj为两天体间位置矢量,由美国喷气实验室(jpl)的de405星历表得出,下标m代表大天体,下
标s代表太阳,下标e代表地球,下标j代表木星。
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,步骤3中,构造扩展卡尔曼滤波的方法包含:
步骤3.1,先对步骤二的状态方程离散化,并围绕
步骤3.2,将步骤一的观测方程离散化,并在
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,步骤3.1处理后的二阶泰勒级数为:
上述的用于深空探测器的高可观度光学脉冲星混合导航方法,其中,步骤3.2处理后的方程为:
本发明提供的方法克服了惯性导航累积误差大的问题,解决了脉冲星导航可观性弱的问题,大大增强了导航系统的可观性,大大减少了导航系统的收敛时间,并有效的提高了导航精度,可直接用于深空探测器的自主控制。
附图说明
图1为本发明混合测量方案示意图;
图2为本发明的实施效果图。
具体实施方式
以下结合附图和实施例对本发明的技术方案做进一步的说明。
如图1所示,为本发明的光学脉冲星混合测量方案示意图,其中,ssb是指太阳系质心(solarsystembarycenter,其为图中的坐标系原点,深空探测器的r是相对该点计算的),脉冲星1和脉冲星2用于对于近天体(如火星)的脉冲星观测,深空探测器在靠近大天体时,引入对邻近天体的光学观测量作为补充。
本发明所述的光学脉冲星混合高可观深空导航方法,其步骤如下:
步骤一:在探测器靠近大天体期间,引入对邻近天体的光学观测量作为补充,建立混合观测方程;
将脉冲星观测方程与光学观测方程混合。脉冲时间模型一般可以表示为脉冲信号的总相位对时间的函数。脉冲时间模型的总相位可以表示为一个小数部分加上一个整周数,即
φ(t)=ψ(t)+n(t)
式中,φ(t)为总相位,ψ(t)为小数部分,n(t)为整数部分。整数周加上观测的小数部分相位就直接反映了探测器到参考坐标系的距离。
式中δρ表示沿脉冲星视线方向航天器(深空探测器)与太阳质心的距离分量,i表示脉冲星序号,λi为第i个脉冲星的导航脉冲信号一个周期内所传播的距离,
光学导航相机的直接观测量为火星中心点的像点坐标,在不考虑电磁和光畸变的情况下,考虑利用相机所给出的目标像元坐标作为观测量,可以表示为:
其中p,l为目标天体的光心在相机像平面上的坐标,单位是毫米,rci为相机坐标系相对惯性坐标系的姿态转换矩阵,rci可以利用相机坐标系相对本体坐标系转换矩阵rcb和星敏感器确定的本体坐标系相对惯性坐标系的姿态转换矩阵rbi确定,x,y,z为探测器在火星j2000惯性坐标系下的位置。
结合方程(1)和(2)可以确定系统的混合观测方程为:
z=h(x)+v.
其中z为p,l,△φi,v为测量噪声,x表示状态量。
步骤二:使用深空探测器多体引力模型,以探测器的惯性位置及速度为状态量,建立探测器状态方程。
深空探测器的运动是由中心引力(下式等号右边的第一项)与各摄动力联合作用的结果。其受力如下:
式中gm为中心天体的引力常数;r为飞行器在惯性系中的位置矢量,r表示它的模(标量);p为摄动力项对于接近大天体的深空探测器,可以大天体为中心引力体建立探测器的运动方程。本文考虑大天体引力、太阳引力、地球引力、木星引力,由于距离大天体较远,因此可以不考虑大天体引力非球形项等其它摄动影响,建立动力学方程如下:
式中,rp为探测器相对大天体质心的位置矢量;μm、μs、μe、μj依次为大天体、太阳、地球、木星的引力常数;rmp,rsp,rep,rjp依次为大天体、太阳、地球、木星对探测器的位置矢量;rms,rme,rmj为两天体间位置矢量,由jpl的de405星历表得出,下标m代表大天体,下标s代表太阳,下标e代表地球,下标j代表木星。
选择探测器的位置与速度矢量作为状态变量
式中w为系统模型误差,axayaz为太阳引力摄动在火星惯性系下的投影,x、y、z的含义是探测器在火星j2000惯性坐标系下的位置。
步骤三:使用扩展卡尔曼滤波(ekf)对探测器的状态进行最优估计,得到精确的探测器惯性系下位置与速度;
根据以上扩维的新状态方程及新观测方程,进行扩展卡尔曼最优估计算法设计:针对上面所描述的连续系统,需首先将步骤二建立的状态方程离散化,并围绕
将步骤一建立的混合观测方程离散化,并在
式中,h表示级数展开的1阶项。
已知状态模型噪声的协方差阵e[w(k)w(k)t]=q,量测模型噪声的协方差阵e[v(k)v(k)t]=r,那么ekf的递推方程为:
k(k)=p(k,k-1)ht(k)[h(k)p(k,k-1)ht(k)+r(k)]-1
p(k,k-1)=φ(k,k-1)p(k-1)φt(k,k-1)+q(k-1)
初始值为
选取一个假想的火星探测任务,从探测器接近火星时开始,对深空光学导航(opn)、单颗脉冲星导航(pn)、以及本发明的光学脉冲星混合导航方法(ophn)三种导航方法进行实验,结果如图2所示。从图中可以明显看到采用本发明后,导航算法的收敛时间由原来单纯脉冲星导航的数十小时缩减于数小时内,同时导航精度也由原来最好的10余千米提高到数千米。
从可观性分析上来看,采用单目标的观测方案,单目标光学导航方法(opn)并不可观,光学导航精度最终随时间渐渐发散;单脉冲星导航方法(pn)的可观性是随探测器位置适量与所观测脉冲星矢量的关系而并化的,因此其可观性是不稳定的。
在数学仿真中,单脉冲星导航方法的导航精度时而收敛,时而发散。精度分布在几十到数百千米,其中的收敛过程也在数十小时左右。而将对光学目标的角度测量与脉冲星的时间测量相结合后,混合导航方法的可观性大大提高。采用ophn方法的导航系统在整个接近火星过程,体现了单一的收敛性,数小时后导航精度便快速的收敛到千米量级。容易看到ophn无论是收敛性还是精度都明显优于opn与pn。
综上所述,本发明在深空探测器靠近大天体时,把光学导航敏感器对该天体的角度观测量引入导航系统,重新构建了与脉冲星距离观测相混合的观测方程,大大提高了导航系统的可观性,从而大大缩短了导航系统的收敛收间,并提高了导航系统的精度。
尽管本发明的内容已经通过上述优选实施例作了详细介绍,但应当认识到上述的描述不应被认为是对本发明的限制。在本领域技术人员阅读了上述内容后,对于本发明的多种修改和替代都将是显而易见的。因此,本发明的保护范围应由所附的权利要求来限定。