CN102168980B - 一种基于小行星交会的深空探测器自主天文导航方法 - Google Patents
一种基于小行星交会的深空探测器自主天文导航方法 Download PDFInfo
- Publication number
- CN102168980B CN102168980B CN2011100066363A CN201110006636A CN102168980B CN 102168980 B CN102168980 B CN 102168980B CN 2011100066363 A CN2011100066363 A CN 2011100066363A CN 201110006636 A CN201110006636 A CN 201110006636A CN 102168980 B CN102168980 B CN 102168980B
- Authority
- CN
- China
- Prior art keywords
- asteroid
- fixed star
- background fixed
- state
- centerdot
- 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
Images
Landscapes
- Image Analysis (AREA)
Abstract
本发明涉及一种基于小行星交会的深空探测器自主天文导航方法。根据圆形限制性轨道动力学模型建立深空探测器的状态模型;利用敏感器获得小行星以及背景恒星的像元像线信息,把所获得的像元像线信息转换为小行星以及背景恒星的角度信息,建立小行星的角度信息量测模型;结合自适应Unscented卡尔曼滤波估计深空探测器的位置和速度。本发明具有估计精度高,非常适用于与小行星交会期间的自主导航。本发明属于航天导航技术领域,不仅可以为深空探测器提供高精度导航参数,而且可为其自主导航系统设计提供参考。
Description
技术领域
本发明涉及在深空探测器与小行星交会阶段,基于小行星角度信息的自主天文导航方法,是一种非常适用于与小行星交会段深空探测器的自主导航方法。
背景技术
在太阳系中,大约140000颗以上的小行星聚集在火星和木星轨道之间,还有一部分小行星运行于地球和火星轨道之间,成为近地小行星。小行星和彗星等小天体保留着太阳系早期的许多信息,是研究太阳系起源与演化的重要物证;通过在小行星上寻找水和有机物存在的证据,有助于理解地球和太阳系内生命的起源与演化。近年来小行星探测越来越受到重视。由于深空探测一般采用多科学探测任务,往往在一次深空任务中,通过精确的轨道设计,实现在飞向目标大行星的轨道转移过程中,实现与小行星交会,完成大行星和小行星共同探测的目标。
由于这种深空探测任务对深空探测器的导航品质要求高,若这一阶段导航误差大,无法及时通过轨道控制系统调整探测器的轨道,错过了轨道机动的最佳时机,就有可能无法与小行星交会,实现共同探测的目标,导致深空探测任务失败。
深空探测任务距离地球遥远,通讯延迟大,地面测控设施复杂庞大,运行费用高,而且地面天文望远镜获得的小行星的星历并不准确,误差较大,传统的基于地面无线电测控的导航方式是通过地面轨道预报,结合小行星的星历给深空探测器发送轨道导航控制命令,但由于深空探测任务无线电通信延迟特性和巨大的星历误差,导致基于地面无线电测控的导航方式不能实时为探测器提供准确的导航信息,因此,实现深空探测器的自主导航是深空探测的必然趋势。
与小行星交会阶段的深空探测器,由于其距离太阳和各行星的距离都较远,用于近地逃逸轨道或行星捕获、着陆等的自主导航方法,如基于IMU、测距测速敏感器、地面图像等的自主导航方法都无法使用,此时天文导航是唯一有效的自主导航手段。
目前根据所观测天体的不同,深空探测器在转移轨道上的自主天文导航方法大致可分为三种:基于太阳和大行星的自主天文导航方法、基于脉冲星的自主天文导航方法和基于小行星的自主天文导航方法。前两种方法是利用太阳和大行星或者脉冲星进行定位,但是由于天体距离远,测量精度低,可观测的脉冲星数目少,因此对于小行星交会段的深空探测器并不适用。基于小行星的自主天文导航方法是借助小行星的位置信息对探测器进行定位。因此以火星以远(包括火星)的深空天体作为探测目标的深空探测器,考虑到与小行星交会的特殊性,可以通过观测多颗小行星获取探测器的位置信息,消除小行星星历误差对探测器导航的影响,实现探测器转移轨道小行星交会段的高精度导航。
传统上利用小行星测量信息的深空探测器自主导航存在以下缺点:一方面传统利用小行星测量信息的深空探测器是采用小行星图像的像元像线这一测量信息,但是像元像线量测模型受探测器姿态估计精度的约束,姿态估计的精度直接影响了深空探测器的自主导航精度;另一方面传统上是利用批处理最小二乘等方法减小系统的随机误差,但最小二乘估计方法的精度较低,无法为探测器导航提供高精度的导航信息。对于自主天文导航这种非线性系统而言,在有限维系统中无法从根本上获得最优的滤波算法,现有的解决系统非线性问题的方法都属于次优非线性估计。现有的次优非线性估计方法如精度较高的非线性卡尔曼滤波方法等是建立在状态模型和量测模型的误差分布特性已知的且状态量的先验信息完备的前提下,如果状态和量测误差分布特性不准确,如量测信息以及未建模的加速的误差等动力学模型误差不准确,则将产生巨大的导航误差。
发明内容
本发明要解决的技术问题是:克服基于太阳与大行星及其卫星和脉冲星自主导航方法中太阳和行星及其卫星到探测器的距离较远或导航脉冲星数量少、精度低、对探测器轨道设计要求高等缺点,弥补传统上观测小行星像元像线量测信息受探测器姿态约束这一不足,并解决系统无法为现有的次优非线性估计方法如Unscented卡尔曼滤波提供准确的状态模型和量测模型的误差分布特性和状态量的先验信息,为深空探测器在与小行星交会阶段提供一种高精度的自主天文导航方法。
本发明解决其技术问题所采用的技术方案为:建立高精度的深空探测器状态模型,通过敏感器获得小行星及其相应图像中的背景恒星像元像线信息,之后把像元像线信息转换为方向矢量,建立小行星与背景恒星之间角度信息的量测模型,其中使用自适应Unscented卡尔曼滤波估计模型误差方差阵Q,并结合估计的模型误差方差阵Q确定深空探测器的导航参数。
具体包括以下步骤:
1.建立基于轨道动力学的小行星交会段深空探测器状态模型;
在太阳系内的深空探测任务小行星都处于地球与木星轨道之间的区域,因此需要考虑太阳中心引力、木星中心引力、火星中心引力和地球中心引力对探测器的作用,选取日心黄道惯性坐标系,可得深空探测器的状态模型为
式中,探测器三轴位置的微分,vx,vy,vz为探测器三轴的速度,为探测器三轴速度的微分,μs、μm、μe和μj分别为太阳、火星、地球和木星引力常数,rps为日心到探测器的距离,rpm为火星到探测器的距离,rsm为火心到日心的距离,rpe为地心到探测器的距离,rse为地心到日心的距离,rpj为木心到探测器的距离,rsj为木心到日心的距离,(x1,y1,z1),(x2,y2,z2)、(x3,y3,z3)和(x,y,z)分别为火星、地球、木星和探测器的位置,其中火星、地球和木星的位置可由行星星历表获得,wx,wy,wz分别为探测器三轴的状态模型误差。
式(1)中的各变量都是与时间t有关的变量,可简写为
状态变量为X=[x,y,z,vx,vy,vz]T,f(X(t),t)为系统非线性连续状态转移函数,状态噪声为w=[wx,wy,wz]T。
2.建立小行星敏感器图像中小行星与背景恒星之间角度信息量测模型
建立第一小行星和第i颗背景恒星角度信息量测模型为
建立第二小行星和第i颗背景恒星角度信息量测模型为
式中,为第二小行星相对探测器的单位矢量,为第二小行星敏感器视场范围内第i颗背景恒星星光方向的单位矢量。
令Z=[θ1i,θ2i]T,量测噪声 分别为测量θ1i,θ2i的观测误差,i=1,2,3,因此因为各变量都是与时间t有关的函数,因此用Z(t)表示t时刻的系统量测量Z,X(t)表示t时刻的状态变量X,h[X(t),t]表示t时刻连续的非线性量测函数,v(t)表示t时刻的量测噪声v;则以第一小行星和第二小行星与各自背景恒星之间的角度信息作为观测量的量测模型可表示为
Z(t)=h[X(t),t]+v(t) (5)
3.对步骤1中式(2)所示的状态方程及步骤2中式(5)所示的量测方程进行离散化
X(k+1)=F(X(k),k)+w(k) (6)
Z(k)=H(X(k),k)+v(k) (7)
式中,k=1,2,…,F(X(k),k)为f(X(t),t)离散后的非线性状态转移函数,H(X(k),k)为h(X(t),t)离散后的非线性量测函数,w(k)、v(k)互不相关。
4.获取敏感器角度信息量测量
①小行星敏感器获取第一小行星和第二小行星的两幅图像信息;
②步骤①中的图像信息经质心提取后,获得第一小行星的像元像线(pm1,lm1)、第一小行星图像中的第i颗背景恒星的像元像线(pmli,lm1i)、第二小行星的像元像线(pm2,lm2)和第二小行星图像中第i颗背景恒星的像元像线(pm2i,lm2i),i=1,2,3;
③第一小行星、第二小行星和背景恒星的二维像元像线转换为三维矢量方向;
A.首先将第一小行星、第二小行星及其背景恒星的像元像线信息转换为敏感器二维成像平面坐标系中的坐标
式中,和为测量得到的第一小行星和第二小行星在对应敏感器二维成像平面坐标系中的坐标,和为测量得到的第i颗背景恒星在第一小行星敏感器和第二小行星敏感器二维成像平面坐标系中的坐标,K1和K2分别为第一小行星和第二小行星成像敏感器由毫米转为像素的相机转换矩阵,(p01,l01)、(p02,l02)分别为第一小行星和第二小行星敏感器中心的像元和像线。
B.将第一小行星、第二小行星及其背景恒星的敏感器二维成像平面坐标系中的坐标转换为三维矢量信息坐标
④.将第一小行星及其背景恒星、第二小行星及其背景恒星的矢量方向信息转换为第一小行星与其背景恒星之间的角度信息、第二小行星与其背景恒星之间的角度信息。
由第一小行星敏感器量测得到的第一小行星和第i颗背景恒星角度信息
由第二小行星敏感器量测得到的第二小行星和第i颗背景恒星角度信息
两个敏感器量测得到的第一小行星和第二小行星与各自背景恒星的角度量测量为:
Zk=[θm11(k),θm12(k),θm13(k),θm21(k),θm22(k),θm23(k)]T (14)
式中,Zk表示第k时刻的系统量测量,θm1i(k),θm2i(k)分别表示第k时刻量测得到的第一小行星与其第i颗背景恒星之间的角度信息、第二小行星与其第i颗背景恒星之间的角度信息,i=1,2,3。
5.轨道自适应Unscented卡尔曼滤波方法
采用自适应Unscented卡尔曼滤波方法,结合步骤①②④的状态模型、量测模型和量测量,一方面利用自适应估计状态模型误差方差算法自适应调节模型误差方差矩阵Q,另一方面减小状态模型、量测模型的模型非线性随机误差,利用Unscented卡尔曼滤波算法,结合所述的状态方程和量测方程进行滤波,利用敏感器获取测量得到的第一小行星、第二小行星和背景恒星的像元像线信息,并将此测量信息转换为量测量第一小行星、第二小行星和背景恒星的角度信息,通过量测量与量测方程相减得到系统量测残差,用系统这一残差校正量测方程的模型误差;利用Unscented采样,并结合状态方程对采样点进行一步预测,并得出与上一步迭代状态值之间协方差阵,以消除状态方程模型误差的影响,最终输出导航信息。其中自适应估计状态模型误差方差算法,具体步骤为:
①初始化窗口系数γ
②自适应调节窗口大小γ
性能指标函数为
式中vk表示量测值与量测模型的残差,m为量测量的维数,v1,n,v2,n,...,vm,n分别表示n时刻残差的第1,2,...,m行,N表示总采样数,这里N=k;借助单纯形数值计算方法,求得使性能指标函数最小的窗口大小γ,使得量测残差最小;
③计算状态模型误差方差的残差Q*
本发明的原理是:本发明是以小行星与其背景恒星之间的角度信息为观测量的一种小行星交会段探测器的天文导航方法,利用自适应Unscented卡尔曼滤波对位置、速度等导航参数进行估计。首先建立深空探测器轨道动力学模型,利用圆形限制性轨道动力学模型建立其状态模型,直接在第一小行星敏感器和第二小行星敏感器的图像中分别获取第一小行星和第一小行星背景恒星的像元像线信息以及第二小行星和第二小行星背景恒星的像元像线信息,从而间接地通过像元像线信息获得第一小行星与第一小行星背景恒星之间的角度信息以及第二小行星与第二小行星背景恒星之间的角度信息,建立相应的量测模型。由于状态模型和量测模型都存在误差,因此除了受到测量仪器精度的制约之外,系统的非线性问题是限制深空探测器小行星交会段导航精度的主要因素,因此在轨道确定滤波中使用Unscented卡尔曼滤波方法解决系统的非线性问题。为了避免选择的滤波参数不合适,本发明利用单纯性搜索数值计算方法,估计出合适的滤波参数,并自动调节滤波参数,实现自适应调整滤波参数进行Unscented卡尔曼滤波,实现对位置、速度等导航参数进行高精度估计。
本发明与现有技术相比的优点在于:(1)充分利用敏感器获得的图像信息,不仅利用了小行星的像元像线信息,还利用了图像中的背景恒星信息,为探测器被火星捕获提供高精度的导航性能;(2)利用小行星之间的角度信息,克服了姿态估计误差对小行星像元像线量测模型精度的影响,进一步提高了深空探测器的导航精度;(3)自适应调整滤波参数,克服了原有方法无法准确设置滤波参数这一缺点,自适应估计状态模型误差方差算法为Unscented卡尔曼滤波提供了准确的状态模型和量测模型误差分布特性以及状态量的先验信息,实现深空探测器的高精度导航。
附图说明
图1为本发明基于小行星交会的深空探测器自主天文导航方法的流程图。
图2为本发明中小行星与背景恒星之间角度信息量测模型的示意图。
图3为本发明中第一小行星成像原理示意图。
图4为本发明中自适应滤波方法的流程图。
具体实施方式
如图1所示,本发明的具体实施方法如下:
1.建立基于轨道动力学的小行星交会段深空探测器状态模型;
首先初始化探测器位置、速度,设状态量X=[x,y,z,vx,vy,vz]T,x,y,z,vx,vy,vz分别为探测器在日心惯性坐标系中三轴的位置和速度,根据探测器的轨道设计,选取探测器的位置和速度初值为
X=[-1.853×1011m -1.168×1011m -5.032×1010m
-9.213×103m/s -1.855×104m/s-8.065×103m/s]T
考虑了太阳中心引力、火星中心引力、地球中心引力和木星中心引力对探测器的作用,选取日心黄道惯性坐标系,可得深空探测器的状态模型为
式中, 探测器三轴位置的微分,vx,vy,vz为探测器三轴的速度, 为探测器三轴速度的微分,μs、μm、μe和μj分别为太阳、火星、地球和木星引力常数,rps为日心到探测器的距离,rpm为火星到探测器的距离,rsm为火心到日心的距离,rpe为地心到探测器的距离,rse为地心到日心的距离,rpj为木心到探测器的距离,rsj为木心到日心的距离,(x1,y1,z1),(x2,y2,z2)、(x3,y3,z3)和(x,y,z)分别为火星、地球、木星和探测器的位置,其中火星、地球和木星的位置可由行星星历表获得,wx,wy,wz分别为探测器三轴的状态模型误差。
式(18)中的各变量都是与时间t有关的变量,可简写为
状态变量为X=[x,y,z,vx,vy,vz]T,f(X(t),t)为系统非线性连续状态转移函数,状态噪声为w=[wx,wy,wz]T。
2.建立小行星与背景恒星之间角度信息的量测模型
本发明以第一小行星和第二小行星与各自图像中的三颗背景恒星之间的角度信息作为量测量,如图2所示,图中显示了第一小行星和第二小行星在各自敏感器二维成像平面上的图像信息,以及第一小行星敏感器中的第i颗背景恒星图像和第二小行星敏感器中的第i颗背景恒星图像,根据第一小行星敏感器中的图像信息可以获得第一小行星的矢量方向和第一小行星图像中第i颗背景恒星的矢量方向之间的角度信息θ1i,同样可以从第二小行星敏感器中的图像信息可以获得第二小行星的矢量方向和第二小行星图像中第i颗背景恒星的矢量方向之间的角度信息θ2i。为了方便描述,图中只选取了1颗背景恒星,即第i颗,i=1,2,3,实际应用时每幅小行星图像中选取三颗背景恒星。
第一小行星敏感器图像中第一小行星和三颗背景恒星角度信息的表达式为
第二小行星敏感器图像中第二小行星和三颗背景恒星角度信息的表达式为
Z(t)=h[X(t),t]+v(t) (22)
由小行星角度信息的量测方程可以看出,方程中不含姿态矩阵,因此与图像坐标信息和矢量方向信息相比,以小行星角度信息作为观测量的导航方法不受姿态确定精度的影响,可以为探测器位置速度的确定提供较高的导航精度。
3.对步骤1中式(19)所示的状态方程及步骤2中式(22)所示的量测方程进行离散化
X(k+1)=F(X(k),k)+w(k) (23)
Z(k)=H(X(k),k)+v(k) (24)
式中,k=1,2,…,F(X(k),k)为f(X(t),t)离散后的非线性状态转移函数,H(X(k),k)为h(X(t),t)离散后的非线性量测函数,w(k)、v(k)互不相关。
4.获取敏感器角度信息量测量
敏感器成像过程如图3所示,图3以第一小行星为例描述了第一小行星敏感器的成像过程,第二小行星敏感器成像过程与之类似。第一小行星敏感器主要由光学透镜和二维成像面阵组成,在第一小行星敏感器测量坐标系OXcYcZc中第一小行星反射太阳光线沿第一小行星到探测器的方向矢量射向第一小行星敏感器,此时,第一小行星在第一小行星敏感器测量坐标系中的坐标为(xc,yc,zc);第一小行星敏感器的光学透镜以焦距f1将火星的光线透射后成像在二维成像面阵上,二维成像面阵将照在每个成像单元上的图像亮度信号储存;由于第一小行星在二维成像面阵上的图像并不是一个点,而是一个圆,通过质心识别等图像处理技术确定第一小行星图像在二维成像平面坐标系OX2dY2d的质心(x2d,y2d),这一中心可以用像元像线坐标系Op1Xp1Yp1中的像元像线(p,l)表示,从小行星的成像原理逆推,可以转换出第一小行星的矢量方向则获取角度信息量测量具体步骤为:
①小行星敏感器获取第一小行星和第二小行星的两幅图像信息;
②步骤①中获取的图像信息经质心提取后,获得第一小行星的像元像线(pm1,lm1)、第一小行星图像中的第一颗、第二颗和第三颗背景恒星的像元像线(pm11,lm11),(pm12,lm12),(pm13,lm13)、第二小行星的像元像线(pm2,lm2)和第二小行星图像中第一颗、第二颗和第三颗背景恒星的像元像线(pm21,lm21),(pm22,lm22),(pm23,lm23);
③第一小行星、第二小行星和背景恒星的二维像元像线转换为三维矢量方向;
A.首先将第一小行星、第二小行星及其背景恒星的像元像线信息转换为敏感器二维成像平面坐标系OX2dY2d中的坐标
式中,和为测量得到的第一小行星和第二小行星在第一小行星敏感器和第二小行星敏感器二维成像平面坐标系中的坐标, 和 为测量得到的第一颗、第二颗和第三颗背景恒星在第一小行星敏感器和第二小行星敏感器二维成像平面坐标系中的坐标,K1和K2分别为第一小行星和第二小行星成像敏感器由毫米转为像素的相机转换矩阵,(p01,l01)、(p02,l02)分别为第一小行星和第二小行星敏感器中心的像元和像线。
B.将第一小行星、第二小行星及其背景恒星的敏感器二维成像平面坐标系中的坐标转换为三维矢量信息坐标
④将第一小行星、第二小行星和背景恒星的矢量方向信息转换为第一小行星、第二小行星和背景恒星之间的角度信息。
第一小行星敏感器量测得到的第一小行星和三颗背景恒星角度信息
第二小行星敏感器量测得到的第二小行星和第i颗背景恒星角度信息
第一小行星与第二小行星与各自图像中三颗背景恒星之间的角度量测量为:
Zk=[θm11(k),θm12(k),θm13(k),θm21(k),θm22(k),θm23(k)]T (31)
式中,Zk表示第k时刻的系统量测量,θm11(k),θm12(k),θm13(k),θm21(k),θm22(k),θm23(k)分别表示第k时刻量测得到的第一小行星和第二小行星与三颗背景恒星之间的角度信息。
5.轨道自适应Unscented卡尔曼滤波方法
自适应Unscented卡尔曼滤波方法的流程图如图4所示,具体步骤为:
①初始化状态误差方差阵P0,状态模型误差方差阵Q0,量测模型误差方差阵R
P0=diag(5×1010,5×1010,5×108,1,1,1×10-2);
Q0=diag(3,3,3,3×10-3,3×10-4,3×10-5);
R=diag(1×10-7,1×10-7,1×10-7,1×10-7,1×10-7,1×10-7,1×10-7,1×10-7,1×10-7);
②扩维状态量和状态误差方差阵
设k时刻的状态量为
③Unscented卡尔曼滤波
A.初始化
B.计算采样点
C.时间更新
状态量的一步预测χk+1|k为
χk|k-1=f(χk-1,k-1) (35)
式中,Wj为第j个采样点的权值;
式中,Qk为k时刻状态模型噪声协方差阵;
采样点对应的量测估计值Zk|k-1
Zk|k-1=h(χk|k-1,k) (38)
D.量测更新
式中,Rk为量测噪声协方差;
滤波增益Kk为
式中,Qk和Rk分别为系统和量测噪声协方差。
④误差估计算法
误差估计算法具体步骤如下
A.初始化窗口系数γ
B.自适应调节窗口大小γ
性能指标函数为
式中,vk表示量测值与量测模型的残差,m为量测量的维数,v1,n,v2,n,...,vm,n分别表示n时刻残差的第1,2,...,m行,N表示总采样数,这里N=k;借助单纯形数值计算方法,求得使性能指标函数最小的窗口大小γ,使得量测残差最小;
C.计算状态模型误差方差的残差Q*
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (2)
1.一种基于小行星交会段的深空探测器自主天文导航方法,其特征在于:首先根据轨道动力学模型建立基于小行星交会段深空探测器的状态模型,并根据小行星敏感器图像中小行星与背景恒星之间的位置关系建立量测模型,利用小行星敏感器获得第一小行星及其背景恒星、第二小行星及其背景恒星的像元像线信息,之后把像元像线转换为角度信息量测量,结合自适应Unscented卡尔曼滤波确定深空探测器的姿态、位置和速度;具体包括以下步骤:
①建立基于轨道动力学的小行星交会段深空探测器状态模型;
考虑太阳中心引力、火星中心引力、地球中心引力和木星中心引力对探测器的作用,选取日心黄道惯性坐标系,可得小行星交会段深空探测器的状态模型:
式中, 探测器三轴位置的微分,vx,vy,vz为探测器三轴的速度, 为探测器三轴速度的微分,μs、μm、μe和μj分别为太阳、火星、地球和木星引力常数,rps为日心到探测器的距离,rpm为火星到探测器的距离,rsm为火心到日心的距离,rpe为地心到探测器的距离,rse为地心到日心的距离,rpj为木心到探测器的距离,rsj为木心到日心的距离,(x1,y1,z1),(x2,y2,z2)、(x3,y3,z3)和(x,y,z)分别为火星、地球、木星和探测器在日心黄道惯性坐标系中的位置,其中火星、地球和木星的位置由行星星历表获得,wx,wy,wz分别为探测器三轴的状态模型误差;
式(1)中的各变量都是与时间t有关的变量,可简写为
状态变量为X=[x,y,z,vx,vy,vz]T,f(X(t),t)为非线性连续状态转移函数,状态噪声为w=[wx,wy,wz]T;
②建立第一小行星及其背景恒星之间角度信息和第二小行星及其背景恒星之间角度信息的量测模型;
第一小行星和第i颗背景恒星角度信息的表达式为:
第二小行星和第i颗背景恒星角度信息的表达式为:
令Z=[θ1i,θ2i]T,量测噪声分别为测量θ1i,θ2i的观测误差,i=1,2,3,因此因为各变量都是与时间t有关的函数,因此用Z(t)表示t时刻的系统量测量Z,X(t)表示t时刻的状态变量X,h[X(t),t]表示t时刻连续的非线性量测函数,v(t)表示t时刻的量测噪声v;则以第一小行星和第二小行星与各自背景恒星之间的角度信息作为观测量的量测模型可表示为:
Z(t)=h[X(t),t]+v(t) (5)
③对步骤①中式(2)所示的状态方程及步骤②中式(5)所示的量测方程进行离散化,
X(k+1)=F(X(k),k)+w(k) (6)
Z(k)=H(X(k),k)+v(k) (7)
式中,k=1,2,…,F(X(k),k)为f(X(t),t)离散后的非线性状态转移函数,H(X(k),k)为h(X(t),t)离散后的非线性量测函数,w(k)、v(k)互不相关;
④获取敏感器角度信息量测量;
A.小行星敏感器获取第一小行星和第二小行星的两幅图像信息;
B.步骤A中的图像信息经质心提取后,获得第一小行星的像元像线(pm1,lm1)、第一小行星图像中的第i颗背景恒星的像元像线(pm1i,lm1i)、第二小行星的像元像线(pm2,lm2)和第二小行星图像中第i颗背景恒星的像元像线(pm2i,lm2i),i=1,2,3;
D.将第一小行星、第二小行星和背景恒星的矢量方向信息转换为第一小行星、第二小行星和背景恒星之间的角度信息;
量测得到的第一小行星和第i颗背景恒星角度信息,
量测得到的第二小行星和第i颗背景恒星角度信息,
⑤采用自适应Unscented卡尔曼滤波方法,结合步骤①②④的状态模型、量测模型和量测量,输出导航的位置、速度信息。
2.根据权利要求1所述的一种基于小行星交会段的深空探测器自主天文导航方法,其特征在于:所述的步骤⑤中自适应Unscented卡尔曼滤波方法采用自适应估计状态模型误差方差算法,具体步骤为:
①初始化窗口系数γ
②自适应调节窗口大小γ
性能指标函数为:
式中,v1,n,v2,n...,vm,n分别表示n时刻量测值与量测模型的残差的第1,2,...,m行,N=k;借助单纯形数值计算方法,求得使性能指标函数最小的窗口大小γ,使得量测残差最小;
③计算状态模型误差方差的残差Q*
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011100066363A CN102168980B (zh) | 2011-01-13 | 2011-01-13 | 一种基于小行星交会的深空探测器自主天文导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2011100066363A CN102168980B (zh) | 2011-01-13 | 2011-01-13 | 一种基于小行星交会的深空探测器自主天文导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102168980A CN102168980A (zh) | 2011-08-31 |
CN102168980B true CN102168980B (zh) | 2012-11-14 |
Family
ID=44490230
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2011100066363A Active CN102168980B (zh) | 2011-01-13 | 2011-01-13 | 一种基于小行星交会的深空探测器自主天文导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102168980B (zh) |
Families Citing this family (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102521506B (zh) * | 2011-12-09 | 2015-01-07 | 中国人民解放军第二炮兵装备研究院第五研究所 | 数字天顶仪旋转轴解算方法 |
CN103063217B (zh) * | 2013-01-08 | 2015-04-29 | 北京航空航天大学 | 一种基于星历修正的深空探测器天文/无线电组合导航方法 |
CN103411614B (zh) * | 2013-08-07 | 2015-11-18 | 北京航空航天大学 | 火星动力下降段多源信息组合导航的迭代skf方法 |
CN103514367B (zh) * | 2013-09-13 | 2017-01-18 | 北京航天飞行控制中心 | 一种深空探测器与小行星交会成像的相对构像方法 |
CN103512574B (zh) * | 2013-09-13 | 2016-05-04 | 北京航天飞行控制中心 | 一种基于小行星序列图像的深空探测器光学导航方法 |
CN103900577B (zh) * | 2014-04-14 | 2016-08-17 | 武汉科技大学 | 一种面向编队飞行的相对导航测速及组合导航方法 |
CN105203101B (zh) * | 2015-09-02 | 2018-01-02 | 北京航空航天大学 | 一种基于目标天体星历修正的深空探测器捕获段天文导航方法 |
CN105716615A (zh) * | 2015-12-28 | 2016-06-29 | 上海卫星工程研究所 | 火星探测器自主导航方法 |
CN106643742B (zh) * | 2016-12-12 | 2020-05-19 | 东南大学 | 一种卫星自主连续观测小行星的方法 |
CN107944084B (zh) * | 2017-10-26 | 2020-12-22 | 北京理工大学 | 一种深空探测器行星借力飞行轨道评估方法 |
CN110657960B (zh) * | 2019-10-31 | 2020-09-25 | 中国科学院长春光学精密机械与物理研究所 | 一种大视场空间天文望远镜稳像精度检测光路系统 |
CN110763240B (zh) * | 2019-11-22 | 2021-07-30 | 北京理工大学 | 融合轨道机动数据的小天体接近高精度光学导航方法 |
CN111409865B (zh) * | 2020-03-31 | 2021-05-04 | 北京理工大学 | 基于交会概率的深空探测器接近段制导方法 |
CN111536982B (zh) * | 2020-05-06 | 2023-09-19 | 北京工业大学 | 一种光照不良条件下小行星探测器光学导航图像生成方法 |
CN111735459B (zh) * | 2020-07-15 | 2022-03-22 | 北京理工大学 | 小天体探测器间协同导航方法 |
CN113029132B (zh) * | 2021-02-22 | 2022-11-22 | 上海航天控制技术研究所 | 一种结合地面影像与恒星光行差测量的航天器导航方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1995915A (zh) * | 2006-12-27 | 2007-07-11 | 北京航空航天大学 | 一种基于星光角距的深空探测器upf自主天文导航方法 |
CN101672651A (zh) * | 2009-09-25 | 2010-03-17 | 北京航空航天大学 | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 |
-
2011
- 2011-01-13 CN CN2011100066363A patent/CN102168980B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1995915A (zh) * | 2006-12-27 | 2007-07-11 | 北京航空航天大学 | 一种基于星光角距的深空探测器upf自主天文导航方法 |
CN101672651A (zh) * | 2009-09-25 | 2010-03-17 | 北京航空航天大学 | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 |
Non-Patent Citations (4)
Title |
---|
《深空探测器小天体交会段自主导航方法研究》;时剑波;《航天控制》;20090831;第27卷(第4期);37-42 * |
宁晓琳等.《深空探测器自主天文导航技术综述(上)》.《中国航天》.2010,(第6期), * |
宁晓琳等.《深空探测器自主天文导航技术综述(下)》.《中国航天》.2010,(第7期), * |
时剑波.《深空探测器小天体交会段自主导航方法研究》.《航天控制》.2009,第27卷(第4期), |
Also Published As
Publication number | Publication date |
---|---|
CN102168980A (zh) | 2011-08-31 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102168980B (zh) | 一种基于小行星交会的深空探测器自主天文导航方法 | |
CN102168981B (zh) | 一种深空探测器火星捕获段自主天文导航方法 | |
CN102175241B (zh) | 一种火星探测器巡航段自主天文导航方法 | |
CN103063217B (zh) | 一种基于星历修正的深空探测器天文/无线电组合导航方法 | |
CN111947652B (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
CN105203101B (zh) | 一种基于目标天体星历修正的深空探测器捕获段天文导航方法 | |
Shapiro et al. | Measurement of the Solar Gravitational Deflection of Radio Waves using Geodetic<? format?> Very-Long-Baseline Interferometry Data, 1979–1999 | |
CN103033189B (zh) | 一种深空探测巡视器惯性/视觉组合导航方法 | |
Trebi-Ollennu et al. | Design and analysis of a sun sensor for planetary rover absolute heading detection | |
Deng et al. | Interplanetary spacecraft navigation using pulsars | |
CN104462776B (zh) | 一种低轨道地球观测卫星对月球绝对辐射定标方法 | |
US20130013199A1 (en) | Method for measuring precision of star sensor and system using the same | |
CN104298647B (zh) | 基于低轨道地球卫星的地影时刻预报的星上确定方法 | |
CN104764449B (zh) | 一种基于星历修正的捕获段深空探测器自主天文导航方法 | |
CN106643741B (zh) | 一种卫星相对小行星视觉自主导航方法 | |
CN103148856B (zh) | 一种基于自适应尺度变化的借力飞行探测器自主天文导航方法 | |
CN106595674A (zh) | 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法 | |
CN105160125B (zh) | 一种星敏感器四元数的仿真分析方法 | |
US20030006345A1 (en) | Method and apparatus for autonomous solar navigation | |
CN104457705A (zh) | 基于天基自主光学观测的深空目标天体初定轨方法 | |
CN103017774A (zh) | 单探测器脉冲星导航方法 | |
CN103968834A (zh) | 一种近地停泊轨道上深空探测器的自主天文导航方法 | |
CN103968844A (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的系统 | |
Pong et al. | Camera modeling, centroiding performance, and geometric camera calibration on ASTERIA |
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 |