CN103900576A - 一种深空探测自主导航的信息融合方法 - Google Patents

一种深空探测自主导航的信息融合方法 Download PDF

Info

Publication number
CN103900576A
CN103900576A CN201410127686.0A CN201410127686A CN103900576A CN 103900576 A CN103900576 A CN 103900576A CN 201410127686 A CN201410127686 A CN 201410127686A CN 103900576 A CN103900576 A CN 103900576A
Authority
CN
China
Prior art keywords
speed
lander
inertial
sensor
landing
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
Application number
CN201410127686.0A
Other languages
English (en)
Other versions
CN103900576B (zh
Inventor
王大轶
黄翔宇
李骥
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Beijing Institute of Control Engineering
Original Assignee
Beijing Institute of Control Engineering
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Beijing Institute of Control Engineering filed Critical Beijing Institute of Control Engineering
Priority to CN201410127686.0A priority Critical patent/CN103900576B/zh
Publication of CN103900576A publication Critical patent/CN103900576A/zh
Application granted granted Critical
Publication of CN103900576B publication Critical patent/CN103900576B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C21/00Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
    • G01C21/24Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 specially adapted for cosmonautical navigation
    • GPHYSICS
    • G01MEASURING; TESTING
    • G01CMEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
    • G01C25/00Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
    • G01C25/005Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Manufacturing & Machinery (AREA)
  • Astronomy & Astrophysics (AREA)
  • Automation & Control Theory (AREA)
  • Navigation (AREA)

Abstract

一种深空探测自主导航的信息融合方法,步骤为:获取测距测速时刻附近的两组惯性导航结果,利用惯性导航结果计算测距时刻着陆器相对天体表面的高度,同时利用测距信息计算着陆器相对天体表面的高度,通过计算高度残差进行导航位置的高度修正。利用惯性导航结果计算测速时刻着陆器相对天体表面的速度,同时确定测速波束方向的速度,通过计算测速波束方向的速度残差并进行处理,计算得到正交速度修正量,利用速度修正量对惯性导航的速度输出进行修正。本发明方法提高了导航算法对测量信息时间不同步、过程中出现波束失效等问题的适应性和鲁棒性,同时也提高了导航精度。

Description

一种深空探测自主导航的信息融合方法
技术领域
本发明属于航天器制导、导航与控制技术领域,涉及一种深空探测器的自主导航方法,适用于深空探测器对月球、火星、小行星等深空天体的探测任务。
背景技术
对于地外天体软着陆探测器的制导、导航与控制系统来说,获取准确的导航数据是保证着陆器安全软着陆的前提。由于软着陆过程时间短、自主性高,因此已实施的着陆任务以及已计划进行的着陆任务大都采用了基于惯性导航配以测距测速修正的自主导航方式。惯性导航技术依靠陀螺直接测量角速度并积分获得探测器的姿态角,或者用陀螺建立稳定平台并通过框架角获得姿态;依靠加速度计测量比力,并积分获得速度和位置。由于惯性导航是一种外推算法,其导航误差取决于导航初值以及惯性器件的误差,且呈现出随时间不断增长的特点。因此,需要配备有微波或者激光测距或测速敏感器,以对惯性导航进行修正。
为了保证速度信息的高可靠性,一般采用3个及3个以上的测速波束信息,来保证测速信息的冗余。但由于波束测量信息的时间不同步,而且某时刻可能有效波束仅有1~2个,因此已有的利用3个波束测量直接转换为3维速度信息进行修正的导航方法不再可用。而其它采用多个有效测量波束中的每个波束依次修正的导航方式,由于多个波束测量间包含了相互耦合的信息量,就会引起测量信息的重复修正,导致惯性导航信息过修正,引起导航误差增大。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供了一种利用正交分解信息的自主导航信息融合方法,通过改进深空着陆探测器自主导航信息的融合结构,提高了自主导航对测量信息时间不同步、过程中出现波束失效等问题的适应性和鲁棒性,从而提高了导航精度,满足地外天体软着陆任务的需要。
本发明的技术解决方案是:一种深空探测自主导航的信息融合方法,包括如下步骤:
(1)在时刻tu获取着陆器上安装的测距敏感器的测量值ρu,同时获取惯性导航系统与tu最接近的两个时刻tn-2和tn-1对应的着陆惯性系下的位置计算值
Figure BDA0000485076210000021
速度计算值
Figure BDA0000485076210000024
(2)利用tn-2和tn-1以及对应的
Figure BDA0000485076210000025
Figure BDA0000485076210000026
计算得到tu时刻着陆惯性系下着陆器的位置计算值
Figure BDA0000485076210000027
由此得到根据惯性导航系统输出信息的着陆器相对着陆天体表面的高度
Figure BDA0000485076210000028
其中rM
Figure BDA0000485076210000029
对应的着陆天体表面的参考高度;
(3)利用ρu直接计算得到根据测距敏感器测量信息的着陆器相对着陆天体表面的高度
Figure BDA00004850762100000210
其中
Figure BDA00004850762100000211
Figure BDA00004850762100000212
为着陆惯性系下测距敏感器的测量波束指向,
Figure BDA00004850762100000213
为着陆器本体坐标系下测距敏感器的测量波束指向,Cbi为着陆器本体坐标系相对于着陆惯性坐标系的姿态矩阵,符号·表示两个矢量的点乘;
(4)利用步骤(2)和步骤(3)的结果计算得到高度误差δhu=hu,radar-hu,ins,并采用公式
Figure BDA00004850762100000214
对惯性导航系统输出的当前周期的位置rI进行修正,其中
Figure BDA00004850762100000215
为修正后的位置,高度修正系数
Figure BDA00004850762100000216
Figure BDA00004850762100000217
的取值在0~1之间,
Figure BDA00004850762100000218
取值大于首次高度修正时对应的高度值,高度修正系数wh随高度下降逐渐增大;
(5)利用tn-2和tn-1以及对应的
Figure BDA00004850762100000219
Figure BDA00004850762100000220
计算得到tu时刻惯性导航系统输出的着陆惯性系下的着陆器速度计算值
Figure BDA00004850762100000221
由此转换得到根据惯性导航系统输出信息的着陆器相对着陆天体表面的速度 v g , ins I = v u I - ω t I × r u I 以及在测速敏感器波束方向上的分量 v um , ins = v g , ins I · u vm I , 其中
Figure BDA0000485076210000034
为着陆天体的自转角速度矢量,
Figure BDA0000485076210000035
为测速敏感器的波束在着陆惯性系下的指向,m=0,1,2,",n,n为测速敏感器的波束数量;
(6)在tu时刻获取着陆器上安装的测速敏感器的测量值vum,radar,根据步骤(5)的计算结果得到速度误差δvum=vum,radar-vum,ins,并由此计算得到测速敏感器波束方向的修正量 dv p m = w vm · δ v um , 其中 w vm = w vm * ( 1 - | | v u I | | / v vm * ) ,
Figure BDA0000485076210000038
的取值在0~1之间,
Figure BDA0000485076210000039
取值大于首次速度修正时对应的速度值,速度修正系数wvm随速度降低逐渐增大;
(7)根据测速敏感器的实际有效测速波束,确定不同情况下着陆惯性坐标系下的速度修正量dvp
(a)当有效测速波束为0时,dvp=[0 0 0]T
(b)当有效测速波束为1时,
Figure BDA00004850762100000310
(c)当有效测速波束为2时,
Figure BDA00004850762100000311
其中
Figure BDA00004850762100000312
δ v ym = - cos ( θ ij ) · dv p i / sin ( θ ij ) + dv p j / sin ( θ ij ) , θ ij = arccos ( u vi b , u vj b ) , x m b = u vi b , y m b = z m b × x m b ,
Figure BDA00004850762100000314
角标i和j用于区分两个不同的有效测速波束,
Figure BDA00004850762100000315
Figure BDA00004850762100000316
分别是两个波束在着陆器本体坐标系下的指向;
(d)当有效测速波束为3时, dv p = u vi I u vj I u vk I - T dv p i dv p j dv p k , 角标i、j和k用于区分三个不同的有效测速波束,矩阵计算A-T表示(AT)-1
(e)当有效测速波束大于3时,采用最小二乘拟合出三个正交轴上的合成速度修正量dvp
(8)利用步骤(7)得到的结果,采用公式对惯性导航系统输出的当前周期的速度vI进行修正,
Figure BDA00004850762100000319
为修正后的速度。本发明与现有技术相比的优点在于:本发明方法利用多波束测量信息构建了正交新息,形成了基于正交新息的导航修正结构;在导航过程中,对于任意一个或多个波束有效情况,本发明方法都能够在一定方向上对惯性导航结果进行修正,且避免了多个波束依次修正导致的导航信息过修正,提高了自主导航对测量信息时间不同步、过程中出现波束失效等问题的适应性和鲁棒性,从而提高了导航精度,能够满足地外天体软着陆任务的需要。
附图说明
图1为本发明方法的流程框图;
图2为本发明方法中各修正量之间的几何关系示意图。图中uvi、uvj、uvk、和uvl分别表示测速敏感器的四个波束指向,
Figure BDA0000485076210000041
Figure BDA0000485076210000042
分别表示利用波束uvi和波束uvj形成的三个正交轴的指向。
具体实施方式
如图1所示,为本发明方法的流程框图,主要步骤如下:
第一步、进行惯性导航解算
(1)参考坐标系的建立和导航系统赋初值(初始化)
着陆器本体坐标系(OB-XBYBZB)固联在着陆器,原点OB与着陆器质心重合,OBXB轴沿着陆器某一惯性主轴方向,OBYB轴和OBZB轴也沿着陆器另外两个惯性主轴方向,且OBXB、OBYB和OBZB构成右手坐标系。导航系统选用J2000惯性坐标系(Om-XIYIZI)作为参考坐标系,原点为天体中心Om,OmXI轴指向J2000的平春分点,OmZI轴垂直于平地心赤道面,且OmXI、OmYI和OmZI构成右手坐标系。
导航系统的初值包括着陆器的位置、速度和姿态。其中着陆器的位置、速度由地面测控给出,而姿态由星敏感器和陀螺测量得到。设位置矢量为rI、速度矢量为vI、着陆器本体相对着陆惯性系的姿态矩阵为Cbi(对应的姿态四元数为q)。
(2)姿态确定算法
姿态确定算法的目的是更新姿态矩阵Cbi,它可以根据陀螺测量递推获得。设陀螺测量的角速度为ωb,则姿态运动方程可以用四元数描述为:
q · = 1 2 Eq ( q ) ω b - - - ( 1 )
其中
Eq ( q ) = q 4 - q 3 q 2 q 3 q 4 - q 1 - q 2 q 1 q 4 - q 1 - q 2 - q 3 - - - ( 2 )
对(1)式进行积分可以完成四元数的更新,进一步可以解算出姿态矩阵:
C bi = q 1 2 - q 2 2 - q 3 2 + q 4 2 2 ( q 1 q 2 + q 3 q 4 ) 2 ( q 1 q 3 - q 2 q 4 ) 2 ( q 1 q 2 - q 3 q 4 ) - q 1 2 + q 2 2 - q 3 2 + q 4 2 2 ( q 2 q 3 + q 1 q 4 ) 2 ( q 1 q 3 + q 2 q 4 ) 2 ( q 2 q 3 - q 1 q 4 ) - q 1 2 - q 2 2 + q 3 2 + q 4 2 - - - ( 3 )
(3)位置速度递推,即利用加速度计测量得到的速度增量累加计算当前时刻着陆器的速度,并积分获得着陆器在惯性坐标系下的位置。
着陆惯性坐标系下描述的惯导基本方程为
r · · I = g I + f I - - - ( 4 )
其中,gI为天体引力加速度,忽略天体非球引力摄动,有
g I = μ t r I r 3 - - - ( 5 )
其中,μt为天体引力常数,
Figure BDA0000485076210000056
为着陆器相对天体中心的距离,fI是惯性系下表示的非引力加速度(比力),它可以根据加速度计测量得到。但是由于加速度计测量是表示在本体系下的,即fb,因此需要根据姿态矩阵进行转换。
f I = C ib f b = C bi T f b - - - ( 6 )
由于
Figure BDA0000485076210000058
因此对(4)式进行两重积分就可以分别获得着陆器的速度矢量vI和位置矢量rI
在获得位置后,还可以计算出着陆器相对天体表面的高度
h=||rI||-rt    (7)
rt为rI对应的参考天体表面高度。
第二步、进行测距修正
利用测距信息可以修正惯性导航的位置。测距敏感器提供的是视线距离,因此利用着陆器的姿态信息和测距敏感器波束方向(视线方向),可以把视线距离转化为着陆器相对天体表面的高度。将测距敏感器获得的信息与惯导解算的位置信息相比较获得的新信息,就可以通过卡尔曼滤波对惯导的位置误差进行修正。
根据测量时刻的着陆器相对天体参考面的高度和测距敏感器数据转换得到的高度,计算测量残差;根据优化修正系数进行位置修正,并利用修正后的位置计算惯导方程中的天体引力加速度。具体算法为:
(1)导航数据外推
由于测距信息的获取时间与惯导解算的时间往往不同步,因此,需要利用导航数据外推来同步时间点。
设测距信息对应的时间为tu,与之最为接近的前两步惯导计算的时间为tn-2和tn-1,对应的位置计算值为
Figure BDA0000485076210000061
则利用惯导信息预测的tu时刻着陆器的位置为
r u I = r n - 1 I + r n - 1 I - r n - 2 I t n - 1 - t n - 2 ( t u - t n - 1 ) - - - ( 8 )
(2)误差计算
由惯导计算的位置信息可以获得着陆器相对天体表面的高度
h u , ins = | | r u I | | - r M - - - ( 9 )
rM
Figure BDA0000485076210000065
对应的参考天体表面高度。
设测距敏感器波束在本体系的安装指向为
Figure BDA0000485076210000066
则利用姿态信息可以将它转到着陆惯性坐标系中
u R I = C ib u R b - - - ( 10 )
设测距敏感器的测量值为ρu,则可以解算出高度为
h u , radar = ρ u u R I · ( - r u I ) | | r u I | | - - - ( 11 )
其中,符号·表示两个矢量的点乘。
由此,可以得到高度计算的误差为
δhu=hu,radar-hu,ins    (12)
(3)单波束滤波修正
取高度修正系数wh随高度下降逐渐增大,即
w h = w h * ( 1 - h u , ins / h h * ) - - - ( 13 )
其中,
Figure BDA0000485076210000073
的取值在0~1之间,
Figure BDA0000485076210000074
取值大于首次高度修正时对应的高度值,高度修正系数wh随高度下降逐渐增大。
对惯性导航输出的当前周期的位置rI进行修正,修正后的惯性系位置为
r ^ I = r I + w h · δ h u · r u I / | | r u I | | - - - ( 14 )
第三步、进行测速修正
测速敏感器获得的是着陆器相对月面的速度在波束方向的分量,因此利用着陆器的姿态信息和测速敏感器的波束方向,并根据着陆器位置补偿上天体自转引起的速度,就可以获得着陆器的惯性速度。将测速敏感器获得的信息与惯导解算的速度信息相比较获得新的信息,就可以通过卡尔曼滤波对惯导的速度误差进行修正。
(1)导航数据外推
根据tn-2和tn-1时刻惯导的数据外推得到测速敏感器测量时刻tu时惯导计算的着陆器速度。设tn-2和tn-1时刻速度计算值为
Figure BDA0000485076210000077
则tu时刻的着陆器速度为
v u I = v n - 1 I + v n - 1 I - v n - 2 I t n - 1 - t n - 2 ( t u - t n - 1 ) - - - ( 15 )
(2)速度差计算
惯导计算出的速度是相对惯性系的速度,需要将其转换为相对天体表面的速度。
v g , ins I = v u I - ω t I × r u I - - - ( 16 )
Figure BDA0000485076210000082
为着陆天体的自转角速度矢量。
先按照(16)式将惯导解算的速度转换为相对天体表面的速度,然后将其投影到波束方向,具体算法如下。
设测速敏感器某波束在着陆器本体系的指向为
Figure BDA0000485076210000083
其中,m=1,2,",n,n≥3,则利用姿态信息可以将它转到着陆惯性坐标系中
u vm I = C ib u vm b - - - ( 17 )
则惯导解算的速度在测速波束方向的分量为
v um , ins = < v g , ins I &CenterDot; u vm I > - - - ( 18 )
测速敏感器实际获得的速度测量为vum,radar,因此,两者之差为
δvum=vum,radar-vum,ins    (19)
(3)计算波束方向修正量
取速度修正系数wvm随速度降低逐渐增大,即
w vm = w vm * ( 1 - | | v u I | | / v vm * ) - - - ( 20 )
其中,
Figure BDA0000485076210000087
的取值在0~1之间,
Figure BDA0000485076210000088
取值大于首次速度修正时对应的速度值,速度修正系数wvm随速度降低逐渐增大。
计算波束方向修正量
dv p m = w vm &CenterDot; &delta; v um - - - ( 21 )
(4)计算惯性系下的速度修正量
如果有效测速波束为0,则置惯性系下的速度修正量
dvp=[0 0 0]T(22)
如果只有1个有效测速波束,则惯性系下的速度修正量为
dv p = dv p m &CenterDot; u vm I - - - ( 23 )
如果只有2个有效测速波束,则:
1)设两个有效测速波束(角标分别为i和j)的夹角为
&theta; ij = arccos ( u vi b , u vj b ) - - - ( 24 )
2)设
Figure BDA0000485076210000092
则与波束1共面且正交方向的速度修正量为
&delta; v ym = - cos ( &theta; ij ) &CenterDot; dv p i / sin ( &theta; ij ) + dv p j / sin ( &theta; ij ) - - - ( 25 )
3)设
Figure BDA0000485076210000094
则两波束组成平面的法线方向为
z m b = u vi b &times; u vj b - - - ( 26 )
4)与波束1共面且正交的方向为
y m b = z m b &times; x m b - - - ( 27 )
5)计算惯性系下的速度修正量为
dv p = &delta; v xm &CenterDot; x m b + &delta; v ym &CenterDot; y m b - - - ( 28 )
如果只有3个有效测速波束,则惯性系下的速度修正量为:
dv p = u vi I u vj I u vk I - T dv p i dv p j dv p k - - - ( 29 )
式中,矩阵计算A-T表示(AT)-1
如果有效测速波束数大于3,则采用最小二乘拟合出三个正交轴上的合成速度修正量。如图2所示,例如有效测速波束数为4,计算惯性系下的速度修正量如下
dv p = { u vi I u vj I u vk I u vl I T } - p dv p i dv p j dv p k dv p l - - - ( 30 )
式中,矩阵计算A-P表示(ATA)-1AT
(5)最终速度修正
v ^ I = v I + dv p - - - ( 31 )
式中,vI为惯性导航系统输出的当前周期速度,
Figure BDA00004850762100000911
为修正后的惯性系速度。
第四步、对每一个控制周期重复(1)~(3)的步骤,完成导航解算和测量修正。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。

Claims (1)

1.一种深空探测自主导航的信息融合方法,其特征在于包括如下步骤:
(1)在时刻tu获取着陆器上安装的测距敏感器的测量值ρu,同时获取惯性导航系统与tu最接近的两个时刻tn-2和tn-1对应的着陆惯性系下的位置计算值
Figure FDA0000485076200000011
Figure FDA0000485076200000012
速度计算值
Figure FDA0000485076200000013
Figure FDA0000485076200000014
(2)利用tn-2和tn-1以及对应的
Figure FDA0000485076200000015
Figure FDA0000485076200000016
计算得到tu时刻着陆惯性系下着陆器的位置计算值
Figure FDA0000485076200000017
由此得到根据惯性导航系统输出信息的着陆器相对着陆天体表面的高度
Figure FDA0000485076200000018
其中rM
Figure FDA0000485076200000019
对应的着陆天体表面的参考高度;
(3)利用ρu直接计算得到根据测距敏感器测量信息的着陆器相对着陆天体表面的高度
Figure FDA00004850762000000110
其中
Figure FDA00004850762000000111
Figure FDA00004850762000000112
为着陆惯性系下测距敏感器的测量波束指向,
Figure FDA00004850762000000113
为着陆器本体坐标系下测距敏感器的测量波束指向,Cbi为着陆器本体坐标系相对于着陆惯性坐标系的姿态矩阵,符号·表示两个矢量的点乘;
(4)利用步骤(2)和步骤(3)的结果计算得到高度误差δhu=hu,radar-hu,ins,并采用公式
Figure FDA00004850762000000114
对惯性导航系统输出的当前周期的位置rI进行修正,其中
Figure FDA00004850762000000115
为修正后的位置,高度修正系数
Figure FDA00004850762000000116
Figure FDA00004850762000000117
的取值在0~1之间,取值大于首次高度修正时对应的高度值,高度修正系数wh随高度下降逐渐增大;
(5)利用tn-2和tn-1以及对应的计算得到tu时刻惯性导航系统输出的着陆惯性系下的着陆器速度计算值
Figure FDA00004850762000000121
由此转换得到根据惯性导航系统输出信息的着陆器相对着陆天体表面的速度 v g , ins I = v u I - &omega; t I &times; r u I 以及在测速敏感器波束方向上的分量 v um , ins = v g , ins I &CenterDot; u vm I , 其中
Figure FDA0000485076200000024
为着陆天体的自转角速度矢量,
Figure FDA0000485076200000025
为测速敏感器的波束在着陆惯性系下的指向,m=0,1,2,…,n,n为测速敏感器的波束数量;
(6)在tu时刻获取着陆器上安装的测速敏感器的测量值vum,radar,根据步骤(5)的计算结果得到速度误差δvum=vum,radar-vum,ins,并由此计算得到测速敏感器波束方向的修正量 dv p m = w vm &CenterDot; &delta; v um , 其中 w vm = w vm * ( 1 - | | v u I | | / v vm * ) ,
Figure FDA0000485076200000028
的取值在0~1之间,取值大于首次速度修正时对应的速度值,速度修正系数wvm随速度降低逐渐增大;
(7)根据测速敏感器的实际有效测速波束,确定不同情况下着陆惯性坐标系下的速度修正量dvp
(a)当有效测速波束为0时,dvp=[0 0 0]T
(b)当有效测速波束为1时,
Figure FDA00004850762000000210
(c)当有效测速波束为2时,
Figure FDA00004850762000000211
其中
Figure FDA00004850762000000212
&delta; v ym = - cos ( &theta; ij ) &CenterDot; dv p i / sin ( &theta; ij ) + dv p j / sin ( &theta; ij ) , &theta; ij = arccos ( u vi b , u vj b ) , x m b = u vi b , y m b = z m b &times; x m b , 角标i和j用于区分两个不同的有效测速波束,
Figure FDA00004850762000000215
分别是两个波束在着陆器本体坐标系下的指向;
(d)当有效测速波束为3时, dv p = u vi I u vj I u vk I - T dv p i dv p j dv p k , 角标i、j和k用于区分三个不同的有效测速波束,矩阵计算A-T表示(AT)-1
(e)当有效测速波束大于3时,采用最小二乘拟合出三个正交轴上的合成速度修正量dvp
(8)利用步骤(7)得到的结果,采用公式对惯性导航系统输出的当前周期的速度vI进行修正,
Figure FDA00004850762000000219
为修正后的速度。
CN201410127686.0A 2014-03-31 2014-03-31 一种深空探测自主导航的信息融合方法 Active CN103900576B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201410127686.0A CN103900576B (zh) 2014-03-31 2014-03-31 一种深空探测自主导航的信息融合方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201410127686.0A CN103900576B (zh) 2014-03-31 2014-03-31 一种深空探测自主导航的信息融合方法

Publications (2)

Publication Number Publication Date
CN103900576A true CN103900576A (zh) 2014-07-02
CN103900576B CN103900576B (zh) 2016-08-17

Family

ID=50992045

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201410127686.0A Active CN103900576B (zh) 2014-03-31 2014-03-31 一种深空探测自主导航的信息融合方法

Country Status (1)

Country Link
CN (1) CN103900576B (zh)

Cited By (13)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104374403A (zh) * 2014-10-28 2015-02-25 上海卫星工程研究所 利用天体相对运动的天文测速自主导航系统地面试验方法
CN105043389A (zh) * 2015-07-07 2015-11-11 中国人民解放军第二炮兵工程大学 一种基于单个外辐射源的组合导航方法
CN106643744A (zh) * 2016-12-29 2017-05-10 武汉大学 一种基于四程中继跟踪模式的远月面着陆器精密定位方法
CN108548540A (zh) * 2018-02-27 2018-09-18 北京控制工程研究所 一种多波束测速信息融合方法及系统
CN109506662A (zh) * 2018-10-30 2019-03-22 北京控制工程研究所 一种小天体着陆初始对准方法、其相对导航基准确定方法及装置
CN109802741A (zh) * 2019-01-09 2019-05-24 上海卫星工程研究所 测角测速组合导航半物理仿真时间同步方法
CN110307840A (zh) * 2019-05-21 2019-10-08 北京控制工程研究所 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法
CN110736482A (zh) * 2019-09-23 2020-01-31 北京控制工程研究所 一种月球软着陆欠测量速度修正方法
CN111351483A (zh) * 2020-03-31 2020-06-30 北京控制工程研究所 一种递归多子样大动态惯性导航方法
CN111351490A (zh) * 2020-03-31 2020-06-30 北京控制工程研究所 一种行星着陆过程惯导基准快速重建方法
CN111896027A (zh) * 2020-07-15 2020-11-06 北京控制工程研究所 一种考虑地形起伏的测距敏感器仿真建模方法
CN113776561A (zh) * 2021-09-17 2021-12-10 北京控制工程研究所 用于地外天体着陆的测距测速敏感器闭环验证系统及方法
CN114152261A (zh) * 2021-09-26 2022-03-08 北京控制工程研究所 一种地外天体着陆过程自适应导航修正方法和系统

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6816112B1 (en) * 2003-05-30 2004-11-09 Lockheed Martin Corporation Hybrid RF/optical acquisition and tracking system and method
CN102116628A (zh) * 2009-12-31 2011-07-06 北京控制工程研究所 一种着陆或附着深空天体探测器的高精度导航方法

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US6816112B1 (en) * 2003-05-30 2004-11-09 Lockheed Martin Corporation Hybrid RF/optical acquisition and tracking system and method
CN102116628A (zh) * 2009-12-31 2011-07-06 北京控制工程研究所 一种着陆或附着深空天体探测器的高精度导航方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
徐超; 黄翔宇; 王大轶: "基于信息融合的火星抵近段自主导航方法研究", 《中国宇航学会深空探测技术专业委员会第九届学术年会 》 *

Cited By (20)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN104374403A (zh) * 2014-10-28 2015-02-25 上海卫星工程研究所 利用天体相对运动的天文测速自主导航系统地面试验方法
CN105043389A (zh) * 2015-07-07 2015-11-11 中国人民解放军第二炮兵工程大学 一种基于单个外辐射源的组合导航方法
CN106643744A (zh) * 2016-12-29 2017-05-10 武汉大学 一种基于四程中继跟踪模式的远月面着陆器精密定位方法
CN108548540B (zh) * 2018-02-27 2020-07-14 北京控制工程研究所 一种多波束测速信息融合方法及系统
CN108548540A (zh) * 2018-02-27 2018-09-18 北京控制工程研究所 一种多波束测速信息融合方法及系统
CN109506662A (zh) * 2018-10-30 2019-03-22 北京控制工程研究所 一种小天体着陆初始对准方法、其相对导航基准确定方法及装置
CN109506662B (zh) * 2018-10-30 2020-09-18 北京控制工程研究所 一种小天体着陆初始对准方法、其相对导航基准确定方法及装置
CN109802741A (zh) * 2019-01-09 2019-05-24 上海卫星工程研究所 测角测速组合导航半物理仿真时间同步方法
CN110307840A (zh) * 2019-05-21 2019-10-08 北京控制工程研究所 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法
CN110307840B (zh) * 2019-05-21 2021-09-07 北京控制工程研究所 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法
CN110736482A (zh) * 2019-09-23 2020-01-31 北京控制工程研究所 一种月球软着陆欠测量速度修正方法
CN110736482B (zh) * 2019-09-23 2021-06-11 北京控制工程研究所 一种月球软着陆欠测量速度修正方法
CN111351483A (zh) * 2020-03-31 2020-06-30 北京控制工程研究所 一种递归多子样大动态惯性导航方法
CN111351490A (zh) * 2020-03-31 2020-06-30 北京控制工程研究所 一种行星着陆过程惯导基准快速重建方法
CN111896027A (zh) * 2020-07-15 2020-11-06 北京控制工程研究所 一种考虑地形起伏的测距敏感器仿真建模方法
CN111896027B (zh) * 2020-07-15 2022-07-29 北京控制工程研究所 一种考虑地形起伏的测距敏感器仿真建模方法
CN113776561A (zh) * 2021-09-17 2021-12-10 北京控制工程研究所 用于地外天体着陆的测距测速敏感器闭环验证系统及方法
CN113776561B (zh) * 2021-09-17 2023-07-14 北京控制工程研究所 用于地外天体着陆的测距测速敏感器闭环验证系统及方法
CN114152261A (zh) * 2021-09-26 2022-03-08 北京控制工程研究所 一种地外天体着陆过程自适应导航修正方法和系统
CN114152261B (zh) * 2021-09-26 2024-05-03 北京控制工程研究所 一种地外天体着陆过程自适应导航修正方法和系统

Also Published As

Publication number Publication date
CN103900576B (zh) 2016-08-17

Similar Documents

Publication Publication Date Title
CN103900576A (zh) 一种深空探测自主导航的信息融合方法
CN103674034B (zh) 多波束测速测距修正的鲁棒导航方法
Li et al. LIDAR/MEMS IMU integrated navigation (SLAM) method for a small UAV in indoor environments
CN101788296B (zh) 一种sins/cns深组合导航系统及其实现方法
CN109613583B (zh) 基于单星与地面站测向及联合测时差的无源目标定位方法
CN104374388B (zh) 一种基于偏振光传感器的航姿测定方法
CN103994763B (zh) 一种火星车的sins/cns深组合导航系统及其实现方法
RU2558724C2 (ru) Устройство диагностического комплекса для определения положения трубопровода и способ определения относительного перемещения трубопровода по результатам двух и более инспекционных пропусков диагностического комплекса для определения положения трубопровода
CN102116628B (zh) 一种着陆或附着深空天体探测器的高精度导航方法
CN105184002B (zh) 一种数传天线指向角度的仿真分析方法
CN109633724B (zh) 基于单星与多地面站联合测量的无源目标定位方法
CN103913181A (zh) 一种基于参数辨识的机载分布式pos传递对准方法
CN103438890B (zh) 基于tds与图像测量的行星动力下降段导航方法
CN103335654B (zh) 一种行星动力下降段的自主导航方法
CN102116634A (zh) 一种着陆深空天体探测器的降维自主导航方法
CN105929836A (zh) 用于四旋翼飞行器的控制方法
JPH095104A (ja) 移動物体の三次元姿勢角測定法および三次元姿勢角計測装置
CN114543794A (zh) 一种视觉惯性里程计与间断性rtk融合的绝对定位方法
CN106672265A (zh) 一种基于光流信息的小天体定点着陆制导控制方法
Xiaolin et al. A tightly coupled rotational SINS/CNS integrated navigation method for aircraft
CN103955005B (zh) 一种火箭橇轨道重力实时测量方法
CN102607563B (zh) 利用背景天文信息对于航天器进行相对导航的系统
Deschênes et al. Lidar scan registration robust to extreme motions
Li et al. Opportunity rover localization and topographic mapping at the landing site of Meridiani Planum, Mars
CN103256932B (zh) 一种替换结合外推的着陆导航方法

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