CN101074881B - 一种月球探测器软着陆阶段惯性导航方法 - Google Patents
一种月球探测器软着陆阶段惯性导航方法 Download PDFInfo
- Publication number
- CN101074881B CN101074881B CN2007101301881A CN200710130188A CN101074881B CN 101074881 B CN101074881 B CN 101074881B CN 2007101301881 A CN2007101301881 A CN 2007101301881A CN 200710130188 A CN200710130188 A CN 200710130188A CN 101074881 B CN101074881 B CN 101074881B
- Authority
- CN
- China
- Prior art keywords
- mtd
- mrow
- mtr
- msub
- speed
- 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
- PEDCQBHIVMGVHV-UHFFFAOYSA-N Glycerine Chemical compound OCC(O)CO PEDCQBHIVMGVHV-UHFFFAOYSA-N 0.000 title claims abstract description 13
- 238000000034 method Methods 0.000 title claims abstract description 13
- 239000000523 sample Substances 0.000 claims description 13
- 238000001914 filtration Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 5
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000002194 synthesizing effect Effects 0.000 claims description 2
- 238000005259 measurement Methods 0.000 description 17
- 101100167360 Drosophila melanogaster chb gene Proteins 0.000 description 10
- 238000004088 simulation Methods 0.000 description 4
- 230000007547 defect Effects 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000005484 gravity Effects 0.000 description 1
Images
Landscapes
- Gyroscopes (AREA)
- Navigation (AREA)
Abstract
一种月球探测器软着陆阶段惯性导航方法,属于月球探测器软着陆阶段惯性导航技术领域,包括下列步骤:(1)建立月球导航方程,由陀螺得到月球探测器的姿态信息,加速度计综合轨道初值与姿态信息得到惯性导航轨道;(2)测速仪根据姿态信息得到探测器速度;测距仪根据姿态信息得到探测器位置;(3)惯性导航轨道综合探测器速度和位置,经过滤波修正得到最终的导航轨道数据。本发明利用测距、测速信息对惯性导航结果进行修正,有效提高了月球软着陆阶段的自主导航精度,一定程度上减轻了地面测控***的压力。
Description
技术领域
本发明属于月球探测器软着陆阶段惯性导航技术领域。
背景技术
月球探测器软着陆阶段,惯性导航是一种简单可靠的导航方法,前苏联的Lunar系列月球探测器、美国的Surveyor系列月球探测器和Apollo系列月球探测器***都采用了惯性导航的方法。惯性导航的原理是,根据初始轨道的装订数据,对惯性测量单元的输出进行积分,得到探测器的位置和速度。但是,在月球探测器软着陆过程中,由地面测控***提供的初始轨道装订数据不可避免地存在误差;惯性测量单元中的陀螺和加速度计也存在测量误差。这些误差的存在影响了导航精度,基于积分原理的惯性导航方法的不足之处正体现于此。
发明内容
本发明的技术解决问题是:克服现有技术在月球软着陆阶段惯性导航方法无法降低初始轨道误差和惯性测量单元的测量误差的不足之处,提供一种基于测距、测速修正的惯性导航方法,该方法可以减弱这些误差对导航精度的影响。
本发明的方法的技术解决方案是:一种月球探测器软着陆阶段惯性导航方法,包括下列步骤:
(1)建立月球导航方程,由陀螺得到月球探测器的姿态信息,加速度计综合轨道初值与姿态信息得到惯性导航轨道;
(2)测速仪根据姿态信息得到探测器速度;测距仪根据姿态信息得到探测器位置;
(3)惯性导航轨道综合探测器速度和位置,经过滤波修正得到最终的导航轨道数据。
本发明与现有技术相比的有益效果是:本发明利用测距、测速信息对惯性导航结果进行修正,有效提高了月球软着陆阶段的自主导航精度,一定程度上减轻了地面测控***的压力。
附图说明
图1为本发明的基于测距、测速修正的惯性导航原理图;
图2为惯性导航在***情况下的位置误差;
图3为惯性导航在***情况下的速度误差;
图4为本发明的惯性导航在有修正情况下的位置误差;
图5为本发明的惯性导航在有修正情况下的速度误差。
具体实施方式
基于测距、测速修正的惯性导航原理如图1所示。
(1)建立导航方程。根据惯性坐标系内的导航基本方程,由陀螺得到月球探测器的姿态信息,加速度计综合轨道初值与姿态信息得到惯性导航轨道。惯性坐标系FI内的导航基本方程为
其中,r为月心到着陆器质心的矢量,g为引力加速度矢量,a为作用在着陆器上的视加速度矢量。加速度计测量的是着陆器相对惯性系的视加速度在FB中的投影 导航方程在惯性坐标系FI内表示为
其中, r=(x2+y2+z2)1/2,CIB为本体系到惯性系的姿态转移矩阵,由陀螺测量得到。
(2)状态方程。将导航方程转化为状态方程。设状态变量
其中
设Xref为惯性导航状态,定义***的误差状态δX=X-Xref。由状态方程可以导出***误差状态的线性化状态方程
其中
(3)观测方程。测距仪、测速仪根据姿态信息得到探测器的位置和速度。测速仪所测量的速度νF是本体坐标系FB相对固连坐标系FF的速度在FB中的表示。本体FB相对惯性FI的速度
ν I=ν F+ω×γ I
其中,ω为月球自转角速度矢量,大小为ωL。上式在FI内表示为
其中, 测距仪可以得到探测器沿敏感器视线方向到月面的距离,结合月球半径和姿态,可以得到探测器的位置 则测量方程
线性化得
可以证明, 非奇异,即***可观。
(5)仿真结果。假设导航初始轨道装订误差(577m,577m,577m,0.577m/s,0.577m/s,0.577m/s),仅利用IMU进行导航,仿真结果的位置误差如图2所示、速度误差如图3所示。从仿真结果可以看出,仅利用IMU的自主导航,无法修正初始导航误差,位置和速度误差随着时间增大而增大,导致最终存在较大的导航偏差。在310秒时引入测速和测距信息对IMU输出进行修正,仿真结果的位置误差如图4所示、速度误差如图5所示,表1、表2给出了在500s、600s和700s时刻,位置误差和速度误差在修正前后的对比数据。可以看出,位置和速度误差都得到明显的修正。
表1 位置误差修正前后对比(m)
表2 速度误差修正前后对比(m/s)
Claims (1)
1.一种月球探测器软着陆阶段惯性导航方法,其特征在于包括下列步骤:
(1)建立月球导航方程,由陀螺得到月球探测器的姿态信息,加速度计综合轨道初值与姿态信息得到惯性导航轨道;所述的月球导航方程为惯性坐标系内的导航基本方程,表达式为:
(2)测速仪根据姿态信息得到探测器速度;测距仪根据姿态信息得到探测器位置;计算探测器速度的表达式为:
(3)惯性导航轨道综合探测器速度和位置,并利用所述探测器速度和位置信息经过卡尔曼滤波修正得到最终的导航轨道数据;所述的卡尔曼滤波方程的表达式为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2007101301881A CN101074881B (zh) | 2007-07-24 | 2007-07-24 | 一种月球探测器软着陆阶段惯性导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2007101301881A CN101074881B (zh) | 2007-07-24 | 2007-07-24 | 一种月球探测器软着陆阶段惯性导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN101074881A CN101074881A (zh) | 2007-11-21 |
CN101074881B true CN101074881B (zh) | 2011-04-27 |
Family
ID=38976066
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2007101301881A Active CN101074881B (zh) | 2007-07-24 | 2007-07-24 | 一种月球探测器软着陆阶段惯性导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101074881B (zh) |
Families Citing this family (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102116631B (zh) * | 2009-12-31 | 2013-05-22 | 北京控制工程研究所 | 一种月球重力方向的自主确定方法 |
CN103363991B (zh) * | 2013-04-09 | 2015-12-23 | 北京控制工程研究所 | 一种适应月面崎岖地形的imu与测距敏感器融合方法 |
CN103256932B (zh) * | 2013-05-30 | 2014-12-17 | 北京控制工程研究所 | 一种替换结合外推的着陆导航方法 |
CN103591948B (zh) * | 2013-10-16 | 2014-11-19 | 北京控制工程研究所 | 一种改善着陆导航精度的初值同步方法 |
CN103592632B (zh) * | 2013-10-16 | 2015-05-27 | 北京控制工程研究所 | 一种适用于月球着陆过程的测距测速波束指向确定方法 |
CN103674034B (zh) * | 2013-12-26 | 2015-12-30 | 北京控制工程研究所 | 多波束测速测距修正的鲁棒导航方法 |
CN103759729B (zh) * | 2014-01-10 | 2015-09-23 | 北京空间飞行器总体设计部 | 采用捷联惯导的月球软着陆地面试验用初始姿态获取方法 |
CN103955223B (zh) * | 2014-04-10 | 2017-01-18 | 北京控制工程研究所 | 一种深空探测软着陆过程的姿轨耦合控制方法 |
CN105865505B (zh) * | 2016-03-17 | 2018-10-23 | 中国科学院紫金山天文台 | 基于卡尔曼滤波的kid阵列探测器s21基线校准方法 |
CN110108298B (zh) * | 2019-04-22 | 2021-03-26 | 北京控制工程研究所 | 一种前后台并行解算容错组合导航方法 |
CN110736482B (zh) * | 2019-09-23 | 2021-06-11 | 北京控制工程研究所 | 一种月球软着陆欠测量速度修正方法 |
CN111351490B (zh) * | 2020-03-31 | 2022-01-04 | 北京控制工程研究所 | 一种行星着陆过程惯导基准快速重建方法 |
CN111551973B (zh) * | 2020-04-16 | 2022-04-05 | 北京踏歌智行科技有限公司 | 一种露天矿无人驾驶惯导***的故障检测和矫正方法 |
CN111637894B (zh) * | 2020-04-28 | 2022-04-12 | 北京控制工程研究所 | 一种定常系数陆标图像导航滤波方法 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6272432B1 (en) * | 1999-05-10 | 2001-08-07 | Hughes Electronics Corporation | System and method for correcting star tracker low spatial frequency error in stellar-inertial attitude determination systems |
CN1361409A (zh) * | 2000-12-23 | 2002-07-31 | 林清芳 | 增强型导航定位之方法及其*** |
EP1382936A1 (en) * | 2001-04-25 | 2004-01-21 | Nihon University | Apparatus and method for estimating attitude using inertial measurement equipment and program |
CN1995916A (zh) * | 2006-12-27 | 2007-07-11 | 北京航空航天大学 | 一种基于星敏感器标定的深综合组合导航方法 |
-
2007
- 2007-07-24 CN CN2007101301881A patent/CN101074881B/zh active Active
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6272432B1 (en) * | 1999-05-10 | 2001-08-07 | Hughes Electronics Corporation | System and method for correcting star tracker low spatial frequency error in stellar-inertial attitude determination systems |
CN1361409A (zh) * | 2000-12-23 | 2002-07-31 | 林清芳 | 增强型导航定位之方法及其*** |
EP1382936A1 (en) * | 2001-04-25 | 2004-01-21 | Nihon University | Apparatus and method for estimating attitude using inertial measurement equipment and program |
CN1995916A (zh) * | 2006-12-27 | 2007-07-11 | 北京航空航天大学 | 一种基于星敏感器标定的深综合组合导航方法 |
Non-Patent Citations (2)
Title |
---|
蔡艳芳.月球探测器软着陆制导控制方法研究.中国优秀博硕士学位论文全文数据库(硕士) 7.2007,(7),1-53. |
蔡艳芳.月球探测器软着陆制导控制方法研究.中国优秀博硕士学位论文全文数据库(硕士) 7.2007,(7),1-53. * |
Also Published As
Publication number | Publication date |
---|---|
CN101074881A (zh) | 2007-11-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101074881B (zh) | 一种月球探测器软着陆阶段惯性导航方法 | |
CN102192741B (zh) | 飞行器姿态角的旋转稳定估计 | |
US9026263B2 (en) | Automotive navigation system and method to utilize internal geometry of sensor position with respect to rear wheel axis | |
CN101788296B (zh) | 一种sins/cns深组合导航***及其实现方法 | |
EP1582840B1 (en) | Inertial navigation system error correction | |
CN106342284B (zh) | 一种飞行载体姿态确定方法 | |
CN103235328B (zh) | 一种gnss与mems组合导航的方法 | |
CN104165641B (zh) | 一种基于捷联惯导/激光测速仪组合导航***的里程计标定方法 | |
CN102809377A (zh) | 飞行器惯性/气动模型组合导航方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导***以及控制方法 | |
CN106482734A (zh) | 一种用于imu多传感器数据融合的滤波方法 | |
CN103900576B (zh) | 一种深空探测自主导航的信息融合方法 | |
CN101846510A (zh) | 一种基于星敏感器和陀螺的高精度卫星姿态确定方法 | |
CN106767797A (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN107655493A (zh) | 一种光纤陀螺sins六位置***级标定方法 | |
CN102645223B (zh) | 一种基于比力观测的捷联惯导真空滤波修正方法 | |
CN102116634A (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
CN103925930B (zh) | 一种重力仪双轴陀螺稳定平台航向误差效应的补偿方法 | |
CN108088443A (zh) | 一种定位定向设备速度补偿方法 | |
CN103674034A (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN105157724B (zh) | 一种基于速度加姿态匹配的传递对准时间延迟估计与补偿方法 | |
CN105606093B (zh) | 基于重力实时补偿的惯性导航方法及装置 | |
CN105928515A (zh) | 一种无人机导航*** | |
CN105737842A (zh) | 基于旋转调制和虚拟里程仪的车载自主导航方法 | |
CN113340298A (zh) | 一种惯导和双天线gnss外参标定方法 |
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 |