CN112066999A - 一种行星着陆过程引力方向实时确定方法 - Google Patents
一种行星着陆过程引力方向实时确定方法 Download PDFInfo
- Publication number
- CN112066999A CN112066999A CN202010974504.9A CN202010974504A CN112066999A CN 112066999 A CN112066999 A CN 112066999A CN 202010974504 A CN202010974504 A CN 202010974504A CN 112066999 A CN112066999 A CN 112066999A
- Authority
- CN
- China
- Prior art keywords
- equation
- state
- lander
- speed
- landing process
- 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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
一种行星着陆过程引力方向实时确定方法,属于航天器自主导航技术领域,首先将本体坐标系下的着陆器速度和引力方向作为状态量,建立相应的系统状态方程,然后建立测速敏感器的测量方程,最后利用约束卡尔曼滤波技术实现对本体系下的速度和引力方向的实时估计。本发明方法利用卡尔曼滤波框架进行引力方向估计,可以通过滤波的方差对状态估计的收敛性进行判断。本发明方法不需要对历史时刻的观测量进行存储,计算量小,适宜星上计算。
Description
技术领域
本发明涉及一种行星着陆过程引力方向实时确定方法,特别是火星着陆过程,属于航天器自主导航技术领域。
背景技术
火星探测任务的进入、降落与着陆段(Entry,Descent,and Landing,简称EDL)是火星探测器近7亿千米旅途的最后6、7分钟,是火星表面探测任务的关键阶段,也是最困难的阶段。EDL技术也是火星表面探测任务的关键技术之一。迄今为止,大部分火星着陆任务的失败都是在EDL过程中发生的。在EDL过程伞降过程中,动态极高,而且无法建立完善的动力学模型进行分析。这一过程的高动态导致IMU极易饱和甚至出现故障,而一段IMU出现饱和故障,将丧失姿态基准。而目前的着陆任务中在根据测距信息计算高度信息的,利用了惯导的姿态基准。一旦姿态丧失基准,高度信息解算错误就会影响任务的成功实施。2016年欧空局ExoMars火星任务的着陆器就是因为IMU出现饱和使得姿态基准丧失,造成了高度计算错误引发GNC指令执行错误,最终导致着陆器坠毁。显然姿态基准的丢失会导致测距测速敏感器的高度和速度解算错误以及惯性导航的高度和速度预测错误,这就要求系统不仅利用测距测速敏感器和惯性测量单元对惯性导航的基准进行重建。惯性导航基准重建关键为确定引力方向在新的惯性基准下的投影。
发明内容
本发明要解决的技术问题是:克服现有技术的不足,提供了一种行星着陆过程引力方向实时确定方法,首先将本体坐标系下的着陆器速度和引力方向作为状态量,建立相应的系统状态方程,然后建立测速敏感器的测量方程,最后利用约束卡尔曼滤波技术实现对本体系下的速度和引力方向的实时估计。
本发明目的通过以下技术方案予以实现:
一种行星着陆过程引力方向实时确定方法,用于着陆器的着陆过程,着陆器上装有测速敏感器,包括如下步骤:
S1、在着陆器本体坐标系下,建立着陆器速度的状态方程和引力加速度的状态方程;
S2、设定滤波状态量,根据着陆器速度的状态方程和引力加速度的状态方程,建立状态估计预测方程和误差状态方差的预测方程;建立着陆器的测速敏感器每个波束的测量方程;
S3、根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,确定每个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
上述行星着陆过程引力方向实时确定方法,优选的,S2中,根据着陆器速度的状态方程和引力加速度的状态方程,获得滤波状态方程;然后根据滤波状态方程获得状态估计预测方程和误差状态方差的预测方程。
上述行星着陆过程引力方向实时确定方法,优选的,S3中,根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,迭代确定每个波束的状态估计预测值。
上述行星着陆过程引力方向实时确定方法,优选的,S3中,根据最后一个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
上述行星着陆过程引力方向实时确定方法,优选的,S3中,根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,首先确定任一波束的非约束卡尔曼滤波增益矩阵,然后确定该波束的状态估计预测值。
上述行星着陆过程引力方向实时确定方法,优选的,根据所述引力方向实时确定方法,重建惯性导航基准,确定探测器的垂向速度、水平速度、高度。
一种行星着陆过程引力方向实时确定装置,用于着陆器的着陆过程,着陆器上装有测速敏感器,包括第一模块、第二模块、估计模块;
所述第一模块用于在着陆器本体坐标系下,建立着陆器速度的状态方程和引力加速度的状态方程;
所述第二模块用于设定滤波状态量,根据着陆器速度的状态方程和引力加速度的状态方程,建立状态估计预测方程和误差状态方差的预测方程;建立着陆器的测速敏感器每个波束的测量方程;
所述估计模块用于根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,确定每个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
上述行星着陆过程引力方向实时确定装置,优选的,所述第二模块根据着陆器速度的状态方程和引力加速度的状态方程,获得滤波状态方程;然后根据滤波状态方程获得状态估计预测方程和误差状态方差的预测方程。
上述行星着陆过程引力方向实时确定装置,优选的,所述估计模块根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,迭代确定每个波束的状态估计预测值。
上述行星着陆过程引力方向实时确定装置,优选的,所述估计模块根据最后一个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
本发明相比于现有技术具有如下有益效果:
(1)本发明方法利用卡尔曼滤波框架进行引力方向估计,可以通过滤波的方差对状态估计的收敛性进行判断。
(2)本发明方法进行引力方向估计时,对测速波束的测量个数没有限制,适应性广。
(3)本发明方法利用约束滤波技术,可以在一定程度提高估计收敛速度和估计精度。
(4)本发明方法不需要对历史时刻的观测量进行存储,计算量小,适宜星上计算。
附图说明
图1为本发明方法的步骤流程图;
图2为应用本发明方法的引力方向估计误差结果。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明的实施方式作进一步详细描述。
一种行星着陆过程引力方向实时确定方法,用于着陆器的着陆过程,着陆器上装有测速敏感器,如图1所示,包括如下步骤:
S1、在着陆器本体坐标系下,建立着陆器速度的状态方程和引力加速度的状态方程;
S2、设定滤波状态量,根据着陆器速度的状态方程和引力加速度的状态方程,建立状态估计预测方程和误差状态方差的预测方程;建立着陆器的测速敏感器每个波束的测量方程;
S3、根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,确定每个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
一种行星着陆过程引力方向实时确定装置,用于着陆器的着陆过程,着陆器上装有测速敏感器,包括第一模块、第二模块、估计模块;
所述第一模块用于在着陆器本体坐标系下,建立着陆器速度的状态方程和引力加速度的状态方程;
所述第二模块用于设定滤波状态量,根据着陆器速度的状态方程和引力加速度的状态方程,建立状态估计预测方程和误差状态方差的预测方程;建立着陆器的测速敏感器每个波束的测量方程;
所述估计模块用于根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,确定每个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
作为本发明的一种优选方案,根据着陆器速度的状态方程和引力加速度的状态方程,获得滤波状态方程;然后根据滤波状态方程获得状态估计预测方程和误差状态方差的预测方程。
作为本发明的一种优选方案,根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,迭代确定每个波束的状态估计预测值。根据最后一个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
作为本发明的一种优选方案,根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,首先确定任一波束的非约束卡尔曼滤波增益矩阵,然后确定该波束的状态估计预测值。
作为本发明的一种优选方案,根据所述引力方向实时确定方法,重建惯性导航基准,确定探测器的垂向速度、水平速度、高度。
实施例:
惯性导航基准重建的关键是确定引力方向在新的惯性基准下的投影,根据引力方向能够重建惯性导航基准,然后确定探测器(即着陆器)的垂向速度、水平速度、高度等数据。
一种行星着陆过程引力方向实时确定方法,能够应用于探测器在火星(或其他行星)的着陆过程中,实时估计火星着陆过程中的引力方向,包括如下步骤:
1)建立着陆器本体坐标系下着陆器速度的状态方程。
着陆器相对于火星的速度为vf,有
对式(1)求微分可以得到:
2)建立本体系下引力加速度的状态方程。
3)设定滤波状态量,根据第1)步着陆器速度的状态方程和第2)步引力加速度的状态方程,获得滤波状态方程。
其中:
上式中g=||gb||为引力加速度大小,近似为常数,03和I3分别为3×3的零矩阵和单位矩阵,03×1为3×1的零向量。
4)设定着陆器的测速敏感器有m个波束,则第k个波束的测量方程可以写作:
5)根据第3)步滤波状态方程获得状态估计预测方程和误差状态方差的预测方程:
其中:Φj,j-1为tj-1时刻到tj时刻的状态转移矩阵,由tj-1时刻的A计算得到,为tj-1时刻的状态估计,为的误差状态方差,为tj时刻的状态预测值,为的误差状态方差,Qd,j-1为离散化的噪声方差。
6)利用第4)步的第k个波束的测量方程和第5)步的误差状态方差的预测方程,获得第1个波束的非约束卡尔曼滤波增益矩阵为:
其中:R(1)为ν(1)的噪声方差。Kj,(1)为第1个波束的非约束卡尔曼滤波增益矩阵;H(1)为第1个波束对应的测量敏感矩阵,见式(5)。
7)利用第1个波束的非约束卡尔曼滤波增益矩阵,对第1个波束进行状态测量更新:
8)利用第1个波束的非约束卡尔曼滤波增益矩阵,对第1个波束的测量值进行误差状态方程更新:
9)依次对第2~m个波束的测量量进行处理,将处理完第i(i=1~m-1)个波束得到的状态估计和误差方差作为处理第i+1个波束前的状态估计和误差方差的预测值,也即:
10)计算tj时刻处理完所有测量数据的状态估计值。将处理完第m个波束得到的状态估计和误差方差作为tj时刻的状态估计和误差方差,也即:
图2给出了引力估计误差曲线,由图可知引力估计大概需要30s收敛,收敛后的引力方向估计误差很小。
本发明说明书中未作详细描述的内容属本领域技术人员的公知技术。
本发明虽然已以较佳实施例公开如上,但其并不是用来限定本发明,任何本领域技术人员在不脱离本发明的精神和范围内,都可以利用上述揭示的方法和技术内容对本发明技术方案做出可能的变动和修改,因此,凡是未脱离本发明技术方案的内容,依据本发明的技术实质对以上实施例所作的任何简单修改、等同变化及修饰,均属于本发明技术方案的保护范围。
Claims (10)
1.一种行星着陆过程引力方向实时确定方法,用于着陆器的着陆过程,着陆器上装有测速敏感器,其特征在于,包括如下步骤:
S1、在着陆器本体坐标系下,建立着陆器速度的状态方程和引力加速度的状态方程;
S2、设定滤波状态量,根据着陆器速度的状态方程和引力加速度的状态方程,建立状态估计预测方程和误差状态方差的预测方程;建立着陆器的测速敏感器每个波束的测量方程;
S3、根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,确定每个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
2.根据权利要求1所述的一种行星着陆过程引力方向实时确定方法,其特征在于,S2中,根据着陆器速度的状态方程和引力加速度的状态方程,获得滤波状态方程;然后根据滤波状态方程获得状态估计预测方程和误差状态方差的预测方程。
3.根据权利要求1所述的一种行星着陆过程引力方向实时确定方法,其特征在于,S3中,根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,迭代确定每个波束的状态估计预测值。
4.根据权利要求1所述的一种行星着陆过程引力方向实时确定方法,其特征在于,S3中,根据最后一个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
5.根据权利要求1所述的一种行星着陆过程引力方向实时确定方法,其特征在于,S3中,根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,首先确定任一波束的非约束卡尔曼滤波增益矩阵,然后确定该波束的状态估计预测值。
6.根据权利要求1~5之一所述的一种行星着陆过程引力方向实时确定方法,其特征在于,根据所述引力方向实时确定方法,重建惯性导航基准,确定探测器的垂向速度、水平速度、高度。
7.一种行星着陆过程引力方向实时确定装置,用于着陆器的着陆过程,着陆器上装有测速敏感器,其特征在于,包括第一模块、第二模块、估计模块;
所述第一模块用于在着陆器本体坐标系下,建立着陆器速度的状态方程和引力加速度的状态方程;
所述第二模块用于设定滤波状态量,根据着陆器速度的状态方程和引力加速度的状态方程,建立状态估计预测方程和误差状态方差的预测方程;建立着陆器的测速敏感器每个波束的测量方程;
所述估计模块用于根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,确定每个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
8.根据权利要求7所述的一种行星着陆过程引力方向实时确定装置,其特征在于,所述第二模块根据着陆器速度的状态方程和引力加速度的状态方程,获得滤波状态方程;然后根据滤波状态方程获得状态估计预测方程和误差状态方差的预测方程。
9.根据权利要求7所述的一种行星着陆过程引力方向实时确定装置,其特征在于,所述估计模块根据测速敏感器每个波束的测量方程和误差状态方差的预测方程,迭代确定每个波束的状态估计预测值。
10.根据权利要求7所述的一种行星着陆过程引力方向实时确定装置,其特征在于,所述估计模块根据最后一个波束的状态估计预测值,获得行星着陆过程任一时刻的引力方向估计值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010974504.9A CN112066999B (zh) | 2020-09-16 | 2020-09-16 | 一种行星着陆过程引力方向实时确定方法及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010974504.9A CN112066999B (zh) | 2020-09-16 | 2020-09-16 | 一种行星着陆过程引力方向实时确定方法及装置 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112066999A true CN112066999A (zh) | 2020-12-11 |
CN112066999B CN112066999B (zh) | 2022-08-12 |
Family
ID=73697075
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010974504.9A Active CN112066999B (zh) | 2020-09-16 | 2020-09-16 | 一种行星着陆过程引力方向实时确定方法及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112066999B (zh) |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103884333A (zh) * | 2014-03-31 | 2014-06-25 | 北京控制工程研究所 | 一种深空探测自主导航初始基准捕获方法 |
JP2016049393A (ja) * | 2014-09-02 | 2016-04-11 | カシオ計算機株式会社 | 計測装置、計測方法及びプログラム |
CN107202584A (zh) * | 2017-07-06 | 2017-09-26 | 北京理工大学 | 一种行星精确着陆抗扰制导方法 |
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 |
CN109269511A (zh) * | 2018-11-06 | 2019-01-25 | 北京理工大学 | 未知环境下行星着陆的曲线匹配视觉导航方法 |
CN110362784A (zh) * | 2019-06-10 | 2019-10-22 | 南京航空航天大学 | 一种基于切比雪夫多项式的小行星着陆段引力计算方法 |
CN110686683A (zh) * | 2019-11-01 | 2020-01-14 | 北京理工大学 | 基于不均匀膨胀椭球的行星着陆轨迹在线优化方法 |
-
2020
- 2020-09-16 CN CN202010974504.9A patent/CN112066999B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103363991A (zh) * | 2013-04-09 | 2013-10-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103884333A (zh) * | 2014-03-31 | 2014-06-25 | 北京控制工程研究所 | 一种深空探测自主导航初始基准捕获方法 |
JP2016049393A (ja) * | 2014-09-02 | 2016-04-11 | カシオ計算機株式会社 | 計測装置、計測方法及びプログラム |
CN107202584A (zh) * | 2017-07-06 | 2017-09-26 | 北京理工大学 | 一种行星精确着陆抗扰制导方法 |
CN109000665A (zh) * | 2018-03-20 | 2018-12-14 | 北京控制工程研究所 | 一种深空着陆几何定轨定姿方法、系统及深空着陆器 |
CN109269511A (zh) * | 2018-11-06 | 2019-01-25 | 北京理工大学 | 未知环境下行星着陆的曲线匹配视觉导航方法 |
CN110362784A (zh) * | 2019-06-10 | 2019-10-22 | 南京航空航天大学 | 一种基于切比雪夫多项式的小行星着陆段引力计算方法 |
CN110686683A (zh) * | 2019-11-01 | 2020-01-14 | 北京理工大学 | 基于不均匀膨胀椭球的行星着陆轨迹在线优化方法 |
Non-Patent Citations (3)
Title |
---|
V.N.LIKHACHEV 等: ""A Method for Estimating the Direction of Gravitational Acceleration in the Active Phase of a Spacecraft Landing on the Martian Surface"", 《SOLAR SYSTEM RESEARCH》 * |
张晓文等: "基于陆标图像的天体定点着陆信息融合导航方法", 《空间控制技术与应用》 * |
王大轶: "《航天器多源信息融合自主导航技术》", 31 March 2018 * |
Also Published As
Publication number | Publication date |
---|---|
CN112066999B (zh) | 2022-08-12 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Mulder et al. | Non-linear aircraft flight path reconstruction review and new advances | |
CN101846510B (zh) | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 | |
CN111156994B (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
O'Keefe et al. | IRVE-II post-flight trajectory reconstruction | |
CN103743395A (zh) | 一种惯性重力匹配组合导航系统中时间延迟的补偿方法 | |
CN108168548B (zh) | 一种通过机器学习算法与模型辅助的行人惯性导航系统和方法 | |
Zurek et al. | Application of MAVEN accelerometer and attitude control data to Mars atmospheric characterization | |
CN103884340B (zh) | 一种深空探测定点软着陆过程的信息融合导航方法 | |
CN106767797A (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN110567454A (zh) | 一种复杂环境下sins/dvl紧组合导航方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
US6170344B1 (en) | Pipeline distortion monitoring system | |
CN111351490B (zh) | 一种行星着陆过程惯导基准快速重建方法 | |
CN113030517B (zh) | 一种火星着陆过程利用测速敏感器的姿态修正方法 | |
CN110307840B (zh) | 一种基于多波束测距测速和惯性的着陆段鲁棒融合方法 | |
CN112066999B (zh) | 一种行星着陆过程引力方向实时确定方法及装置 | |
Hajiyev et al. | Gyroless attitude and rate estimation of small satellites using singular value decomposition and extended Kalman filter | |
CN103411627B (zh) | 火星动力下降段非线性三步滤波方法 | |
Da Forno et al. | Autonomous navigation of MegSat1: Attitude, sensor bias and scale factor estimation by EKF and magnetometer-only measurement | |
Nøkland | Nonlinear observer design for GNSS and IMU integration | |
Li et al. | Velocimeter-aided attitude estimation for Mars autonomous landing: Observability analysis and filter algorithms | |
Lee et al. | Spacecraft attitude estimation under attitude tracking maneuver during close-proximity operations | |
Zhang et al. | An iterative optimization method for estimating accelerometer bias based on gravitational apparent motion with excitation of swinging motion | |
Fang et al. | Integrating SINS sensors with odometer measurements for land vehicle navigation system | |
Hajiyev et al. | Nontraditional UKF based nanosatellite attitude estimation with the process and measurement noise covariances adaptation |
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 |