CN104296752A - 航天器天文测角测速组合自主导航系统及其导航方法 - Google Patents
航天器天文测角测速组合自主导航系统及其导航方法 Download PDFInfo
- Publication number
- CN104296752A CN104296752A CN201410494372.4A CN201410494372A CN104296752A CN 104296752 A CN104296752 A CN 104296752A CN 201410494372 A CN201410494372 A CN 201410494372A CN 104296752 A CN104296752 A CN 104296752A
- Authority
- CN
- China
- Prior art keywords
- navigation
- spacecraft
- celestial body
- speed
- angle measurement
- 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
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)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供了一种航天器天文测角测速组合自主导航系统及其导航方法,该导航系统包括:天文测速导航子系统,与主滤波器相连,用于观测导航天体并获得其光谱频移测量值,解算输出航天器在惯性坐标系下的导航参数;天文测角导航子系统,与主滤波器相连,用于观测导航天体并获得导航天体方向单位矢量,解算输出航天器在惯性坐标系下的导航参数;主滤波器,与天文测速导航子系统及天文测角导航子系统相连,用于根据天文测速导航子系统及天文测角导航子系统的输出,以获得全局最优估计值。本发明以天体视线方向角度信息和天文光谱信息作为观测量,采用联邦滤波对导航信息进行融合,实现航天器飞行过程的自主导航,实现高精度导航参数估计。
Description
技术领域
本发明涉及一种导航系统及其导航方法,具体地,涉及一种航天器天文测角测速组合自主导航系统及其导航方法。
背景技术
目前,常用的导航方法有地面无线电导航、光学导航、惯性导航以及组合导航等,这些导航方法和技术的发展已经非常成熟,并广泛应用于航天任务中,但也都有各自的适用范围和局限性,尤其对深空探测,这些局限性使深空自主导航的实现更加困难。
天文测角导航通过观测参考天体视向角信息、参考天体和背景恒星之间的夹角等信息,利用几何解析的方法或结合轨道动力学滤波解算探测器位置。但该方法速度信息无法直接获得,需要进一步作位置差分或滤波估计,精度受限。
发明内容
针对现有技术中的缺陷,本发明的目的是提供一种航天器天文测角测速组合自主导航系统及其导航方法,其以天体视线方向角度信息和天文光谱信息作为观测量,采用联邦滤波对导航信息进行融合,实现航天器飞行过程的自主导航,实现高精度导航参数估计。
根据本发明的一个方面,提供一种航天器天文测角测速组合自主导航系统,其特征在于,其包括:
天文测速导航子系统,与主滤波器相连,用于观测导航天体并获得其光谱频移测量值,解算输出航天器在惯性坐标系下的导航参数;
天文测角导航子系统,与主滤波器相连,用于观测导航天体并获得导航天体方向单位矢量,解算输出航天器在惯性坐标系下的导航参数;
主滤波器,与天文测速导航子系统及天文测角导航子系统相连,用于根据天文测速导航子系统及天文测角导航子系统的输出,分配权因子,实现两个子最优估计值在主滤 波器中进行信息融合,以获得全局最优估计值。
优选地,所述天文测速导航子系统主要包括天文测速导航敏感器和天文测速导航子滤波器,天文测速导航敏感器用于观测导航天体并获得其光谱频移测量值,天文测速导航子滤波器用于根据光谱频移测量值,结合星历及航天器姿态解算航天器在惯性坐标系下的导航参数。
优选地,所述天文测角导航子系统主要包括天文测角导航敏感器和天文测角导航子滤波器,天文测角导航敏感器用于观测导航天体并获得其方向单位矢量,天文测角导航子滤波器用于根据方向单位矢量,结合星历及航天器姿态解算航天器在惯性坐标系下的导航参数。
本发明还提供一种航天器天文测角测速组合自主导航系统的导航方法,其特征在于,其包括以下步骤:
步骤一,建立天体惯性坐标系OXYZ;
步骤二,在天体惯性坐标系OXYZ下,在t时刻,采用测角导航敏感器可测得本体系下的导航天体方向单位矢量,建立参考天体方向矢量的测量方程和导航参数状态方程,解算获得航天器位置参数;将两次观测获得的航天器位置参数差分后可得速度参数;
步骤三,在天体惯性坐标系OXYZ下,在t时刻,航天器同时接收到第一导航天体的光信号、第二导航天体的光信号、第三导航天体的光信号,采用测速导航敏感器可测得其光谱频移测量值,结合航天器姿态信息,通过计算得出航天器在惯性坐标系下的导航参数;
步骤四,在步骤二和步骤三的基础上组成联邦滤波器,在满足信息守恒的前提下分配权因子,实现两个子最优估计值在主滤波器中进行信息融合,以获得全局最优估计值。
与现有技术相比,本发明具有如下的有益效果:本发明的天文测速导航利用多普勒频移计算出航天器与某个参考天体的相对速度。本发明不依赖地面无线电信息、仅需要光谱信息、太阳系天体星历信息和航天器姿态信息即可获得航天器在参考坐标系中的速度信息。本发明以天体视线方向角度信息和天文光谱信息作为观测量,采用联邦滤波对导航信息进行融合,实现航天器飞行过程的自主导航。该方法原理简单,方法新颖,具有无时延、高度自主的明显优势与特点,可直接应用于我国深空探测自主导航任务,在深空探测领域具有广阔的应用前景,并可为近地航天器自 主导航提供借鉴和参考。
附图说明
通过阅读参照以下附图对非限制性实施例所作的详细描述,本发明的其它特征、目的和优点将会变得更明显:
图1为本发明航天器天文测角测速组合自主导航系统的原理框图。
具体实施方式
下面结合具体实施例对本发明进行详细说明。以下实施例将有助于本领域的技术人员进一步理解本发明,但不以任何形式限制本发明。应当指出的是,对本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进。这些都属于本发明的保护范围。
如图1所示,本发明航天器天文测角测速组合自主导航系统包括:
天文测速导航子系统10,与主滤波器相连,用于观测导航天体并获得其光谱频移测量值,解算输出航天器在惯性坐标系下的导航参数。
天文测角导航子系统20,与主滤波器相连,用于观测导航天体并获得导航天体方向单位矢量,解算输出航天器在惯性坐标系下的导航参数;
主滤波器30,与天文测速导航子系统10及天文测角导航子系统20相连,用于根据天文测速导航子系统10及天文测角导航子系统20的输出,分配权因子,实现两个子最优估计值在主滤波器中进行信息融合,以获得全局最优估计值;
天文测速导航子系统10主要包括天文测速导航敏感器11和天文测速导航子滤波器12,天文测速导航敏感器11用于观测导航天体并获得其光谱频移测量值,天文测速导航子滤波器12用于根据光谱频移测量值,结合星历及航天器姿态解算航天器在惯性坐标系下的导航参数。
天文测角导航子系统20主要包括天文测角导航敏感器21和天文测角导航子滤波器22,天文测角导航敏感器21用于观测导航天体并获得其方向单位矢量,天文测角导航子滤波器22用于根据方向单位矢量,结合星历及航天器姿态解算航天器在惯性坐标系下的导航参数。
航天器天文测角测速组合自主导航系统的工作原理如下:航天器在飞行过程中依靠自身携带的天文测速导航敏感器及天文测角导航敏感器测量航天器相对参考 天体的视向角等角度信息及光谱频移信息,经过导航子滤波器后计算获得航天器的位置及速度参数,进而采用联邦滤波进行信息融合,实现高精度导航参数估计。
本发明航天器天文测角测速组合自主导航系统的导航方法包括以下步骤:
步骤一,建立天体惯性坐标系OXYZ;本发明可以直接利用太阳系天体做光源,可利用的光源包括太阳、木星、地球等,也可根据飞行轨道选择合适的其他太阳系天体做光源。坐标原点O可根据导航需求选取,如日心、地心等。
步骤二,在天体惯性坐标系OXYZ下,在t时刻,航天器S采用测角导航敏感器可测得本体系下的参考天体方向单位矢量,建立参考天体方向矢量的测量方程和导航参数状态方程,解算获得航天器位置参数;将两次观测获得的航天器位置参数差分后可得速度参数;即获得航天器在惯性坐标系下的位置速度信息;
步骤三,在天体惯性坐标系OXYZ下,在t时刻,航天器S同时接收到第一导航天体A的光信号、第二导航天体B的光信号、第三导航天体C的光信号,根据光谱频移测量值,结合航天器姿态信息,通过计算得出航天器S在惯性坐标系下的导航参数;比如,根据光谱频移特性测量获得航天器飞行速度,包括根据多源光谱频移特性测量获得航天器在惯性坐标系下的速度;
步骤四,在步骤二和步骤三的基础上组成联邦滤波器,在满足信息守恒的前提下分配权因子,实现两个子最优估计值在主滤波器中进行信息融合,以获得全局最优估计值。
下面举出一个具体的例子进行说明:
步骤S1,建立太阳系惯性坐标系OXYZ。
步骤S2,采用测角导航敏感器可测得本体系下的参考天体方向单位矢量的量测值为式(1):
其中Abi为从日心惯性系到航天器本体系的姿态转移矩阵,为测角导航敏感器测量误差,为导航敏感器测得的指向参考天体方向单位矢量在惯性系下的表示,是关于航天器在日心惯性系下位置参数的函数如式(2):
可获得参考天体方向矢量的测量方程如式(3):
其中为参考天体在日心惯性系下位置矢量,可通过星历获得。
联立两个导航天体测角信息的观测方程将获得方程组如式(4):
通过解算上式可获得航天器位置参数,将两次观测获得的航天器位置参数差分后可得速度参数。
步骤S3,航天器和参考天体之间相对运动的视向速度vrS可通过光谱仪的多普勒测量获得,其值vrS可表示为如式(5):
其中为航天器在惯性系下的速度,为由航天器指向参考天体方向的单位矢量在惯性系下表示,δrS为速度测量误差。
当航天器获得三个或三个以上参考天体(如太阳、木星、地球)的径向速率及参考天体位置的单位矢量,采用天文测速自主导航方法生成观测方程及状态方程,并求解其位置、速度信息。
步骤S4,将天文测角导航的观测方程及状态方程构成联邦导航子滤波器,将天文测速导航的观测方程及状态方程构成联邦导航子滤波器,在满足信息守恒的前提下分配权因子,实现两个子最优估计值在主滤波器中进行信息融合,以达到全局最优估计值。
以上对本发明的具体实施例进行了描述。需要理解的是,本发明并不局限于上述特定实施方式,本领域技术人员可以在权利要求的范围内做出各种变形或修改,这并不影响本发明的实质内容。
Claims (4)
1.一种航天器天文测角测速组合自主导航系统,其特征在于,其包括:
天文测速导航子系统,与主滤波器相连,用于观测导航天体并获得其光谱频移测量值,解算输出航天器在惯性坐标系下的导航参数;
天文测角导航子系统,与主滤波器相连,用于观测导航天体并获得导航天体方向单位矢量,解算输出航天器在惯性坐标系下的导航参数;
主滤波器,与天文测速导航子系统及天文测角导航子系统相连,用于根据天文测速导航子系统及天文测角导航子系统的输出,分配权因子,实现两个子最优估计值在主滤波器中进行信息融合,以获得全局最优估计值。
2.根据权利要求1所述的航天器天文测角测速组合自主导航系统,其特征在于,所述天文测速导航子系统主要包括天文测速导航敏感器和天文测速导航子滤波器,天文测速导航敏感器用于观测导航天体并获得其光谱频移测量值,天文测速导航子滤波器用于根据光谱频移测量值,结合星历及航天器姿态解算航天器在惯性坐标系下的导航参数。
3.根据权利要求1所述的航天器天文测角测速组合自主导航系统,其特征在于,所述天文测角导航子系统主要包括天文测角导航敏感器和天文测角导航子滤波器,天文测角导航敏感器用于观测导航天体并获得其方向单位矢量,天文测角导航子滤波器用于根据方向单位矢量,结合星历及航天器姿态解算航天器在惯性坐标系下的导航参数。
4.一种航天器天文测角测速组合自主导航系统的导航方法,其特征在于,其包括以下步骤:
步骤一,建立天体惯性坐标系OXYZ;
步骤二,在天体惯性坐标系OXYZ下,在t时刻,采用测角导航敏感器可测得本体系下的导航天体方向单位矢量,建立参考天体方向矢量的测量方程和导航参数状态方程,解算获得航天器位置参数;将两次观测获得的航天器位置参数差分后可得速度参数;
步骤三,在天体惯性坐标系OXYZ下,在t时刻,航天器同时接收到第一导航天体的光信号、第二导航天体的光信号、第三导航天体的光信号,采用测速导航敏感器可测得其光谱频移测量值,结合航天器姿态信息,通过计算得出航天器在惯性坐标系下的导航参数;
步骤四,在步骤二和步骤三的基础上组成联邦滤波器,在满足信息守恒的前提下分配权因子,实现两个子最优估计值在主滤波器中进行信息融合,以获得全局最优估计值。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410494372.4A CN104296752B (zh) | 2014-09-24 | 2014-09-24 | 航天器天文测角测速组合自主导航系统及其导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201410494372.4A CN104296752B (zh) | 2014-09-24 | 2014-09-24 | 航天器天文测角测速组合自主导航系统及其导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104296752A true CN104296752A (zh) | 2015-01-21 |
CN104296752B CN104296752B (zh) | 2017-05-03 |
Family
ID=52316588
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201410494372.4A Active CN104296752B (zh) | 2014-09-24 | 2014-09-24 | 航天器天文测角测速组合自主导航系统及其导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104296752B (zh) |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104865846A (zh) * | 2015-05-14 | 2015-08-26 | 电子科技大学 | 组合自主导航系统的地面半物理仿真平台 |
CN104913781A (zh) * | 2015-06-04 | 2015-09-16 | 南京航空航天大学 | 一种基于动态信息分配的非等间隔联邦滤波方法 |
CN105424047A (zh) * | 2015-10-30 | 2016-03-23 | 上海新跃仪表厂 | 基于路标信息的航天器姿态指向误差辨识方法 |
CN105424048A (zh) * | 2015-11-03 | 2016-03-23 | 北京空间飞行器总体设计部 | 一种基于周期变星的航天器自主导航方法 |
CN105651287A (zh) * | 2015-12-31 | 2016-06-08 | 武汉科技大学 | 一种太阳耀斑到达时间差分测量及组合导航方法、系统 |
CN106767842A (zh) * | 2016-11-30 | 2017-05-31 | 上海卫星工程研究所 | 以非对称空间外差式测速为目标的发射型目标源遴选方法 |
CN107883966A (zh) * | 2017-09-25 | 2018-04-06 | 上海卫星工程研究所 | 小行星反射光谱的深空导航方法 |
CN111536961A (zh) * | 2020-03-31 | 2020-08-14 | 上海卫星工程研究所 | 一种面向撞击探测任务的基于马尔可夫随机过程的信息融合方法 |
CN111854764A (zh) * | 2020-07-20 | 2020-10-30 | 中国科学院微小卫星创新研究院 | 基于星间测量信息的航天器姿态确定方法及系统 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004086079A1 (fr) * | 2003-03-20 | 2004-10-07 | Centre National D'etudes Spatiales | Procede et dispositif d’attribution de coefficients de ponderation pour des calculs d’attitude avec un capteur stellaire |
US20110077863A1 (en) * | 2009-09-30 | 2011-03-31 | Terrell Michael Brace | Method and system for spectral image celestial navigation |
CN103206955A (zh) * | 2013-03-06 | 2013-07-17 | 上海卫星工程研究所 | 航天器光谱红移自主导航方法 |
CN103674032A (zh) * | 2012-09-04 | 2014-03-26 | 西安电子科技大学 | 融合脉冲星辐射矢量和计时观测的卫星自主导航系统及方法 |
CN103868514A (zh) * | 2014-03-20 | 2014-06-18 | 北京航天自动控制研究所 | 一种在轨飞行器自主导航系统 |
-
2014
- 2014-09-24 CN CN201410494372.4A patent/CN104296752B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2004086079A1 (fr) * | 2003-03-20 | 2004-10-07 | Centre National D'etudes Spatiales | Procede et dispositif d’attribution de coefficients de ponderation pour des calculs d’attitude avec un capteur stellaire |
US20110077863A1 (en) * | 2009-09-30 | 2011-03-31 | Terrell Michael Brace | Method and system for spectral image celestial navigation |
CN103674032A (zh) * | 2012-09-04 | 2014-03-26 | 西安电子科技大学 | 融合脉冲星辐射矢量和计时观测的卫星自主导航系统及方法 |
CN103206955A (zh) * | 2013-03-06 | 2013-07-17 | 上海卫星工程研究所 | 航天器光谱红移自主导航方法 |
CN103868514A (zh) * | 2014-03-20 | 2014-06-18 | 北京航天自动控制研究所 | 一种在轨飞行器自主导航系统 |
Non-Patent Citations (5)
Title |
---|
JO RYEONG YIM,等: ""AUTONOMOUS ORBIT NAVIGATION OF INTERPLANETARY SPACECRAFT"", 《AMERICAN INSTITUTE OF AERONAUTICS AND ASTRONAUTICS PAPER 2000-3936》 * |
PS RAY,等: ""Spacecraft Navigation Using X-Ray Pulsars"", 《JOURNAL OF GUIDANCE CONTROL & DYNAMICS》 * |
刘劲,等: ""基于脉冲星和火星观测的深空探测器自主导航"", 《仪器仪表学报》 * |
崔平远,等: ""深空探测器自主技术发展现状与趋势"", 《航空学报》 * |
张伟,等: ""光谱红移自主导航新方法"", 《上海航天》 * |
Cited By (12)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104865846A (zh) * | 2015-05-14 | 2015-08-26 | 电子科技大学 | 组合自主导航系统的地面半物理仿真平台 |
CN104913781A (zh) * | 2015-06-04 | 2015-09-16 | 南京航空航天大学 | 一种基于动态信息分配的非等间隔联邦滤波方法 |
CN105424047A (zh) * | 2015-10-30 | 2016-03-23 | 上海新跃仪表厂 | 基于路标信息的航天器姿态指向误差辨识方法 |
CN105424047B (zh) * | 2015-10-30 | 2018-10-30 | 上海新跃仪表厂 | 基于路标信息的航天器姿态指向误差辨识方法 |
CN105424048A (zh) * | 2015-11-03 | 2016-03-23 | 北京空间飞行器总体设计部 | 一种基于周期变星的航天器自主导航方法 |
CN105424048B (zh) * | 2015-11-03 | 2018-12-21 | 北京空间飞行器总体设计部 | 一种基于周期变星的航天器自主导航方法 |
CN105651287A (zh) * | 2015-12-31 | 2016-06-08 | 武汉科技大学 | 一种太阳耀斑到达时间差分测量及组合导航方法、系统 |
CN105651287B (zh) * | 2015-12-31 | 2018-03-27 | 武汉科技大学 | 一种太阳耀斑到达时间差分测量及组合导航方法、系统 |
CN106767842A (zh) * | 2016-11-30 | 2017-05-31 | 上海卫星工程研究所 | 以非对称空间外差式测速为目标的发射型目标源遴选方法 |
CN107883966A (zh) * | 2017-09-25 | 2018-04-06 | 上海卫星工程研究所 | 小行星反射光谱的深空导航方法 |
CN111536961A (zh) * | 2020-03-31 | 2020-08-14 | 上海卫星工程研究所 | 一种面向撞击探测任务的基于马尔可夫随机过程的信息融合方法 |
CN111854764A (zh) * | 2020-07-20 | 2020-10-30 | 中国科学院微小卫星创新研究院 | 基于星间测量信息的航天器姿态确定方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN104296752B (zh) | 2017-05-03 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104296752A (zh) | 航天器天文测角测速组合自主导航系统及其导航方法 | |
CN103206955B (zh) | 航天器光谱红移自主导航方法 | |
CN107655476B (zh) | 基于多信息融合补偿的行人高精度足部导航方法 | |
CN111947652B (zh) | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 | |
CN102829785B (zh) | 基于序列图像和基准图匹配的飞行器全参数导航方法 | |
CN105203101B (zh) | 一种基于目标天体星历修正的深空探测器捕获段天文导航方法 | |
CN103697889B (zh) | 一种基于多模型分布式滤波的无人机自主导航与定位方法 | |
CN102175241B (zh) | 一种火星探测器巡航段自主天文导航方法 | |
CN104457705B (zh) | 基于天基自主光学观测的深空目标天体初定轨方法 | |
CN107024211B (zh) | 一种深空探测器测角/差分测速/差分测距组合导航方法 | |
CN105910602B (zh) | 一种组合导航方法 | |
CN104764449B (zh) | 一种基于星历修正的捕获段深空探测器自主天文导航方法 | |
CN108592945A (zh) | 一种惯性/天文组合系统误差的在线标定方法 | |
CN105928518A (zh) | 采用伪距和位置信息的室内行人uwb/ins紧组合导航系统及方法 | |
Mostafa et al. | A novel GPS/RAVO/MEMS-INS smartphone-sensor-integrated method to enhance USV navigation systems during GPS outages | |
CN103017772B (zh) | 一种基于可观性分析的光学和脉冲星融合自主导航方法 | |
CN103900611A (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN105371844A (zh) | 一种基于惯性/天文互助的惯性导航系统初始化方法 | |
CN107144278B (zh) | 一种基于多源特征的着陆器视觉导航方法 | |
CN113375659B (zh) | 一种基于星光角距测量信息的脉冲星导航方法 | |
CN103968844B (zh) | 基于低轨平台跟踪测量的大椭圆机动航天器自主导航方法 | |
CN103398725A (zh) | 一种基于星敏感器的捷联惯导系统初始对准的方法 | |
Burns et al. | Digital elevation models and derived products from LROC NAC stereo observations | |
Dorveaux | Magneto-inertial navigation: principles and application to an indoor pedometer | |
CN103278165A (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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |