CN105716615A - 火星探测器自主导航方法 - Google Patents
火星探测器自主导航方法 Download PDFInfo
- Publication number
- CN105716615A CN105716615A CN201511004962.5A CN201511004962A CN105716615A CN 105716615 A CN105716615 A CN 105716615A CN 201511004962 A CN201511004962 A CN 201511004962A CN 105716615 A CN105716615 A CN 105716615A
- Authority
- CN
- China
- Prior art keywords
- mars
- sun
- probes
- state
- navigation
- 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.)
- Pending
Links
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/02—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by astronomical means
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)
- Geophysics And Detection Of Objects (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明提供了一种火星探测器自主导航方法,根据探测器在太阳系中的位置关系,分别选择太阳、地球及太阳、火星作为观测目标,获取角度信息,并用扩展卡尔曼滤波对位置、速度等导航参数进行估计。本发明原理简单,***资源要求不高,是火星探测器自主天文导航新方法,拓展了航天器导航手段,提高了导航能力,可直接应用于我国未来火星探测自主导航任务,在深空探测领域具有广阔的应用前景。
Description
技术领域
本发明涉及火星探测巡航段天文导航技术领域,具体地,涉及火星探测器自主导航方法。
背景技术
火星探测器在行星际空间巡航飞行中,具有飞行距离远、飞行环境未知因素多、飞行程序复杂、器地通信时延与损耗大等特点,对自主导航能力提出了更高的要求。
目前,常用的自主导航方法主要是基于小行星或火星的光学导航。然而,对于火星探测任务,由于近地小行星数量有限且受到观测筛选准则的约束,可用的导航小行星数量不一定满足任务要求。另外,地面站观测获得的小行星星历信息误差较大,从而无法获得满足导航精度要求的导航方案。
发明内容
针对现有技术中的缺陷,本发明的目的是提供一种火星探测器自主导航方法。
根据本发明的一个方面,提供一种火星探测器自主导航方法,其特征是,包括如下步骤:
(1)以探测器在J2000日心黄道惯性坐标系下的空间位置与速度作为导航***的状态矢量X(t),矢量X(t)计算公式如下:
X(t)=[x,y,z,vx,vy,vz]T
(2)在日心惯性坐标系下,确定状态方程:
其中,w(t)表示状态模型噪声;
(3)通过导航敏感器及太阳敏感器获得太阳及火星相对探测器视线方向的单位矢量和
(4)取观测值为z为Rsp,建立观测方程有:
Z=h(X)+v(t)
其中观测误差
(5)基于状态方程和观测方程,选用基于滤波值线性化的滤波方式进行状态估计,获得火星探测器实时的导航参数。
优选地,在步骤(3)中,太阳及火星相对探测器视线方向的观测量模型为:
其中vps,vpm为视线矢量观测噪声。
优选地,在步骤(4)中,在日心惯性坐标系中,根据各天体视线矢量的几何关系,有:
γ=arccos(nRps·nRpm)
θ=arccos(nRsm·nRpm)
探测器在惯性系中的位置为:
与现有技术相比,本发明具有如下的有益效果:
不依赖地面无线电信息,仅需要获得太阳及火星的图像,结合航天器姿态信息即可实现航天器飞行过程的自主导航,是高度自主的导航新方法,简单易行,同时,与地面无线电导航方法相比,还具有无时延的明显优势与特点。
原理简单,方法新颖,拓展了航天器导航手段,提高了导航能力,可实现真正意义上的航天器自主导航,可直接应用于我国未来火星探测自主导航任务,并在深空探测领域具有广阔的应用前景。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明的方法原理图。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进。这些都属于本发明的保护范围。
本方法的基本原理是:航天器依靠自身携带的太阳敏感器和火星敏感器接收到太阳、火星的光学图像信号,根据图像处理算法,计算天体视线矢量参数,结合航天器姿态信息,天体星历信息,进行获得航天器的速度参数,进而通过积分获得航天器的位置参数。
如图1所示,是火星探测巡航段天文自主导航方法原理图,其步骤是:
(1)、建立太阳系惯性坐标系OXYZ,并选取空间位置与速度作为导航***的状态矢量。
(2)、依据卫星轨道动力学方程建立状态方程。
(3)、通过导航敏感器及太阳敏感器获得太阳及火星相对探测器视线方向的单位矢量和
(4)、根据步骤(3)获得的视线方向的单位矢量和建立观测方程。
(5)、在步骤(3)和步骤(4)的基础上,选用基于滤波值线性化的滤波方式进行状态估计,即可获得火星探测器实时的导航参数。
本方法的具体描述如下:
1、以探测器在J2000日心黄道惯性坐标系下的空间位置与速度作为导航***的状态矢量X(t),可描述为:
X(t)=[x,y,z,vx,vy,vz]T
2、依据卫星轨道动力学方程建立状态方程。在火星探测巡航段,主要考虑太阳、地球、火星等天体摄动,太阳光压摄动,探测器的修正推力等影响。在日心惯性坐标系下,其一般形式为:
由此,将探测器轨道动力学方程表述为如下一般形式
其中,w(t)表示状态模型噪声,一般作高斯白噪声处理。
3、通过导航敏感器及太阳敏感器获得太阳及火星相对探测器视线方向的单位矢量和其观测量模型为:
4、取观测值为z为Rsp,建立观测方程有:
忽略观测量中的高阶小量,由太阳和火星视线信息得到探测器位置矢量的观测方程可表示为:
Z=h(X)+v(t)
其中观测误差
5.对于状态方程和观测方程如上的导航***,选用基于滤波值线性化的滤波方式进行状态估计,即可获得火星探测器实时的导航参数。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变形或修改,这并不影响本发明的实质内容。
Claims (3)
1.一种火星探测器自主导航方法,其特征在于,包括如下步骤:
(1)以探测器在J2000日心黄道惯性坐标系下的空间位置与速度作为导航***的状态矢量X(t),矢量X(t)计算公式如下:
X(t)=[x,y,z,vx,vy,vz]T
(2)在日心惯性坐标系下,确定状态方程:
其中,w(t)表示状态模型噪声;
(3)通过导航敏感器及太阳敏感器获得太阳及火星相对探测器视线方向的单位矢量和
(4)取观测值为Z为Rsp,建立观测方程有:
Z=h(X)+v(t)
其中观测误差
(5)基于状态方程和观测方程,选用基于滤波值线性化的滤波方式进行状态估计,获得火星探测器实时的导航参数。
2.根据权利要求1所述的火星探测器自主导航方法,其特征在于,在步骤(3)中,太阳及火星相对探测器视线方向的观测量模型为:
其中vps,vpm为视线矢量观测噪声。
3.根据权利要求1所述的火星探测器自主导航方法,其特征在于,在步骤(4)中,在日心惯性坐标系中,根据各天体视线矢量的几何关系,有:
γ=arccos(nRps·nRpm)
θ=arccos(nRsm·nRpm)
探测器在惯性系中的位置为:
。
Priority Applications (3)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511004962.5A CN105716615A (zh) | 2015-12-28 | 2015-12-28 | 火星探测器自主导航方法 |
PCT/CN2016/082171 WO2017113567A1 (zh) | 2015-12-28 | 2016-05-16 | 火星探测器自主导航方法 |
EP16880375.7A EP3346234A4 (en) | 2015-12-28 | 2016-05-16 | Autonomous navigation method for mars probe |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201511004962.5A CN105716615A (zh) | 2015-12-28 | 2015-12-28 | 火星探测器自主导航方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN105716615A true CN105716615A (zh) | 2016-06-29 |
Family
ID=56147614
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201511004962.5A Pending CN105716615A (zh) | 2015-12-28 | 2015-12-28 | 火星探测器自主导航方法 |
Country Status (3)
Country | Link |
---|---|
EP (1) | EP3346234A4 (zh) |
CN (1) | CN105716615A (zh) |
WO (1) | WO2017113567A1 (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106773671A (zh) * | 2016-11-21 | 2017-05-31 | 上海卫星工程研究所 | 深空探测器分阶段mdo方法 |
CN106767840A (zh) * | 2016-11-18 | 2017-05-31 | 上海卫星工程研究所 | 火星探测接近段组合自主导航方法 |
CN108981703A (zh) * | 2018-07-09 | 2018-12-11 | 上海卫星工程研究所 | 火星着陆器联合位置估计方法 |
CN116707611A (zh) * | 2023-06-02 | 2023-09-05 | 北京航天飞行控制中心 | 一种火星探测多目标协同控制方法及装置 |
Families Citing this family (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109031349B (zh) * | 2018-04-20 | 2022-04-08 | 南京航空航天大学 | 一种geo卫星的智能自主运行*** |
CN111382514B (zh) * | 2020-03-12 | 2023-12-29 | 上海航天控制技术研究所 | 一种基于监督学习的火星探测飞行轨道精确计算方法及*** |
CN111538019B (zh) * | 2020-03-31 | 2023-07-14 | 上海卫星工程研究所 | 一种用于深空撞击探测的辅助激光指示信标与自主导航测量*** |
CN111536982B (zh) * | 2020-05-06 | 2023-09-19 | 北京工业大学 | 一种光照不良条件下小行星探测器光学导航图像生成方法 |
CN111572815B (zh) * | 2020-05-07 | 2023-08-11 | 上海宇航***工程研究所 | 一种基于可重复使用飞行器的全周期载人火星探测方法 |
CN111551172B (zh) * | 2020-05-13 | 2022-05-10 | 北京航空航天大学 | 一种月球探测器测角/时间差分距离/速度组合导航方法 |
CN112014869B (zh) * | 2020-08-12 | 2023-11-28 | 中国科学院微小卫星创新研究院 | 基于天文导航的星间链路自主导航方法及*** |
CN112068176A (zh) * | 2020-09-15 | 2020-12-11 | 北京航空航天大学 | 一种携带多微纳卫星组网的无人智能火星探测***及方法 |
CN112529797B (zh) * | 2020-12-04 | 2024-05-31 | 中国人民解放军63921部队 | 基于序列视轴指向矢量的目标轨迹确认方法 |
CN112525203A (zh) * | 2020-12-14 | 2021-03-19 | 北京航空航天大学 | 一种基于角度约束辅助测量的航天器自主天文导航方法 |
CN113091731A (zh) * | 2021-03-03 | 2021-07-09 | 北京控制工程研究所 | 一种基于恒星视线相对论效应的航天器自主导航方法 |
CN113984069B (zh) * | 2021-04-30 | 2023-06-06 | 北京临近空间飞行器***工程研究所 | 基于人造卫星的星光定位导航方法 |
CN114485678B (zh) * | 2021-12-31 | 2023-09-12 | 上海航天控制技术研究所 | 天地一体月面着陆导航方法 |
CN114485679B (zh) * | 2022-01-18 | 2024-05-07 | 北京理工大学 | 行星着陆稀疏特征虚拟衍生自主导航方法 |
CN115326061B (zh) * | 2022-10-17 | 2023-01-17 | 中国人民解放军国防科技大学 | 一种基于已编目空间目标序贯观测的自主导航方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101672651B (zh) * | 2009-09-25 | 2011-06-01 | 北京航空航天大学 | 一种基于改进mmupf滤波的火星探测器自主天文导航方法 |
CN102168980B (zh) * | 2011-01-13 | 2012-11-14 | 北京航空航天大学 | 一种基于小行星交会的深空探测器自主天文导航方法 |
CN102175241B (zh) * | 2011-01-13 | 2013-03-20 | 北京航空航天大学 | 一种火星探测器巡航段自主天文导航方法 |
US8532861B1 (en) * | 2012-06-02 | 2013-09-10 | Fukashi Andoh | Protective apparatus for electronic unit on unmanned space exploration vehicle |
CN104764449B (zh) * | 2015-04-23 | 2017-07-11 | 北京航空航天大学 | 一种基于星历修正的捕获段深空探测器自主天文导航方法 |
-
2015
- 2015-12-28 CN CN201511004962.5A patent/CN105716615A/zh active Pending
-
2016
- 2016-05-16 EP EP16880375.7A patent/EP3346234A4/en not_active Ceased
- 2016-05-16 WO PCT/CN2016/082171 patent/WO2017113567A1/zh active Application Filing
Non-Patent Citations (2)
Title |
---|
常晓华: "深空自主导航方法研究及在小天体探测中的应用", 《中国博士学位论文全文数据库 工程科技Ⅱ辑》 * |
朱圣英 等: "基于视线矢量的深空自主导航算法研究", 《空间科学学报》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN106767840A (zh) * | 2016-11-18 | 2017-05-31 | 上海卫星工程研究所 | 火星探测接近段组合自主导航方法 |
CN106773671A (zh) * | 2016-11-21 | 2017-05-31 | 上海卫星工程研究所 | 深空探测器分阶段mdo方法 |
CN106773671B (zh) * | 2016-11-21 | 2019-08-23 | 上海卫星工程研究所 | 深空探测器分阶段mdo方法 |
CN108981703A (zh) * | 2018-07-09 | 2018-12-11 | 上海卫星工程研究所 | 火星着陆器联合位置估计方法 |
CN116707611A (zh) * | 2023-06-02 | 2023-09-05 | 北京航天飞行控制中心 | 一种火星探测多目标协同控制方法及装置 |
CN116707611B (zh) * | 2023-06-02 | 2023-11-28 | 北京航天飞行控制中心 | 一种火星探测多目标协同控制方法及装置 |
Also Published As
Publication number | Publication date |
---|---|
EP3346234A4 (en) | 2018-07-18 |
WO2017113567A1 (zh) | 2017-07-06 |
EP3346234A1 (en) | 2018-07-11 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105716615A (zh) | 火星探测器自主导航方法 | |
CN106595674B (zh) | 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法 | |
Crassidis et al. | Survey of nonlinear attitude estimation methods | |
Trawny et al. | Vision‐aided inertial navigation for pin‐point landing using observations of mapped landmarks | |
Lefferts et al. | Kalman filtering for spacecraft attitude estimation | |
CN102607564B (zh) | 一种基于星光/地磁组合信息的小卫星自主导航***及其导航方法 | |
CN106643741B (zh) | 一种卫星相对小行星视觉自主导航方法 | |
CN107655485B (zh) | 一种巡航段自主导航位置偏差修正方法 | |
CN103148849B (zh) | 基于地月卫星联合测距和紫外敏感器的组合导航方法 | |
CN104457705B (zh) | 基于天基自主光学观测的深空目标天体初定轨方法 | |
CN102944241B (zh) | 基于多胞型线性微分包含的航天器相对姿态确定方法 | |
CN102305630A (zh) | 基于扩展卡尔曼滤波的sar卫星自主定轨方法 | |
CN109269510A (zh) | 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法 | |
CN106767768A (zh) | 一种双星编队的自主导航方法 | |
Rad et al. | Optimal attitude and position determination by integration of INS, star tracker, and horizon sensor | |
CN103206955A (zh) | 航天器光谱红移自主导航方法 | |
Wolf et al. | Toward improved landing precision on Mars | |
CN103335654A (zh) | 一种行星动力下降段的自主导航方法 | |
CN106679653A (zh) | 一种基于星敏感器和星间链路的heo卫星群相对测量方法 | |
Nguyen et al. | Lateral stability control of electric vehicle based on disturbance accommodating kalman filter using the integration of single antenna GPS receiver and yaw rate sensor | |
CN110779514B (zh) | 面向仿生偏振导航辅助定姿的分级卡尔曼融合方法及装置 | |
Ning et al. | A new autonomous celestial navigation method for the lunar rover | |
CN103487032A (zh) | 低轨空间相机自由指向像移矢量计算方法 | |
CN105387861A (zh) | 采用大动态暗弱目标成像敏感器的多天体观测自主导航*** | |
CN102607563A (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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20160629 |
|
RJ01 | Rejection of invention patent application after publication |