CN110307840B - 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 - Google Patents
一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 Download PDFInfo
- Publication number
- CN110307840B CN110307840B CN201910422724.8A CN201910422724A CN110307840B CN 110307840 B CN110307840 B CN 110307840B CN 201910422724 A CN201910422724 A CN 201910422724A CN 110307840 B CN110307840 B CN 110307840B
- Authority
- CN
- China
- Prior art keywords
- speed
- detector
- measurement
- height
- planet
- 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
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/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
- G01C21/025—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means with the use of startrackers
-
- 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
Abstract
一种基于多波束测距测速和惯性的着陆段鲁棒融合方法,首先建立探测器高度和垂向速度的二阶动力学系统、探测器测距的虚拟高度,使用探测器测距的虚拟高度建立探测器高度和垂向速度的统一线性方程,并得到最优无偏估计,进而得到高度和垂向速度的鲁棒估计,然后建立探测器相对于行星的速度的动力学方程、探测器测速敏感器的测量方程,进而得到探测器速度的统一线性方程及线性无偏估计,最后根据探测器相对于行星的速度的线性无偏估计,借助方差上界理论得到探测器相对于行星速度的鲁棒估计。
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测量误差的影响,惯性导航的外推误差会随着时间的推移而增大,如果单纯依靠惯性导航计算,在接触火星表面时的位置和速度误差太大,不能保证着陆安全,因此必须在抛大底以后,引入测距测速修正。
为了获得三维速度信息需要三个波束的速度测量,而为了获得高度信息则需要一个波束的距离测量,而为了提高导航系统的冗余性和可靠性,则一般采用多个波束进行测量。但是这也给测距测速+惯性的融合算法研制带来了挑战,首先由于共有的姿态信息以及测量噪声和状态相关,使得每个波束的测量是彼此相关的,而且这些相关性很难解析计算出来,如果简单的忽略这些相关性去设计融合算法,则有可能会使得滤波发散导致任务失败;其次,采用多个波束势必会增加速度计算量,而星上计算能力有限,很难采取实时的卡尔曼滤波技术进行估计,如何设计计算量小的融合算法也是需要考虑的问题。
发明内容
本发明解决的技术问题是:克服现有技术的不足,针对火星着陆段的测距和测速修正过程,由于姿态的耦合以及测量噪声其他的影响导致相关未知的情况,提供了一种基于多波束测距测速和惯性的着陆段鲁棒融合方法,实现鲁棒估计。并考虑星上计算约束,实现实时估计。
本发明的技术解决方案是:一种基于多波束测距测速和惯性的着陆段鲁棒融合方法,包括如下步骤:
(1)建立探测器高度和垂向速度的二阶动力学系统;
(2)根据探测器高度和垂向速度的二阶动力学系统确定探测器测距的虚拟高度;
(3)使用探测器测距的虚拟高度建立探测器高度和垂向速度的统一线性方程,并得到最优无偏估计;
(4)根据最优无偏估计得到高度和垂向速度;
(5)建立探测器相对于行星的速度的动力学方程;
(6)建立探测器测速敏感器的测量方程;
(7)根据探测器相对于行星的速度的动力学方程、探测器测速敏感器的测量方程得到探测器速度的统一线性方程及线性无偏估计;
(8)根据步骤(7)得到的探测器相对于行星的速度的线性无偏估计,借助方差上界理论得到探测器相对于行星速度的鲁棒估计。
所述的探测器高度和垂向速度的二阶动力学系统为
所述的探测器高度和垂向速度的统一线性方程为
zhv=Hhvxhv+whv
所述的步骤(4)根据最优无偏估计得到高度和垂向速度的方法为:
所述的探测器测速敏感器的测量方程为
所述的探测器速度的统一线性方程为
其中, 为探测器惯导输出的探测器相对于行星的速度,l为测速敏感器可用的测速波束数目,I3为三维三维矩阵,则惯导输出和波束测量可以写作统一的线性方程,w为探测器惯导可以输出探测器相对于行星的速度对应的噪声;
所述的探测器相对于行星速度的鲁棒估计的方法为:
得到
本发明与现有技术相比的优点在于:
(1)本发明基于方差上界理论,给出了测距测速的鲁棒修正算法,提高了算法的稳定和精度。且算法为解析算法,易于星上运算,为软着陆任务的成功实施奠定了基础;
(2)本发明采用线性统一估计理论,给出了高度和速度的最优无偏估计,并基于方差上界理论消除了估计与观测之间的未知相关性,解决了现有技术状态估计和观测噪声的未知相关性带来的滤波发散问题,最终给出的估计具备一致性。
附图说明
图1为测距修正和测速修正的估计结果示意图。
具体实施方式
本发明针对火星着陆段的测距和测速修正过程,由于姿态的耦合以及测量噪声其他的影响导致相关未知的情况,提供了一种基于多波束测距测速和惯性的着陆段鲁棒融合方法,实现鲁棒估计。并考虑星上计算约束,实现实时估计,包括如下步骤:
(1)测距修正
(11)根据惯导方程建立高度-垂向速度的二阶动力学方程。
(12)利用姿态信息,根据每个波束的测量量计算高度,将高度作为虚拟的观测量
(13)根据惯导预测的高度、垂向速度和测距得到高度,得到线性统一方程,利用最小方差估计理论可以得到关于高度和垂向速度的最优无偏估计
(14)利用方差上界理论和噪声统计特性,得到噪声方差的上界,以消除未知的相关性,并利用最小方差估计理论得到高度和垂向速度的融合估计
(2)测速修正
(21)根据惯导方程建立本体3维速度的动力学系统
(22)建立测速测量方程
(23)根据惯导方程得到本体速度和测速的测量量得到线性统一方程,利用最小方差估计理论可以得到关于本体3维速度的最优无偏估计,利用方差上界理论和噪声统计特性,得到噪声方差的上界,以消除未知的相关性,并利用最小方差估计理论得到本体三维速度的融合估计。下面结合附图对本发明方法进行更详细的解释和说明。
基于多波束测距测速和惯性的着陆段鲁棒融合算法具体计算过程如下:
1)建立探测器高度和垂向速度的二阶动力学系统
其中,h和vver分别为探测器的高度和垂向速度;g为引力加速度,可设为常值;fver为探测器上的加速度计测得的加速度在重力方向的投影,重力方向可以由惯性导航计算得到。
2)计算探测器的测距的虚拟高度
探测器上的测距仪的的观测方程为:
3)建立关于高度和垂向速度的统一线性方程,并得到最小无偏估计
zhv=Hhvxhv+whv (4)
其中:
5)建立速度的动力学方程
假定探测器相对于行星的速度为ve,则其微分方程可以写作
6)建立探测器测速敏感器的测量方程
7)建立探测器速度的统一线性方程及线性无偏估计
其中:
对于式(11)组成的线性系统,其最优无偏线性估计为
其中
8)基于方差上界理论,给出速度修正的鲁棒估计
经过化简可以得到:
如图1所示为测距修正和测速修正的估计结果,图1的左图为高度估计误差,图1右图为速度估计误差,其中上下边界的实线分别为3σ边界,由图可知3σ边界包含有实际的误差曲线(边界以内的曲线),这说明给出的最终估计满足一致性,从而验证了算法的有效性。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
Claims (7)
1.一种基于多波束测距测速和惯性的着陆段鲁棒融合方法,其特征在于包括如下步骤:
(1)建立探测器高度和垂向速度的二阶动力学系统;
(2)根据探测器高度和垂向速度的二阶动力学系统确定探测器测距的虚拟高度;
(3)使用探测器测距的虚拟高度建立探测器高度和垂向速度的统一线性方程,并得到最优无偏估计;
所述的探测器高度和垂向速度的统一线性方程为
zhv=Hhvxhv+whv
(4)根据最优无偏估计得到高度和垂向速度;
(5)建立探测器相对于行星的速度的动力学方程;
(6)建立探测器测速敏感器的测量方程;
(7)根据探测器相对于行星的速度的动力学方程、探测器测速敏感器的测量方程得到探测器速度的统一线性方程及线性无偏估计;
所述的探测器速度的统一线性方程为
其中, 为探测器惯导输出的探测器相对于行星的速度,l为测速敏感器可用的测速波束数目,I3为三维矩阵,则惯导输出和波束测量可以写作统一的线性方程,w为探测器惯导可以输出探测器相对于行星的速度对应的噪声;ve为探测器相对于行星的速度;上标i表示投影在惯性系下;为测速敏感器第i个波速的测量值,p(i)为测速敏感器第i个波速的指向,νv(i)为对应的测量噪声;
(8)根据步骤(7)得到的探测器相对于行星的速度的线性无偏估计,借助方差上界理论得到探测器相对于行星速度的鲁棒估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910422724.8A CN110307840B (zh) | 2019-05-21 | 2019-05-21 | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910422724.8A CN110307840B (zh) | 2019-05-21 | 2019-05-21 | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110307840A CN110307840A (zh) | 2019-10-08 |
CN110307840B true CN110307840B (zh) | 2021-09-07 |
Family
ID=68074798
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910422724.8A Active CN110307840B (zh) | 2019-05-21 | 2019-05-21 | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110307840B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111351490B (zh) * | 2020-03-31 | 2022-01-04 | 北京控制工程研究所 | 一种行星着陆过程惯导基准快速重建方法 |
CN114152261B (zh) * | 2021-09-26 | 2024-05-03 | 北京控制工程研究所 | 一种地外天体着陆过程自适应导航修正方法和系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674034A (zh) * | 2013-12-26 | 2014-03-26 | 北京控制工程研究所 | 多波束测速测距修正的鲁棒导航方法 |
CN103900576A (zh) * | 2014-03-31 | 2014-07-02 | 北京控制工程研究所 | 一种深空探测自主导航的信息融合方法 |
CN105371853A (zh) * | 2014-08-06 | 2016-03-02 | 北京理工大学 | 基于tds与轨道器的火星动力下降段导航方法 |
CN107132542A (zh) * | 2017-05-02 | 2017-09-05 | 北京理工大学 | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 |
CN108548540A (zh) * | 2018-02-27 | 2018-09-18 | 北京控制工程研究所 | 一种多波束测速信息融合方法及系统 |
-
2019
- 2019-05-21 CN CN201910422724.8A patent/CN110307840B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103674034A (zh) * | 2013-12-26 | 2014-03-26 | 北京控制工程研究所 | 多波束测速测距修正的鲁棒导航方法 |
CN103900576A (zh) * | 2014-03-31 | 2014-07-02 | 北京控制工程研究所 | 一种深空探测自主导航的信息融合方法 |
CN105371853A (zh) * | 2014-08-06 | 2016-03-02 | 北京理工大学 | 基于tds与轨道器的火星动力下降段导航方法 |
CN107132542A (zh) * | 2017-05-02 | 2017-09-05 | 北京理工大学 | 一种基于光学和多普勒雷达的小天体软着陆自主导航方法 |
CN108548540A (zh) * | 2018-02-27 | 2018-09-18 | 北京控制工程研究所 | 一种多波束测速信息融合方法及系统 |
Non-Patent Citations (3)
Title |
---|
一种深空探测雷达信号处理精度校准方法;郭语等;《空间电子技术》;20180625(第3期);全文 * |
嫦娥三号着陆器动力下降的制导导航与控制;张洪华等;《中国科学: 技术科学》;20140420;第44卷(第4期);全文 * |
嫦娥三号着陆器动力下降的自主导航;张洪华等;《控制理论与应用》;20141215;第31卷(第12期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN110307840A (zh) | 2019-10-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Mulder et al. | Non-linear aircraft flight path reconstruction review and new advances | |
US9726499B2 (en) | Method of determining a radius of protection associated with a navigation parameter of a hybrid inertial navigation system, and associated system | |
CN100585602C (zh) | 惯性测量系统误差模型验证试验方法 | |
CN103363991B (zh) | 一种适应月面崎岖地形的imu与测距敏感器融合方法 | |
CN109000665B (zh) | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 | |
RU2380656C1 (ru) | Комплексированная бесплатформенная инерциально-спутниковая система навигации на "грубых" чувствительных элементах | |
CN111965685B (zh) | 一种基于多普勒信息的低轨卫星/惯性组合导航定位方法 | |
CN103674034A (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN110307840B (zh) | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 | |
Striepe et al. | Autonomous precision landing and hazard avoidance technology (ALHAT) project status as of May 2010 | |
CN113030517B (zh) | 一种火星着陆过程利用测速敏感器的姿态修正方法 | |
CN111351490B (zh) | 一种行星着陆过程惯导基准快速重建方法 | |
CN103256932B (zh) | 一种替换结合外推的着陆导航方法 | |
CN109238307A (zh) | 一种基于多惯组信息辅助的飞行故障检测方法及装置 | |
Vinande et al. | Mounting-angle estimation for personal navigation devices | |
Sokolov et al. | Solving the autonomous initial navigation task for strapdown inertial navigation system on the perturbed basis using Rodriguez—Hamilton parameters | |
Bashir et al. | Kalman Filter Based Sensor Fusion for Altitude Estimation of Aerial Vehicle | |
Bruton et al. | Deriving acceleration from DGPS: toward higher resolution applications of airborne gravimetry | |
CN114964215A (zh) | 多个探测目标主体的轨道确定方法及装置、电子设备 | |
CN109100705A (zh) | 星载激光测高仪在轨标定模型中权矩阵的确定方法 | |
CN112066999B (zh) | 一种行星着陆过程引力方向实时确定方法及装置 | |
Harigae et al. | Development of GPS Aided Inertial Navigation System for High Speed Flight Demonstrator | |
CN105929192A (zh) | 一种基于gnss自主测速的测风装置及测风方法 | |
RU2620786C1 (ru) | Способ восстановления параметров движения летательного аппарата | |
Fang et al. | Integrating SINS sensors with odometer measurements for land vehicle navigation system |
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 |