CN111351490A - 一种行星着陆过程惯导基准快速重建方法 - Google Patents
一种行星着陆过程惯导基准快速重建方法 Download PDFInfo
- Publication number
- CN111351490A CN111351490A CN202010245815.1A CN202010245815A CN111351490A CN 111351490 A CN111351490 A CN 111351490A CN 202010245815 A CN202010245815 A CN 202010245815A CN 111351490 A CN111351490 A CN 111351490A
- Authority
- CN
- China
- Prior art keywords
- lander
- inertial
- landing process
- attitude
- nadir
- 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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial 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)
- Automation & Control Theory (AREA)
- Astronomy & Astrophysics (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
一种行星着陆过程惯导基准快速重建方法,属于航天器自主导航技术领域,包括如下步骤:S1、建立第一惯性基准坐标系,利用着陆器的惯性测量单元输出的角度增量进行姿态外推,获得着陆器的惯性姿态;S2、对着陆器的高度进行估计,对着陆器的天底向量进行第一状态估计;S3、根据着陆器的测速敏感器测量的速度和S1中所述的着陆器的惯性姿态,对着陆器的天底向量进行第二状态估计;S4、利用S2中所述高度估计和着陆器的天底向量第一状态估计、S3中所述着陆器的天底向量的第二状态估计,获得行星着陆过程的天底向量最终估计值,重建着陆器在行星着陆过程中的惯导基准。本发明方法对两种天底向量进行融合,有效地提高了基准重建的收敛速度。
Description
技术领域
本发明涉及一种行星着陆过程惯导基准快速重建方法,属于航天器自主导航技术领域。
背景技术
火星探测任务的进入、降落与着陆段(Entry,Descent,and Landing,简称EDL)是火星探测器近7亿千米旅途的最后6、7分钟,是火星表面探测任务的关键阶段,也是最困难的阶段。EDL技术也是火星表面探测任务的关键技术之一。从火星探测器以2万千米每小时的速度进入火星大气开始,经历大气减速,降落伞拖拽,动力减速等一系列的阶段,最终为了确保安全精确地降落在火星表面。火星探测的失败案例中较多是由于火星着陆器在下降着陆过程中出现意外,导致整个探测任务的失败。苏联的火星-6于1973年08月05日发射,着陆器在下降期间出现故障,失去了与地球的联系;美国1999年01月03日发射的火星极地着陆器,在着陆下降期间通信丧失,着陆器坠毁;欧空局在2003年6月2号发射的火星快车/猎兔犬-2的火星着陆器也在着陆过程中坠毁。可见火星着陆探测EDL过程技术是保证任务成功的关键技术,需要深入展开研究。
在EDL过程伞降过程中,动态极高,而且无法建立完善的动力学模型进行分析。这一过程的高动态导致IMU极易饱和甚至出现故障,而一段IMU出现饱和故障,将丧失姿态基准。而目前的着陆任务中在根据测距信息计算高度信息的,利用了惯导的姿态基准。一旦姿态丧失基准,高度信息解算错误就会影响任务的成功实施。2016年欧空局ExoMars火星任务的着陆器就是因为IMU出现饱和使得姿态基准丧失,造成了高度计算错误引发GNC指令执行错误,最终导致着陆器坠毁。
发明内容
本发明要解决的技术问题是:克服现有技术的不足,提供了一种行星着陆过程惯导基准快速重建方法,包括如下步骤:S1、建立第一惯性基准坐标系,利用着陆器的惯性测量单元输出的角度增量进行姿态外推,获得着陆器的惯性姿态;S2、对着陆器的高度进行估计,对着陆器的天底向量进行第一状态估计;S3、根据着陆器的测速敏感器测量的速度和S1中所述的着陆器的惯性姿态,对着陆器的天底向量进行第二状态估计;S4、利用S2中所述高度估计和着陆器的天底向量第一状态估计、S3中所述着陆器的天底向量的第二状态估计,获得行星着陆过程的天底向量最终估计值,重建着陆器在行星着陆过程中的惯导基准。
本发明目的通过以下技术方案予以实现:
一种行星着陆过程惯导基准快速重建方法,包括如下步骤:
S1、建立第一惯性基准坐标系,在第一惯性基准坐标系下利用着陆器的惯性测量单元输出的角度增量进行姿态外推,获得着陆器的惯性姿态;
S2、对着陆器的高度进行估计,对着陆器的天底向量进行第一状态估计;
S3、根据着陆器的测速敏感器测量的速度和S1中所述的着陆器的惯性姿态,对着陆器的天底向量进行第二状态估计;
S4、利用S2中所述高度估计和着陆器的天底向量第一状态估计、S3中所述着陆器的天底向量的第二状态估计,获得行星着陆过程的天底向量最终估计值,重建着陆器在行星着陆过程中的惯导基准。
优选的,S2中利用最小二乘算法,对着陆器的高度进行估计,对着陆器的天底向量进行第一状态估计。
优选的,S3中利用滑动滤波方法,对着陆器的天底向量进行第二状态估计。
其中
优选的,S1中所述的着陆器的惯性姿态为:
其中
其中
式中,h为高度,pR(i)为测距敏感器第i个波束指向在着陆器本体坐标系下的投影,ηl(i)为测距敏感器第i个波束的测量噪声,ug为天底向量在着陆器本体系下的投影。
优选的,S4中所述的着陆器在行星着陆过程中的惯导基准包括任一时刻tk的位置和速度。
本发明相比于现有技术具有如下有益效果:
(1)本发明方法对两种天底向量进行融合,有效地提高了基准重建的收敛速度;
(2)本发明方法对两种天底向量估计状态进行融合,可以有效提高估计精度;
(3)本发明方法可以实现数据有效性判断,剔除异常数据和无效估计,提高了系统的鲁棒性;
(4)本发明方法的第一状态估计可以给出大概的天底向量,用于波束指令的快速发出。
附图说明
图1为本发明方法的步骤流程图;
图2为本发明方法的天底向量估计精度示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明的实施方式作进一步详细描述。
实施例1:
一种行星着陆过程惯导基准快速重建方法,如图1所示,包括如下步骤:
S1、建立第一惯性基准坐标系,在第一惯性基准坐标系下利用着陆器的惯性测量单元输出的角度增量进行姿态外推,获得着陆器的惯性姿态。
着陆器的惯性姿态为:
其中
S2、利用最小二乘算法,对着陆器的高度进行估计,对着陆器的天底向量进行第一状态估计。
其中
式中,h为高度,pR(i)为测距敏感器第i个波束指向在着陆器本体坐标系下的投影,ηl(i)为测距敏感器第i个波束的测量噪声,ug为天底向量在着陆器本体系下的投影。
S3、根据着陆器的测速敏感器测量的速度和S1中所述的着陆器的惯性姿态,利用滑动滤波方法,对着陆器的天底向量进行第二状态估计。
S4、利用S2中所述高度估计和着陆器的天底向量第一状态估计、S3中所述着陆器的天底向量的第二状态估计,获得行星着陆过程的天底向量最终估计值,重建着陆器在行星着陆过程中的惯导基准。
其中
着陆器在行星着陆过程中的惯导基准包括任一时刻tk的位置和速度,具体为:
实施例2:
火星着陆过程惯导基准快速重建的具体计算过程如下:
1、建立第一惯性基准坐标系,在第一惯性基准坐标系下利用IMU(即惯性测量单元)输出的角度增量,进行姿态外推,得到惯性姿态。
其中Δθ为一个姿态更新周期内的角度增量,为三维向量,δθ为Δθ的模。
2、利用最小二乘算法,由测距敏感器的多个波束的距离测量量对着陆器天底向量进行第一状态估计和高度估计:
2.1、测距敏感器的测量方程可以写作:
其中测距敏感器第i个波束的距离测量量,h为高度,pR(i)为测距敏感器第i个波束指向在着陆器本体坐标系下的投影,ηl(i)为测距敏感器第i个波束的测量噪声,ug为天底向量在着陆器本体系下的投影。记波束的个数为m,式(3)可以写作:
AX=a+ηl (4)
从而可以得到测距仪计算的tk时刻天底向量第一状态估计值和高度估计值,由下式给出:
3、根据着陆器的测速敏感器测量的速度和着陆器惯性姿态,利用滑动滤波方法对天底向量进行第二状态估计。
3.1、测速敏感器测量方程可以写作
BvB=b+ηv (7)
其中vB为本体系下的着陆器速度,B为测速敏感器波束组成的矩阵,b为测速敏感器测量速度组成的向量,ηv为测速敏感器测量噪声组成的向量
3.4、对多个时刻的单次引力估计进行滑动滤波处理,如下:
其中w>0为滑动窗口大小;j为第一序数;天底向量估计误差如图2所示。
4、将第一状态估计和第二状态估计进行融合,给出天底向量的最终估计值:
其中0≤k≤1。本实施例中,系数k取值为0.3。
其中Rm为行星参考半径。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (9)
1.一种行星着陆过程惯导基准快速重建方法,其特征在于,包括如下步骤:
S1、建立第一惯性基准坐标系,在第一惯性基准坐标系下利用着陆器的惯性测量单元输出的角度增量进行姿态外推,获得着陆器的惯性姿态;
S2、对着陆器的高度进行估计,对着陆器的天底向量进行第一状态估计;
S3、根据着陆器的测速敏感器测量的速度和S1中所述的着陆器的惯性姿态,对着陆器的天底向量进行第二状态估计;
S4、利用S2中所述高度估计和着陆器的天底向量第一状态估计、S3中所述着陆器的天底向量的第二状态估计,获得行星着陆过程的天底向量最终估计值,重建着陆器在行星着陆过程中的惯导基准。
2.根据权利要求1所述的一种行星着陆过程惯导基准快速重建方法,其特征在于,S2中利用最小二乘算法,对着陆器的高度进行估计,对着陆器的天底向量进行第一状态估计。
3.根据权利要求1所述的一种行星着陆过程惯导基准快速重建方法,其特征在于,S3中利用滑动滤波方法,对着陆器的天底向量进行第二状态估计。
8.根据权利要求1~7之一所述的一种行星着陆过程惯导基准快速重建方法,其特征在于,S4中所述的着陆器在行星着陆过程中的惯导基准包括任一时刻tk的位置和速度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010245815.1A CN111351490B (zh) | 2020-03-31 | 2020-03-31 | 一种行星着陆过程惯导基准快速重建方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010245815.1A CN111351490B (zh) | 2020-03-31 | 2020-03-31 | 一种行星着陆过程惯导基准快速重建方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111351490A true CN111351490A (zh) | 2020-06-30 |
CN111351490B CN111351490B (zh) | 2022-01-04 |
Family
ID=71194777
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010245815.1A Active CN111351490B (zh) | 2020-03-31 | 2020-03-31 | 一种行星着陆过程惯导基准快速重建方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111351490B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111680462A (zh) * | 2020-08-11 | 2020-09-18 | 北京控制与电子技术研究所 | 基于空间目标在光学相平面位置变化的制导方法和系统 |
CN113030517A (zh) * | 2021-02-18 | 2021-06-25 | 北京控制工程研究所 | 一种火星着陆过程利用测速敏感器的姿态修正方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101074881A (zh) * | 2007-07-24 | 2007-11-21 | 北京控制工程研究所 | 一种月球探测器软着陆阶段惯性导航方法 |
US20080023587A1 (en) * | 2006-07-27 | 2008-01-31 | Raytheon Company | Autonomous Space Flight System and Planetary Lander for Executing a Discrete Landing Sequence to Remove Unknown Navigation Error, Perform Hazard Avoidance and Relocate the Lander and Method |
CN102879011A (zh) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | 一种基于星敏感器辅助的月面惯导对准方法 |
CN103256932A (zh) * | 2013-05-30 | 2013-08-21 | 北京控制工程研究所 | 一种替换结合外推的着陆导航方法 |
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103674034A (zh) * | 2013-12-26 | 2014-03-26 | 北京控制工程研究所 | 多波束测速测距修正的鲁棒导航方法 |
CN103759729A (zh) * | 2014-01-10 | 2014-04-30 | 北京空间飞行器总体设计部 | 采用捷联惯导的月球软着陆地面试验用初始姿态获取方法 |
CN103900576A (zh) * | 2014-03-31 | 2014-07-02 | 北京控制工程研究所 | 一种深空探测自主导航的信息融合方法 |
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 |
CN109292114A (zh) * | 2018-09-14 | 2019-02-01 | 北京控制工程研究所 | 一种崎岖地形月面软着陆轨迹确定方法 |
CN110307840A (zh) * | 2019-05-21 | 2019-10-08 | 北京控制工程研究所 | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 |
-
2020
- 2020-03-31 CN CN202010245815.1A patent/CN111351490B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20080023587A1 (en) * | 2006-07-27 | 2008-01-31 | Raytheon Company | Autonomous Space Flight System and Planetary Lander for Executing a Discrete Landing Sequence to Remove Unknown Navigation Error, Perform Hazard Avoidance and Relocate the Lander and Method |
CN101074881A (zh) * | 2007-07-24 | 2007-11-21 | 北京控制工程研究所 | 一种月球探测器软着陆阶段惯性导航方法 |
CN102879011A (zh) * | 2012-09-21 | 2013-01-16 | 北京控制工程研究所 | 一种基于星敏感器辅助的月面惯导对准方法 |
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103256932A (zh) * | 2013-05-30 | 2013-08-21 | 北京控制工程研究所 | 一种替换结合外推的着陆导航方法 |
CN103674034A (zh) * | 2013-12-26 | 2014-03-26 | 北京控制工程研究所 | 多波束测速测距修正的鲁棒导航方法 |
CN103759729A (zh) * | 2014-01-10 | 2014-04-30 | 北京空间飞行器总体设计部 | 采用捷联惯导的月球软着陆地面试验用初始姿态获取方法 |
CN103900576A (zh) * | 2014-03-31 | 2014-07-02 | 北京控制工程研究所 | 一种深空探测自主导航的信息融合方法 |
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 |
CN109292114A (zh) * | 2018-09-14 | 2019-02-01 | 北京控制工程研究所 | 一种崎岖地形月面软着陆轨迹确定方法 |
CN110307840A (zh) * | 2019-05-21 | 2019-10-08 | 北京控制工程研究所 | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 |
Non-Patent Citations (5)
Title |
---|
张洪华等: "嫦娥三号着陆器动力下降的制导导航与控制 ", 《中国科学:技术科学》 * |
王大轶等: "基于IMU配以测量修正的月球软着陆自主导航研究 ", 《宇航学报》 * |
王大轶等: "月球软着陆过程高精度自主导航避障方法 ", 《深空探测学报》 * |
王大轶等: "火星进入段自主导航技术研究综述 ", 《空间控制技术与应用》 * |
黄翔宇等: ""嫦娥三号"探测器软着陆自主导航与制导技术 ", 《深空探测学报》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111680462A (zh) * | 2020-08-11 | 2020-09-18 | 北京控制与电子技术研究所 | 基于空间目标在光学相平面位置变化的制导方法和系统 |
CN111680462B (zh) * | 2020-08-11 | 2020-11-10 | 北京控制与电子技术研究所 | 基于空间目标在光学相平面位置变化的制导方法和系统 |
CN113030517A (zh) * | 2021-02-18 | 2021-06-25 | 北京控制工程研究所 | 一种火星着陆过程利用测速敏感器的姿态修正方法 |
CN113030517B (zh) * | 2021-02-18 | 2022-10-28 | 北京控制工程研究所 | 一种火星着陆过程利用测速敏感器的姿态修正方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111351490B (zh) | 2022-01-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP3043148B1 (en) | Heading for a hybrid navigation solution based on magnetically calibrated measurements | |
CN109000665B (zh) | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 | |
O'Keefe et al. | IRVE-II post-flight trajectory reconstruction | |
CN111351490B (zh) | 一种行星着陆过程惯导基准快速重建方法 | |
CN103884340B (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
CN111678514B (zh) | 一种基于载体运动条件约束和单轴旋转调制的车载自主导航方法 | |
CN103453907B (zh) | 基于分层大气模型的行星进入段导航滤波方法 | |
CN103968844B (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN101122637A (zh) | 一种sar运动补偿用sins/gps组合导航自适应降维滤波方法 | |
CN111121766A (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN106989761A (zh) | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 | |
CN113030517B (zh) | 一种火星着陆过程利用测速敏感器的姿态修正方法 | |
CN111766397B (zh) | 一种基于惯性/卫星/大气组合的气象风测量方法 | |
CN112556724A (zh) | 动态环境下的微型飞行器低成本导航系统初始粗对准方法 | |
CN103123487B (zh) | 一种航天器姿态确定方法 | |
CN109211232B (zh) | 一种基于最小二乘滤波的炮弹姿态估计方法 | |
CN110307840B (zh) | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 | |
CN103913169A (zh) | 一种飞行器的捷联惯性/星光折射组合导航方法 | |
Karlgaard et al. | Mars Science Laboratory entry, descent, and landing trajectory and atmosphere reconstruction | |
CN112066999B (zh) | 一种行星着陆过程引力方向实时确定方法及装置 | |
CN104764464A (zh) | 一种利用全量信息进行飞行器冗余诊断的方法 | |
Huttner et al. | Offset and misalignment estimation for the online calibration of an MEMS-IMU using FIR-filter modulating functions | |
CN111649738B (zh) | 微重力场下的加速度计初始姿态解算方法 | |
CN111007542B (zh) | 一种车载星基增强多模gnss/mimu组合导航中mimu安装误差角的计算方法 | |
CN110132267B (zh) | 空天地一体化飞行器的光纤惯导系统及光纤惯导在轨对准方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |