CN103591956B - 一种基于可观测性分析的深空探测器自主导航方法 - Google Patents
一种基于可观测性分析的深空探测器自主导航方法 Download PDFInfo
- Publication number
- CN103591956B CN103591956B CN201310612878.6A CN201310612878A CN103591956B CN 103591956 B CN103591956 B CN 103591956B CN 201310612878 A CN201310612878 A CN 201310612878A CN 103591956 B CN103591956 B CN 103591956B
- Authority
- CN
- China
- Prior art keywords
- nautical star
- observability
- navigation
- deep space
- nautical
- 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.)
- Expired - Fee Related
Links
- 238000000034 method Methods 0.000 title claims abstract description 23
- 239000000523 sample Substances 0.000 title claims abstract description 12
- 238000005259 measurement Methods 0.000 claims abstract description 40
- 230000003287 optical effect Effects 0.000 claims abstract description 17
- 239000013598 vector Substances 0.000 claims description 26
- 239000011159 matrix material Substances 0.000 claims description 9
- 230000007704 transition Effects 0.000 claims description 6
- 238000005183 dynamical system Methods 0.000 claims description 5
- 238000001914 filtration Methods 0.000 claims description 4
- 239000004576 sand Substances 0.000 claims description 3
- 238000005265 energy consumption Methods 0.000 abstract description 2
- 238000005457 optimization Methods 0.000 abstract description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
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
-
- 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/20—Instruments for performing navigational calculations
-
- 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)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Astronomy & Astrophysics (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于可观测性分析的深空探测器自主导航方法,属于深空探测技术领域。本方法将可观测性分析与基于光学测量的自主导航方案相结合,利用光学测量构建自主导航方案,通过可观测性分析,选取最优导航星,使得导航系统可观测性最强,以实现导航性能最优化。本发明采用光学测量手段提供导航信息,功耗低、精度高、自主性强;结合可观测性分析对导航星进行选择,使得导航系统可观测性最强,保证导航性能;利用非线性滤波器进行导航滤波解算,提高了导航滤波的精确性及收敛性。
Description
技术领域
本发明涉及一种基于可观测性分析的深空探测器自主导航方法,属于深空探测技术领域。
背景技术
深空探测目标天体距离远,轨道及姿态机动精度要求高,不确定性大。作为深空探测的关键技术,导航系统的稳定性、精确性及自主性直接影响到各项科学任务的成功实施。如何寻找有效的自主导航方法成为深空探测研究中亟待解决的问题。
已经成功实施的行星探测任务大多依赖于地面深空网所测量的径向距离及速度信息进行导航。为了提高地面导航的性能,在原有模型基础上加入了ΔDOR测量,可以有效提高导航精度。但是由于深空探测目标一般距离地球遥远,基于地面深空网的导航方案往往受到通信延时的影响,另外受到可见弧段的约束,难以满足导航自主性与实时性的要求。
光学导航是小天体探测重要的导航方法,利用对小天体和背景星的光学测量结合星历来确定探测器的位置和速度。光学导航成功地运用在“Galileo号”接近和飞越Ida和Gaspra小行星任务上。“深空1号”任务首次实现了光学导航技术的完全自主化。但是如何选择导航星以保证导航系统性能仍需要进一步研究。
发明内容
本发明的目的是为了提高深空探测巡航段自主导航的精度与实时性,提出了一种基于可观测性分析的深空探测自主导航方法。
本方法将可观测性分析与基于光学测量的自主导航方案相结合,利用光学测量构建自主导航方案,通过可观测性分析,选取最优导航星,使得导航系统可观测性最强,以实现导航性能最优化。
一种基于可观测性分析的深空探测自主导航方法,具体技术方案如下:
步骤1:建立深空探测巡航段状态模型。
在日心惯性坐标系下建立探测器状态模型。探测器的状态矢量为位置矢量rs=[rx,ry,rz]T和速度矢量vs=[vx,vy,vz]T。考虑太阳引力、行星引力以及其他摄动力,深空探测巡航段探测器的状态模型建立为:
其中N表示对探测器动力学模型具有影响的行星个数,μS和μMi分别为太阳和第i颗行星的引力常数,rMi为第i颗行星在日心惯性坐标系中的位置矢量,通过星历确定,a为其他未建模摄动力矢量。此外rMsi为探测器相对于第i颗行星的位置矢量,满足:
rMsi=rs-rMi,i=1,…,N(2)
将深空探测巡航段探测器的动力学模型描述为,其中x=[rs T,vs T]T。
步骤2:建立深空探测巡航段自主导航测量模型。
在可选导航星集合S中随机选取多组不同的导航星组合,备选导航星为太阳系行星或其他小行星。每组导航星数量相同,均为M,能重复选取,即对于同一颗导航星,能同时属于不同的导航星组合。对每组导航星组合分别建立自主导航测量模型。对任意一组导航星,其自主导航测量模型的具体建立方法为:
用光学导航相机对导航星进行光学测量,得到第j颗导航星在相机坐标系中的方向单位矢量ncj。同时通过相机安装角及探测器姿态角,确定探测器本体坐标系到相机坐标系的转移矩阵CCB以及日心惯性坐标系到探测器本体坐标系的转移矩阵CBI。得到ncj的光学测量方程
式中rnj为第j颗导航星在日心惯性坐标系中的位置矢量,通过星历确定。εj为第j颗导航星的测量误差矢量,为零均值高斯白噪声。进而深空探测巡航段的测量模型描述为
步骤3:分别计算多组导航星组合的可观测度。
考虑到星上计算能力的限制,选择基于线性化的可观测性分析方法。基于步骤1得到的非线性动力学系统及步骤2得到的多组测量模型y=h(r),分别计算多组导航星组合的可观测度。具体方法为:
在当前状态利用Taylor级数展开,并只保留线性项:
其中。利用线性化动力学系统构建可观测性矩阵为
定义导航星组合的可观测度为
步骤4:选取最优导航星。
通过步骤2得到的可观测度,选择最优导航星,确定导航采用的最终测量模型yfinal=hfinal(r),结合导航滤波计算对探测器状态进行估计。由于状态模型及测量模型均呈现非线性,故宜选用非线性滤波器,如无迹Kalman滤波器(UKF),集合Kalman滤波器(EnKF)等。具体方法如下:
导航滤波器对导航系统的k时刻状态一步预测值为。将此一步预测值代入每组导航星组合的可观测度,取可观测度最大值所对应的导航星组合为最优导航星,即满足
利用选择的M颗最优导航星,通过深空探测巡航段的测量模型,构建出最终测量模型yfinal=hfinal(r),将其输入非线性滤波器对探测器状态进行最优估计,最终输出探测器状态信息。
有益效果
(1)本方法采用光学测量手段提供导航信息,功耗低、精度高、自主性强。
(2)本方法结合可观测性分析对导航星进行选择,使得导航系统可观测性最强,保证导航性能。
(3)本方法利用非线性滤波器进行导航滤波解算,提高了导航滤波的精确性及收敛性。
附图说明
图1为本发明的深空探测器自主导航方法流程图;
图2为具体实施方式中火星探测器巡航段导航误差结果,其中(a)、(b)、(c)分别为x轴、y轴、z轴的位置误差,(d)、(e)、(f)分别为x轴、y轴、z轴的速度误差。
具体实施方式
本实例针对火星探测巡航段的自主导航方案,采用导航相机对导航星(行星及小行星)的光学测量提供导航信息,通过可观测性分析选取最优导航星,结合集合Kalman滤波器进行滤波解算,实现高精度实时自主导航。本实例的具体实施方法如下:
步骤1:火星探测巡航段状态模型建立
在日心惯性坐标系下建立探测器状态模型。探测器的状态矢量为位置矢量rs=[rx,ry,rz]T和速度矢量vs=[vx,vy,vz]T。考虑太阳引力、火星引力以及其他摄动力,火星探测巡航段探测器的状态模型建立为:
其中μS和μM分别为太阳和火星的引力常数,rM为第火星在日心惯性坐标系中的位置矢量,通过星历确定,a为其他未建模摄动力矢量。此外rMs为探测器相对于火星的位置矢量,满足:
rMs=rs-rM(10)
进而火星探测巡航段探测器的动力学模型可描述为,其中x=[rs T,vs T]T。
步骤2:建立火星探测巡航段自主导航测量模型。
将火星、火卫一、火卫二、小行星4769Castalia、18751Yualexandrov、3103Eger等10颗行星及小行星作为导航星集合S。从导航星集合S中随机选取组不同的导航星组合。每组导航星数量均为3颗,能重复选取,即对于同一颗导航星,能同时属于不同的导航星组合。对每组导航星组合分别建立自主导航测量模型。对任意一组导航星,其自主导航测量模型的具体建立方法为:
用光学导航相机对导航星进行光学测量,得到第j颗导航星在相机坐标系中的方向单位矢量ncj。同时通过相机安装角及探测器姿态角,确定探测器本体坐标系到相机坐标系的转移矩阵CCB以及日心惯性坐标系到探测器本体坐标系的转移矩阵CBI。得到ncj的光学测量方程
式中rnj为第j颗导航星在日心惯性坐标系中的位置矢量,通过星历确定。εj为第j颗导航星的测量误差矢量,为零均值高斯白噪声。进而深空探测巡航段的测量模型描述为
步骤3:分别计算多组导航星组合的可观测度。
考虑到星上计算能力的限制,选择基于线性化的可观测性分析方法。基于步骤1得到的非线性动力学系统及步骤2得到的多组测量模型y=h(r),分别计算多组导航星组合的可观测度。具体方法为:
在当前状态利用Taylor级数展开,并只保留线性项:
其中。利用线性化动力学系统构建可观测性矩阵为
定义导航星组合的可观测度为
步骤4:选取最优导航星。
通过步骤2得到的可观测度,选择最优导航星,确定导航采用的最终测量模型yfinal=hfinal(r),结合导航滤波计算对探测器状态进行估计。由于状态模型及测量模型均呈现非线性,故宜选用非线性滤波器,如无迹Kalman滤波器(UKF),集合Kalman滤波器(EnKF)等。具体方法如下:
导航滤波器对导航系统的k时刻状态一步预测值为。将此一步预测值代入每组导航星组合的可观测度,取可观测度最大值所对应的导航星组合为最优导航星,即满足
利用选择的3颗最优导航星,通过深空探测巡航段的测量模型,构建出最终测量模型yfinal=hfinal(r),将其输入非线性滤波器对探测器状态进行最优估计,最终输出探测器状态信息。
导航相机像平面测量误差标准差为0.1mm。初始三轴位置和速度误差标准差分别为10km和5m/s。基于可观测性分析的火星探测自主导航方案性能如图2所示。其中(a)、(b)、(c)分别为x轴、y轴、z轴的位置误差,(d)、(e)、(f)分别为x轴、y轴、z轴的速度误差。可以看出所涉及的自主导航方案相比基于地面深空网测控的导航方案导航精度更高、收敛速度更快。
Claims (3)
1.一种基于可观测性分析的深空探测器自主导航方法,其特征在于:包括如下步骤:
步骤1:在日心惯性坐标系下建立深空探测器巡航段动力学模型;探测器的状态矢量为位置矢量和速度矢量考虑太阳引力、行星引力以及其他摄动力,深空探测器巡航段的动力学模型建立为:
其中N表示对探测器动力学模型具有影响的行星个数,μS和μMi分别为太阳和第i颗行星的引力常数,rMi为第i颗行星在日心惯性坐标系中的位置矢量,a为其他未建模摄动力矢量;rMsi为探测器相对于第i颗行星的位置矢量,满足:
rMsi=rs-rMi,i=1,…,N(2)
将深空探测器巡航段动力学模型描述为其中f(x)为状态方程矢量,x=[rs T,vs T]T;
步骤2:建立自主导航测量模型;
在可选导航星集合S中随机选取多组不同的导航星组合;每组导航星数量相同,均为M;对每组导航星组合分别建立自主导航测量模型;对任意一组导航星,其自主导航测量模型的具体建立方法为:
用光学导航相机对导航星进行光学测量,得到第j颗导航星在相机坐标系中的方向单位矢量ncj;同时通过相机安装角及探测器姿态角,确定探测器本体坐标系到相机坐标系的转移矩阵CCB以及日心惯性坐标系到探测器本体坐标系的转移矩阵CBI;得到ncj的光学测量方程
式中rnj为第j颗导航星在日心惯性坐标系中的位置矢量;εj为第j颗导航星的测量误差矢量;进而自主导航测量模型描述为
其中h(rs)为测量方程矢量。
步骤3:分别计算多组导航星组合的可观测度;
基于步骤1得到的动力学模型及步骤2得到的多组自主导航测量模型y=h(r)+ε,分别计算多组导航星组合的可观测度;具体方法为:
在当前状态x利用Taylor级数展开,并只保留线性项:
其中利用线性化动力学系统构建可观测性矩阵为
定义导航星组合的可观测度为
步骤4:选取最优导航星;
通过步骤2得到的可观测度,选择最优导航星,确定导航采用的最终自主导航测量模型yfinal=hfinal(rs)+ε,结合导航滤波计算对探测器状态进行估计;具体方法如下:
导航滤波器对导航系统的k时刻状态一步预测值为将此一步预测值代入每组导航星组合的可观测度,取可观测度最大值所对应的导航星组合为最优导航星,即满足
利用选择的M颗最优导航星,通过深空探测巡航段的自主导航测量模型,构建出最终自主导航测量模型yfinal=hfinal(rs)+ε,将其输入非线性滤波器对探测器状态进行最优估计,最终输出探测器状态信息。
2.根据权利要求1所述的一种基于可观测性分析的深空探测器自主导航方法,其特征在于:对于同一颗导航星,能同时属于不同的导航星组合。
3.根据权利要求1所述的一种基于可观测性分析的深空探测器自主导航方法,其特征在于:可选导航星集合S中的导航星为太阳系行星或其他小行星。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310612878.6A CN103591956B (zh) | 2013-11-27 | 2013-11-27 | 一种基于可观测性分析的深空探测器自主导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310612878.6A CN103591956B (zh) | 2013-11-27 | 2013-11-27 | 一种基于可观测性分析的深空探测器自主导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103591956A CN103591956A (zh) | 2014-02-19 |
CN103591956B true CN103591956B (zh) | 2016-02-03 |
Family
ID=50082187
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310612878.6A Expired - Fee Related CN103591956B (zh) | 2013-11-27 | 2013-11-27 | 一种基于可观测性分析的深空探测器自主导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103591956B (zh) |
Families Citing this family (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103870714B (zh) * | 2014-04-03 | 2017-04-12 | 武汉科技大学 | 一种基于高阶可观阵的导航系统可观测分析方法 |
CN106092092B (zh) * | 2016-06-02 | 2018-08-21 | 武汉科技大学 | 面向脉冲星导航系统的分数阶可观测性分析方法 |
CN108574291A (zh) * | 2018-04-23 | 2018-09-25 | 河海大学 | 一种基于集合卡尔曼滤波发电机动态状态估计方法 |
CN109813301B (zh) * | 2019-01-29 | 2021-04-02 | 中国人民解放军国防科技大学 | 一种最佳导航星方位快速确定方法 |
CN110702122B (zh) * | 2019-10-22 | 2021-03-30 | 北京理工大学 | 地外天体着陆自主光学导航特征综合优化方法 |
CN111735459B (zh) * | 2020-07-15 | 2022-03-22 | 北京理工大学 | 小天体探测器间协同导航方法 |
CN112948741B (zh) * | 2021-02-04 | 2023-02-28 | 上海卫星工程研究所 | 一种深空探测器可见弧段计算方法及系统 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101762272A (zh) * | 2010-01-18 | 2010-06-30 | 哈尔滨工业大学 | 一种基于可观测度分析的深空自主导航方法 |
RU2454631C1 (ru) * | 2010-10-28 | 2012-06-27 | Государственное образовательное учреждение высшего профессионального образования Военно-космическая академия имени А.Ф. Можайского | Способ автономной навигации и ориентации космических аппаратов на основе виртуальных измерений зенитных расстояний звезд |
CN103076017A (zh) * | 2012-12-30 | 2013-05-01 | 北京理工大学 | 基于可观测度分析的火星进入段自主导航方案设计方法 |
-
2013
- 2013-11-27 CN CN201310612878.6A patent/CN103591956B/zh not_active Expired - Fee Related
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101762272A (zh) * | 2010-01-18 | 2010-06-30 | 哈尔滨工业大学 | 一种基于可观测度分析的深空自主导航方法 |
RU2454631C1 (ru) * | 2010-10-28 | 2012-06-27 | Государственное образовательное учреждение высшего профессионального образования Военно-космическая академия имени А.Ф. Можайского | Способ автономной навигации и ориентации космических аппаратов на основе виртуальных измерений зенитных расстояний звезд |
CN103076017A (zh) * | 2012-12-30 | 2013-05-01 | 北京理工大学 | 基于可观测度分析的火星进入段自主导航方案设计方法 |
Non-Patent Citations (2)
Title |
---|
深空探测巡航段自主光学导航方案研究;刘宇飞等;《系统仿真学报》;20080430;第20卷(第7期);第1781-1785页 * |
深空自主导航系统的可观性分析;黄翔宇等;《宇航学报》;20060531;第27卷(第3期);第332-337,358页 * |
Also Published As
Publication number | Publication date |
---|---|
CN103591956A (zh) | 2014-02-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103591956B (zh) | 一种基于可观测性分析的深空探测器自主导航方法 | |
CN104075715B (zh) | 一种结合地形和环境特征的水下导航定位方法 | |
CN103323005B (zh) | 一种sins/gps/偏振光组合导航系统多目标优化抗干扰滤波方法 | |
CN102116628B (zh) | 一种着陆或附着深空天体探测器的高精度导航方法 | |
CN104061932B (zh) | 一种利用引力矢量和梯度张量进行导航定位的方法 | |
CN103076017B (zh) | 基于可观测度分析的火星进入段自主导航方案设计方法 | |
CN103674034B (zh) | 多波束测速测距修正的鲁棒导航方法 | |
CN102175260B (zh) | 一种自主导航系统误差校正方法 | |
Manchester et al. | Stochastic space exploration with microscale spacecraft | |
CN101788296A (zh) | 一种sins/cns深组合导航系统及其实现方法 | |
CN103488830B (zh) | 一种基于Cycler轨道的地月往返的任务仿真系统 | |
CN101694389B (zh) | 无陀螺捷联惯导系统的初始姿态快速测量方法 | |
CN103206955A (zh) | 航天器光谱红移自主导航方法 | |
CN102519470A (zh) | 多级嵌入式组合导航系统及导航方法 | |
CN107144283A (zh) | 一种用于深空探测器的高可观度光学脉冲星混合导航方法 | |
CN104848862A (zh) | 一种环火探测器精密同步定位守时方法及系统 | |
CN103438890B (zh) | 基于tds与图像测量的行星动力下降段导航方法 | |
CN101762272A (zh) | 一种基于可观测度分析的深空自主导航方法 | |
CN102116634A (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
CN103076026A (zh) | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 | |
CN103344245A (zh) | 火星进入段imu和甚高频无线电组合导航的ud-skf方法 | |
CN102607563B (zh) | 利用背景天文信息对于航天器进行相对导航的系统 | |
CN105371853A (zh) | 基于tds与轨道器的火星动力下降段导航方法 | |
CN103274066B (zh) | 从Halo轨道出发探测深空目标的逃逸轨道设计方法 | |
CN104199024A (zh) | 甚短基线光学测量目标定位方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20160203 |