CN103900576A - 一种深空探测自主导航的信息融合方法 - Google Patents
一种深空探测自主导航的信息融合方法 Download PDFInfo
- 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
Links
Images
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, 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维速度信息进行修正的导航方法不再可用。而其它采用多个有效测量波束中的每个波束依次修正的导航方式,由于多个波束测量间包含了相互耦合的信息量,就会引起测量信息的重复修正,导致惯性导航信息过修正,引起导航误差增大。
发明内容
本发明的技术解决问题是:克服现有技术的不足,提供了一种利用正交分解信息的自主导航信息融合方法,通过改进深空着陆探测器自主导航信息的融合结构,提高了自主导航对测量信息时间不同步、过程中出现波束失效等问题的适应性和鲁棒性,从而提高了导航精度,满足地外天体软着陆任务的需要。
本发明的技术解决方案是:一种深空探测自主导航的信息融合方法,包括如下步骤:
(3)利用ρu直接计算得到根据测距敏感器测量信息的着陆器相对着陆天体表面的高度其中 为着陆惯性系下测距敏感器的测量波束指向,为着陆器本体坐标系下测距敏感器的测量波束指向,Cbi为着陆器本体坐标系相对于着陆惯性坐标系的姿态矩阵,符号·表示两个矢量的点乘;
(4)利用步骤(2)和步骤(3)的结果计算得到高度误差δhu=hu,radar-hu,ins,并采用公式对惯性导航系统输出的当前周期的位置rI进行修正,其中为修正后的位置,高度修正系数 的取值在0~1之间,取值大于首次高度修正时对应的高度值,高度修正系数wh随高度下降逐渐增大;
(5)利用tn-2和tn-1以及对应的和计算得到tu时刻惯性导航系统输出的着陆惯性系下的着陆器速度计算值由此转换得到根据惯性导航系统输出信息的着陆器相对着陆天体表面的速度 以及在测速敏感器波束方向上的分量 其中为着陆天体的自转角速度矢量,为测速敏感器的波束在着陆惯性系下的指向,m=0,1,2,",n,n为测速敏感器的波束数量;
(6)在tu时刻获取着陆器上安装的测速敏感器的测量值vum,radar,根据步骤(5)的计算结果得到速度误差δvum=vum,radar-vum,ins,并由此计算得到测速敏感器波束方向的修正量 其中 的取值在0~1之间,取值大于首次速度修正时对应的速度值,速度修正系数wvm随速度降低逐渐增大;
(7)根据测速敏感器的实际有效测速波束,确定不同情况下着陆惯性坐标系下的速度修正量dvp,
(a)当有效测速波束为0时,dvp=[0 0 0]T;
(d)当有效测速波束为3时, 角标i、j和k用于区分三个不同的有效测速波束,矩阵计算A-T表示(AT)-1;
(e)当有效测速波束大于3时,采用最小二乘拟合出三个正交轴上的合成速度修正量dvp;
附图说明
图1为本发明方法的流程框图;
具体实施方式
如图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,则姿态运动方程可以用四元数描述为:
其中
对(1)式进行积分可以完成四元数的更新,进一步可以解算出姿态矩阵:
(3)位置速度递推,即利用加速度计测量得到的速度增量累加计算当前时刻着陆器的速度,并积分获得着陆器在惯性坐标系下的位置。
着陆惯性坐标系下描述的惯导基本方程为
其中,gI为天体引力加速度,忽略天体非球引力摄动,有
其中,μt为天体引力常数,为着陆器相对天体中心的距离,fI是惯性系下表示的非引力加速度(比力),它可以根据加速度计测量得到。但是由于加速度计测量是表示在本体系下的,即fb,因此需要根据姿态矩阵进行转换。
在获得位置后,还可以计算出着陆器相对天体表面的高度
h=||rI||-rt (7)
rt为rI对应的参考天体表面高度。
第二步、进行测距修正
利用测距信息可以修正惯性导航的位置。测距敏感器提供的是视线距离,因此利用着陆器的姿态信息和测距敏感器波束方向(视线方向),可以把视线距离转化为着陆器相对天体表面的高度。将测距敏感器获得的信息与惯导解算的位置信息相比较获得的新信息,就可以通过卡尔曼滤波对惯导的位置误差进行修正。
根据测量时刻的着陆器相对天体参考面的高度和测距敏感器数据转换得到的高度,计算测量残差;根据优化修正系数进行位置修正,并利用修正后的位置计算惯导方程中的天体引力加速度。具体算法为:
(1)导航数据外推
由于测距信息的获取时间与惯导解算的时间往往不同步,因此,需要利用导航数据外推来同步时间点。
(2)误差计算
由惯导计算的位置信息可以获得着陆器相对天体表面的高度
设测距敏感器的测量值为ρu,则可以解算出高度为
其中,符号·表示两个矢量的点乘。
由此,可以得到高度计算的误差为
δhu=hu,radar-hu,ins (12)
(3)单波束滤波修正
取高度修正系数wh随高度下降逐渐增大,即
对惯性导航输出的当前周期的位置rI进行修正,修正后的惯性系位置为
第三步、进行测速修正
测速敏感器获得的是着陆器相对月面的速度在波束方向的分量,因此利用着陆器的姿态信息和测速敏感器的波束方向,并根据着陆器位置补偿上天体自转引起的速度,就可以获得着陆器的惯性速度。将测速敏感器获得的信息与惯导解算的速度信息相比较获得新的信息,就可以通过卡尔曼滤波对惯导的速度误差进行修正。
(1)导航数据外推
(2)速度差计算
惯导计算出的速度是相对惯性系的速度,需要将其转换为相对天体表面的速度。
先按照(16)式将惯导解算的速度转换为相对天体表面的速度,然后将其投影到波束方向,具体算法如下。
则惯导解算的速度在测速波束方向的分量为
测速敏感器实际获得的速度测量为vum,radar,因此,两者之差为
δvum=vum,radar-vum,ins (19)
(3)计算波束方向修正量
取速度修正系数wvm随速度降低逐渐增大,即
计算波束方向修正量
(4)计算惯性系下的速度修正量
如果有效测速波束为0,则置惯性系下的速度修正量
dvp=[0 0 0]T(22)
如果只有1个有效测速波束,则惯性系下的速度修正量为
如果只有2个有效测速波束,则:
1)设两个有效测速波束(角标分别为i和j)的夹角为
4)与波束1共面且正交的方向为
5)计算惯性系下的速度修正量为
如果只有3个有效测速波束,则惯性系下的速度修正量为:
式中,矩阵计算A-T表示(AT)-1。
如果有效测速波束数大于3,则采用最小二乘拟合出三个正交轴上的合成速度修正量。如图2所示,例如有效测速波束数为4,计算惯性系下的速度修正量如下
式中,矩阵计算A-P表示(ATA)-1AT。
(5)最终速度修正
第四步、对每一个控制周期重复(1)~(3)的步骤,完成导航解算和测量修正。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (1)
1.一种深空探测自主导航的信息融合方法,其特征在于包括如下步骤:
(3)利用ρu直接计算得到根据测距敏感器测量信息的着陆器相对着陆天体表面的高度其中 为着陆惯性系下测距敏感器的测量波束指向,为着陆器本体坐标系下测距敏感器的测量波束指向,Cbi为着陆器本体坐标系相对于着陆惯性坐标系的姿态矩阵,符号·表示两个矢量的点乘;
(4)利用步骤(2)和步骤(3)的结果计算得到高度误差δhu=hu,radar-hu,ins,并采用公式对惯性导航系统输出的当前周期的位置rI进行修正,其中为修正后的位置,高度修正系数 的取值在0~1之间,取值大于首次高度修正时对应的高度值,高度修正系数wh随高度下降逐渐增大;
(5)利用tn-2和tn-1以及对应的和计算得到tu时刻惯性导航系统输出的着陆惯性系下的着陆器速度计算值由此转换得到根据惯性导航系统输出信息的着陆器相对着陆天体表面的速度 以及在测速敏感器波束方向上的分量 其中为着陆天体的自转角速度矢量,为测速敏感器的波束在着陆惯性系下的指向,m=0,1,2,…,n,n为测速敏感器的波束数量;
(6)在tu时刻获取着陆器上安装的测速敏感器的测量值vum,radar,根据步骤(5)的计算结果得到速度误差δvum=vum,radar-vum,ins,并由此计算得到测速敏感器波束方向的修正量 其中 的取值在0~1之间,取值大于首次速度修正时对应的速度值,速度修正系数wvm随速度降低逐渐增大;
(7)根据测速敏感器的实际有效测速波束,确定不同情况下着陆惯性坐标系下的速度修正量dvp,
(a)当有效测速波束为0时,dvp=[0 0 0]T;
(d)当有效测速波束为3时, 角标i、j和k用于区分三个不同的有效测速波束,矩阵计算A-T表示(AT)-1;
(e)当有效测速波束大于3时,采用最小二乘拟合出三个正交轴上的合成速度修正量dvp;
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)
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)
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 | 北京控制工程研究所 | 一种着陆或附着深空天体探测器的高精度导航方法 |
-
2014
- 2014-03-31 CN CN201410127686.0A patent/CN103900576B/zh active Active
Patent Citations (2)
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)
Title |
---|
徐超; 黄翔宇; 王大轶: "基于信息融合的火星抵近段自主导航方法研究", 《中国宇航学会深空探测技术专业委员会第九届学术年会 》 * |
Cited By (20)
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 |