CN112525204B - 一种航天器惯性和太阳多普勒速度组合导航方法 - Google Patents
一种航天器惯性和太阳多普勒速度组合导航方法 Download PDFInfo
- Publication number
- CN112525204B CN112525204B CN202011467901.3A CN202011467901A CN112525204B CN 112525204 B CN112525204 B CN 112525204B CN 202011467901 A CN202011467901 A CN 202011467901A CN 112525204 B CN112525204 B CN 112525204B
- Authority
- CN
- China
- Prior art keywords
- spacecraft
- speed
- error
- solar
- doppler
- 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
- 238000000034 method Methods 0.000 title claims abstract description 39
- 238000005259 measurement Methods 0.000 claims abstract description 58
- 238000001914 filtration Methods 0.000 claims abstract description 9
- 239000013598 vector Substances 0.000 claims description 25
- 239000011159 matrix material Substances 0.000 claims description 11
- 230000003595 spectral effect Effects 0.000 claims description 10
- 230000008569 process Effects 0.000 claims description 8
- 230000009466 transformation Effects 0.000 claims description 7
- 238000012546 transfer Methods 0.000 claims description 6
- 230000001133 acceleration Effects 0.000 claims description 4
- 230000001568 sexual effect Effects 0.000 claims 1
- 230000007704 transition Effects 0.000 claims 1
- 238000000691 measurement method Methods 0.000 abstract 1
- 238000010586 diagram Methods 0.000 description 6
- 238000005070 sampling Methods 0.000 description 5
- 230000000295 complement effect Effects 0.000 description 3
- 230000010354 integration Effects 0.000 description 3
- 238000006243 chemical reaction Methods 0.000 description 2
- 230000007123 defense Effects 0.000 description 2
- 238000011160 research Methods 0.000 description 2
- 238000001228 spectrum Methods 0.000 description 2
- 230000001131 transforming effect Effects 0.000 description 2
- 230000000007 visual effect Effects 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 230000008859 change Effects 0.000 description 1
- 238000004891 communication Methods 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
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
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
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
本发明涉及一种航天器惯性和太阳多普勒速度组合导航方法,将惯性导航与多普勒测速方法相结合,首先根据惯性导航***的误差方程建立***状态模型,然后利用光谱仪获得的太阳多普勒速度作为量测量,并建立太阳多普勒速度量测模型,最后使用UKF滤波估计航天器的位置、速度和姿态。本发明属于航天器自主导航领域,可为航天器提供高精度的位置、速度及姿态信息,对航天器导航具有重要的实际意义。
Description
技术领域
本发明属于航天器自主导航领域,涉及一种航天器惯性和太阳多普勒速度组合导航方法。
背景技术
航天器的发展在国防、信息通讯与科技创新中占有重要地位,而导航***作为航天器上的重要设备,为航天器的操作或控制***提供有关运动参数,从而引导航天器按所需速度和轨迹从起始点运动到目的地,对航天器的飞行任务有着不可忽视的作用。
惯性导航根据惯性测量单元(Inertial Measurement Unit,IMU)中陀螺仪和加速度计的输出,利用积分的方法确定航天器的位置、速度和姿态,具有独立性强、输出频率高、隐蔽性好、较为成熟等特点。由于具有优良性能,被广泛的应用在各类航天器中,但由于惯性测量单元中的陀螺和加速度计不可避免的存在误差,并随时间累积,严重影响导航精度,因此常与其他导航***组合起来用以改善导航性能。天文导航误差不随时间积累,和惯导具有互补性,因此常选用天文导航加以辅助,惯性/天文组合导航成为自主导航中的有效手段。传统的惯性/天文组合导航是利用天文导航中星敏感器提供的姿态信息来修正惯导的姿态误差和陀螺漂移,从而得到高精度姿态,并不能直观修正惯性导航速度与位置误差。而不管在什么领域,速度信息都至关重要,会对导航精度产生巨大影响,因此迫切需要寻找一种合适的天文导航方法来校正惯导的速度信息。研究发现,在航海领域的自主水下航行器导航***中,常常使用多普勒计程仪器来修正惯性导航的速度,能够显著提升航行器的速度精度,据此提出在航天器导航中使用太阳多普勒速度信息辅助惯导,以此来修正速度,提高航天器速度与位置精度。
在深空探测任务中,研究一种全自主、高精度的导航方法具有十分重要的意义。本发明提出的一种航天器惯性和太阳多普勒速度组合导航方法,在传统惯性导航的基础上,辅助太阳多普勒速度导航,能够实现两种导航方法的优势互补,既保留惯导自主性强、输出信息全面的特点,也能够直接提高速度精度,间接修正位置,大幅度提高导航***的准确性与可靠性。考虑到它们在工作原理与信息来源上的互补特性,对于长时间、长距离的航天器自主导航任务,利用太阳多普勒速度信息辅助惯性导航实现航天器自主导航是一种可行且值得深入研究的方法。
发明内容
本发明要解决的技术问题是:传统的惯性/天文组合导航方法,大多利用星敏感器输出的姿态信息来修正惯导的姿态,无法直观修正惯导的速度与位置误差,而速度信息至关重要,会对导航精度产生巨大影响。为解决航天器导航中传统惯性/天文组合导航方法无法直观修正惯导速度的问题,为航天器提供一种将惯性导航与太阳多普勒速度导航结合起来的自主导航方法,利用太阳多普勒速度导航辅助惯导获得高精度速度信息。
本发明解决其技术问题所采用的技术方案为:一种航天器惯性和太阳多普勒速度组合导航方法,实现为:
第一步,根据惯性导航***的误差方程建立***状态模型;
第二步,利用光谱仪获得太阳多普勒速度,并建立太阳多普勒速度量测模型;
第三步,基于第一步中的状态模型和第二步中的量测模型,采用UKF滤波估计航天器的位置、速度和姿态。
具体包括以下步骤:
1、建立基于惯性导航误差方程的***状态模型
惯性导航通过惯性测量单元IMU测量航天器相对惯性空间的角速率和加速度信息,利用牛顿运动定律自动推算航天器的瞬时速度和位置信息。在捷联惯性导航***下,IMU通常由三个正交加速度计和三个正交陀螺仪组成,整个组件直接安装在航天器本体上。根据惯性导航原理,***的状态模型为:
其中,φ=[φE φN φU]T是姿态误差角,φE、φN、φU分别表示n系内东、北、天向的姿态误差;是航天器速度,vE、vN、vU分别表示n系内东、北、天向的速度,/>是航天器速度误差,δvE、δvN、δvU分别表示n系内东、北、天向的速度误差;rn=[L λ h]T是航天器位置,L、λ、h分别表示n系下纬度、经度及高度,δrn=[δL δλδh]T是航天器位置误差,δL、δλ、δh分别表示n系下纬度误差、经度误差及高度误差;fn是加速度计的输出在n系中的投影;/>表示航天器在n系下的地球自转角速率,/>是航天器在n系下wie的误差;是n系相对e系的旋转角速率在n系中的表示,其中Rx和Ry分别为卯酉圈和子午圈的主曲率半径,是n系下wen的误差;/>表示n系相对i系的转动角速度在n系中的表示,/>是n系下ωin的误差;ε=(εx εy εz)T是惯性导航***x、y、z三个方向的陀螺仪常值漂移;/>是惯性导航***x、y、z三个方向加速度计的常值偏置;/> 所述n系为地理坐标系,e系是地球坐标系,i系为地心惯性坐标系,b系为航天器本体坐标系;
上式状态模型写为:
Xk=F(Xk-1,k-1)+Wk-1 (2)
其中,状态量为分别为航天器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,Xk,Xk-1分别为k时刻和k-1下的状态量,F(Xk-1,k-1)为航天器惯性/太阳多普勒速度组合导航***非线性转移函数,Wk-1为过程噪声。
2、建立太阳多普勒速度量测模型
利用光谱仪获得光谱频移,并根据频移获得航天器相对太阳的径向速度vr,表示为:
vr=c((frs-fes)/fes) (3)
其中,c为光速,frs为航天器所接受到的太阳发出的光谱频率,fes为太阳发出的光谱频率。
以航天器相对于太阳的多普勒径向速度此作为量测量,利用与航天器位置间的数学联系建立太阳多普勒速度量测模型:
其中,vr表示航天器相对太阳的径向速度量测量,rps,vps分别表示航天器相对太阳的位置与速度矢量,rps=||rps||表示位置矢量的大小,vm表示量测噪声。
利用坐标变换将航天器相对太阳的位置矢量与INS中的状态量建立联系。
如图3所示,在地心惯性坐标系O-xyz中,rps、vps分别为地心惯性系下航天器相对于太阳的位置、速度矢量,rpe、vpe分别为航天器相对于地球的位置、速度矢量,则有:
其中,rn、vn为n系内航天器相对于地球的位置、速度矢量,δrn、δvn为位置和速度误差,由INS获得;rse与vse分别为太阳相对地球的位置和速度矢量,可以由STK工具获得;/>是从n系到i系的转换矩阵。由此,将量测模型中的状态量与状态模型联系起来。则太阳多普勒速度量测模型表示为:
离散化后太阳多普勒速度量测模型表示为:
Zk=H(Xk,k)+Vk (7)
其中,H(·)表示太阳多普勒速度的非线性连续量测函数,Vk表示k时刻太阳多普勒速度的量测误差。
3、进行UKF滤波获得航天器的位置、速度及姿态估计
离散后航天器惯性和太阳多普勒速度组合导航***的状态模型与量测模型为:
其中,F(Xk-1,k-1)为组合导航***非线性转移函数,H(Xk,k)为非线性量测函数,Wk-1及Vk分别表示过程与量测噪声。对***模型式(8)通过UKF进行滤波,获得航天器的后验状态估计分别为航天器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,以及后验误差协方差/>将/>及/>输出,同时将k时刻状态量与误差协方差的估计值返回UKF滤波器,用于获得k+1时刻的输出。
本发明的原理是:在惯性导航的基础上,使用天文导航中的多普勒速度信息加以辅助。根据惯性导航***的误差方程建立航天器的状态模型,利用光谱仪实时观测太阳光谱的多普勒速度频移量,直接获取航天器相对太阳的速度,对速度积分间接获取位置信息,并以太阳多普勒速度为量测量,根据多普勒径向速度与航天器位置之间的关系,建立量测模型,将多普勒速度导航与惯性导航组合起来直接修正航天器速度,间接修正位置,最后通过UKF实现对航天器位置、速度等导航参数的估计。
本发明与现有技术相比的优点在于:
(1)现有航天器自主导航技术中,为满足高精度要求与复杂任务,常常采用两种或两种以上导航手段的组合导航***应用于现代军事导航。其中惯性导航以其自主性强、短时间内精度高、输出信息全面连续等特点,成为组合导航中的主要方式,常与其他导航组合起来改善导航精度。常用的导航方式有天文导航、视觉导航、卫星导航等,但考虑到航天器在军事国防方面的应用,视觉导航不适用于远距离导航,GPS导航受制于美国,战时可用性不高,天文导航精度高,且误差不随时间积累,因此常使用天文导航辅助惯性导航完成航天器导航任务。
(2)传统的惯性/天文组合导航,无论深组合、浅组合,都是利用天文导航***提供的高精度姿态信息对惯导***进行校正,并对惯性器件的误差进行补偿,主要用于姿态的修正,不能直接、较好的修正速度与位置信息。本发明提出在惯性导航的基础上,使用太阳多普勒速度信息加以辅助,这种组合导航方法能够实现两种导航方法的优势互补,不仅保留了惯导自主性强、输出信息全面的特点,也能够用太阳多普勒速度导航直接提高速度精度,间接修正位置,大幅度提高导航***的准确性与可靠性。
附图说明
图1为本发明中航天器惯性和太阳多普勒速度组合导航方法流程图;
图2为本发明中航天器惯性和太阳多普勒速度组合导航方法原理图;
图3为本发明中地心惯性坐标系下航天器与太阳的位置关系示意图;
图4为本发明中组合导航坐标系示意图。
具体实施方式
下面结合附图及实例对本发明进行详细说明。
如图1所示,本发明的航天器惯性和太阳多普勒速度组合导航方法具体实施过程如下:
1、建立基于惯性导航误差方程的***状态模型
惯性导航通过惯性测量单元IMU测量航天器相对惯性空间的角速率和加速度信息,利用牛顿运动定律自动推算航天器的瞬时速度和位置信息。在捷联惯性导航***下,IMU通常由三个正交加速度计和三个正交陀螺仪组成,整个组件直接安装在航天器本体上。根据惯性导航原理,***状态模型为:
其中,φ=[φE φN φU]T是姿态误差角,φE、φN、φU分别表示n系内东、北、天向的姿态误差;是航天器速度,vE、vN、vU分别表示n系内东、北、天向的速度,是航天器速度误差,δvE、δvN、δvU分别表示n系内东、北、天向的速度误差;rn=[L λ h]T是航天器位置,L、λ、h分别表示n系下纬度、经度及高度,δrn=[δL δλ δh]T是航天器位置误差,δL、δλ、δh分别表示n系下纬度误差、经度误差及高度误差;fn是加速度计的输出在n系中的投影;/>表示航天器在n系下的地球自转角速率,/>是航天器在n系下wie的误差;是n系相对e系的旋转角速率在n系中的表示,其中Rx和Ry分别为卯酉圈和子午圈的主曲率半径,是n系下wen的误差;/>表示n系相对i系的转动角速度在n系中的表示,/>是n系下ωin的误差;ε=(εx εy εz)T是惯性导航***x、y、z三个方向的陀螺仪常值漂移;/>是惯性导航***x、y、z三个方向加速度计的常值偏置;/> 所述n系为地理坐标系,e系是地球坐标系,i系为地心惯性坐标系,b系为航天器本体坐标系;
上式***状态模型写为:
Xk=F(Xk-1,k-1)+Wk-1 (2)
其中,状态量为分别为航天器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,Xk,Xk-1分别为k时刻和k-1下的状态量,F(Xk-1,k-1)为航天器惯性/太阳多普勒速度组合导航***非线性转移函数,Wk-1为过程噪声。
2、建立太阳多普勒速度量测模型
利用光谱仪获得光谱频移,并根据频移获得航天器相对太阳的径向速度vr,表示为
vr=c((frs-fes)/fes) (3)
其中,c为光速,frs为航天器所接受到的太阳发出的光谱频率,fes为太阳发出的光谱频率。
以航天器相对于太阳的多普勒径向速度此作为量测量,利用与航天器位置间的数学联系建立太阳多普勒速度量测模型:
其中,vr表示航天器相对太阳的径向速度量测量,rps,vps分别表示航天器相对太阳的位置与速度矢量,rps=||rps||表示位置矢量的大小,vm表示量测噪声。
利用坐标变换将航天器相对太阳的位置矢量与INS中的状态量建立联系。
如图3所示,在地心惯性坐标系O-xyz中,rps、vps分别为地心惯性系下航天器相对于太阳的位置、速度矢量,rpe、vpe分别为航天器相对于地球的位置、速度矢量,则有:
其中,rn、vn为n系内航天器相对于地球的位置、速度矢量,δrn、δvn为位置和速度误差,由INS获得;rse与vse分别为太阳相对地球的位置和速度矢量,可以由STK工具获得;/>是从n系到i系的转换矩阵。由此,将量测模型中的状态量与状态模型联系起来。则太阳多普勒速度量测模型表示为:
离散化后太阳多普勒速度量测模型表示为:
Zk=H(Xk,k)+Vk (7)
其中,H(·)表示太阳多普勒速度的非线性连续量测函数,Vk表示k时刻太阳多普勒速度的量测误差。
3、进行UKF滤波获得航天器的位置、速度及姿态估计
离散后航天器惯性/太阳多普勒速度组合导航***的状态模型与量测模型为:
其中,F(Xk-1,k-1)为组合导航***非线性转移函数,H(Xk,k)为非线性量测函数,Wk-1及Vk分别表示过程与量测噪声。对***模型式通过UKF进行滤波,获得航天器的后验状态估计分别为航天器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,以及后验误差协方差/>将/>及/>输出。
具体步骤如下:
B.选取sigma采样点
C.传递sigma采样点并获得先验估计及先验误差协方差
式中,Qk为k时刻状态模型噪声协方差阵。
D.量测更新
计算预测量测协方差Pyy,k及互协方差Pxy,k:
其中Rk为k时刻***的量测噪声协方差阵。计算滤波增益Kk为:
图2给出了航天器惯性和太阳多普勒速度组合导航方法原理图,介绍了各个导航***的基本原理。
①惯性导航***
惯导***主要由惯性测量单元(IMU)和相应的惯导机械化组成,以牛顿力学定律为基础。捷联惯导中,IMU通常由三个正交加速度计和三个正交陀螺仪组成,整个组件直接安装在航天器本体上。陀螺仪和加速度计分别获得航天器相对惯性坐标系的角速度、加计非引力加速度,将测量数据转换到n系,就能够确定航天器在导航坐标系中的位置、速度与姿态信息。
②多普勒速度导航***
多普勒频移,指的是光源和移动物体之间的相对运动引起光谱线基于其波长发生相位和频率的变化。当导航天体为太阳时,通过观测航天器与太阳的相对运动引起的多普勒频移测量,可以获得航天器相对于太阳的径向速度,以此作为多普勒速度量测量,积分可获得航天器的位置。
基于惯性导航***的误差方程建立组合导航***状态模型,利用光谱仪实时观测太阳光谱的多普勒速度频移量,直接获取航天器相对太阳的速度,对速度积分间接获取位置信息,并以太阳多普勒速度为量测量,根据多普勒径向速度与航天器位置之间的关系,建立量测模型,将多普勒速度导航与惯性导航组合起来直接修正航天器速度,间接修正位置,最后通过UKF实现对航天器位置、速度等导航参数的估计。
图3给出了地心惯性坐标系下航天器与太阳的位置关系示意图。在地心惯性坐标系下,rps、vps分别为航天器相对于太阳的位置、速度矢量,rpe、vpe分别为航天器相对于地球的位置、速度矢量,rse与vse分别为太阳相对地球的位置、速度矢量。根据向量几何关系,可以将rps表示为rpe、rse之差,vps表示为vpe、vse之差,从而建立地心系下的航天器多普勒径向速度与航天器速度与位置之间的联系。
图4给出了组合导航坐标系示意图,由于有些测量值是用不同的坐标系表示的,需要进行一些计算和变换,在此介绍了针对航天器惯性和太阳多普勒速度组合导航中涉及的常用坐标系,包括地心惯性坐标系(i系),地球坐标系(e系),地理坐标系(n系),航天器本体坐标系(b系)。
①惯性坐标系(i系,Oixiyizi)
惯性坐标系的原点位于地球质心Oi,xi轴在赤道平面内并指向春分点方向,zi轴垂直于赤道平面,且与地球自转轴方向一致,yi轴与xi轴和zi轴均垂直,并构成右手直角坐标系。
②地球坐标系(e系,Oixeyeze)
地球坐标系的原点位于地球质心Oi,ze轴垂直于赤道平面,且与地球自转方向一致,xe轴在赤道平面内并指向本初子午线,ye轴垂直于xe轴和ze轴,并构成右手直角坐标系。坐标系与地球固连,与地球一起旋转。
其中,ωie为地球绕其旋转轴的自转角速率,t是时间参数。
③地理坐标系(n系,O xnynzn)
地理坐标系为当地东北天坐标系,在此也作为导航坐标系,其原点位于航天器质心O,O xn轴指向当地水平东向,O yn轴指向当地水平北向,O zn轴沿垂线方向指向天顶。
④航天器本体坐标系(b系,O xbybzb)
航天器本体坐标系就是固定在航天器上面的坐标系,其原点位于航天器质心O,纵轴O yb为本体纵向指向前,横轴O xb指向其右,Ozb垂直于O xbyb构成右手坐标系。
⑤IMU坐标系
IMU坐标系是固定在IMU上的坐标系,它是专门为惯导***设置的坐标系,三轴指向为IMU敏感轴的方向,与本体坐标系一致。
本发明说明书中未作详细描述的内容属于本领域专业技术人员公知的现有技术。
Claims (2)
1.一种航天器惯性和太阳多普勒速度组合导航方法,其特征在于,包括以下步骤:
第一步,根据惯性导航***的误差方程建立***状态模型;
第二步,利用光谱仪获得太阳多普勒速度,并建立太阳多普勒速度量测模型;
第三步,基于第一步的***状态模型和第二步的量测模型,采用UKF滤波估计航天器的位置、速度和姿态,从而完成航天器惯性和太阳多普勒速度组合导航;
所述第一步,根据惯性导航***的误差方程建立***状态模型,包括以下步骤:惯性导航通过惯性测量单元IMU测量航天器相对惯性空间的角速率和加速度信息,利用牛顿运动定律自动推算航天器的瞬时速度和位置信息,在捷联惯性导航***下,IMU由三个正交加速度计和三个正交陀螺仪组成,直接安装在航天器本体上,根据惯性导航原理,***状态模型为:
其中,φ=[φE φN φU]T是姿态误差角,φE、φN、φU分别表示n系内东、北、天向的姿态误差;是航天器速度,vE、vN、vU分别表示n系内东、北、天向的速度,是航天器速度误差,δvE、δvN、δvU分别表示n系内东、北、天向的速度误差;rn=[L λ h]T是航天器位置,L、λ、h分别表示n系下纬度、经度及高度,δrn=[δL δλ δh]T是航天器位置误差,δL、δλ、δh分别表示n系下纬度误差、经度误差及高度误差;fn是加速度计的输出在n系中的投影;/>表示航天器在n系下的地球自转角速率,/>是航天器在n系下wie的误差;是n系相对e系的旋转角速率在n系中的表示,其中Rx和Ry分别为卯酉圈和子午圈的主曲率半径,是n系下wen的误差;/>表示n系相对i系的转动角速度在n系中的表示,/>是n系下ωin的误差;ε=(εx εy εz)T是惯性导航***x、y、z三个方向的陀螺仪常值漂移;/>是惯性导航***x、y、z三个方向加速度计的常值偏置;/> 所述n系为地理坐标系,e系是地球坐标系,i系为地心惯性坐标系,b系为航天器本体坐标系;
上式***状态模型写为:
Xk=F(Xk-1,k-1)+Wk-1 (2)
其中,状态量为分别为航天器的姿态误差角,速度、位置误差,陀螺仪的常值漂移与加速度计的常值偏置,Xk,Xk-1分别为k时刻和k-1下的状态量,F(Xk-1,k-1)为航天器惯性和太阳多普勒速度组合导航***非线性转移函数,Wk-1为过程噪声;
所述第二步,建立太阳多普勒速度量测模型步骤为:
利用光谱仪获得光谱频移,并根据频移获得航天器相对太阳的径向速度vr,表示为:
vr=c((frs-fes)/fes) (3)
其中,c为光速,frs为航天器所接受到的太阳发出的光谱频率,fes为太阳发出的光谱频率;
以航天器相对于太阳的多普勒径向速度作为量测量,利用与航天器位置间的数学联系建立太阳多普勒速度量测模型:
其中,vr表示航天器相对太阳的径向速度量测量,rps,vps分别为地心惯性系下航天器相对于太阳的位置、速度矢量,rps=||rps||表示位置矢量的大小,vm表示量测噪声;
利用坐标变换将航天器相对太阳的位置矢量与INS中的状态量建立联系;
在地心惯性坐标系O-xyz中,rps、vps分别为地心惯性系下航天器相对于太阳的位置、速度矢量,rpe、vpe分别为航天器相对于地球的位置、速度矢量,则有
其中,rn、vn为n系内航天器相对于地球的位置、速度矢量,δrn、δvn为位置和速度误差,由INS获得;rse与vse分别为太阳相对地球的位置和速度矢量,由STK工具获得;/>是从n系到i系的转换矩阵,由此,将量测模型中的状态量与状态模型联系起来,则太阳多普勒速度量测模型表示为:
离散化后太阳多普勒速度量测模型表示为:
Zk=H(Xk,k)+Vk (7)
其中,H(g)表示太阳多普勒速度的非线性连续量测函数,Vk表示k时刻太阳多普勒速度的量测误差。
2.根据权利要求1所述的一种航天器惯性和太阳多普勒速度组合导航方法,其特征在于:所述第三步中,进行UKF滤波获得航天器的位置、速度及姿态估计如下:
离散后航天器惯性和太阳多普勒速度组合导航***的状态模型与量测模型为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011467901.3A CN112525204B (zh) | 2020-12-14 | 2020-12-14 | 一种航天器惯性和太阳多普勒速度组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011467901.3A CN112525204B (zh) | 2020-12-14 | 2020-12-14 | 一种航天器惯性和太阳多普勒速度组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112525204A CN112525204A (zh) | 2021-03-19 |
CN112525204B true CN112525204B (zh) | 2023-06-16 |
Family
ID=74999579
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011467901.3A Active CN112525204B (zh) | 2020-12-14 | 2020-12-14 | 一种航天器惯性和太阳多普勒速度组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112525204B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113295170A (zh) * | 2021-04-25 | 2021-08-24 | 西北工业大学 | 捷联惯导/光谱红移自主组合导航***及滤波方法 |
CN113551667B (zh) * | 2021-07-21 | 2024-05-24 | 北京航空航天大学 | 航天器惯性/恒星星光矢量/太阳多普勒速度组合导航方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103954279A (zh) * | 2014-05-19 | 2014-07-30 | 武汉科技大学 | 多普勒差分测速模型及与x射线脉冲星组合导航的方法 |
CN107024212A (zh) * | 2017-06-22 | 2017-08-08 | 北京航空航天大学 | 一种深空探测器x射线脉冲星/时间差分天文多普勒组合导航方法 |
CN109870155A (zh) * | 2019-02-28 | 2019-06-11 | 武汉科技大学 | 太阳直射光/行星反射光到达时间差分估测方法 |
CN111623785A (zh) * | 2020-07-17 | 2020-09-04 | 中南大学 | 基于星间时间延迟量测的深空探测器自主导航方法 |
CN111947652A (zh) * | 2020-08-13 | 2020-11-17 | 北京航空航天大学 | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US11287522B2 (en) * | 2018-10-16 | 2022-03-29 | The Aerospace Corporation | Single space optical platform for determining the range and/or velocity of space objects |
-
2020
- 2020-12-14 CN CN202011467901.3A patent/CN112525204B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103954279A (zh) * | 2014-05-19 | 2014-07-30 | 武汉科技大学 | 多普勒差分测速模型及与x射线脉冲星组合导航的方法 |
CN107024212A (zh) * | 2017-06-22 | 2017-08-08 | 北京航空航天大学 | 一种深空探测器x射线脉冲星/时间差分天文多普勒组合导航方法 |
CN109870155A (zh) * | 2019-02-28 | 2019-06-11 | 武汉科技大学 | 太阳直射光/行星反射光到达时间差分估测方法 |
CN111623785A (zh) * | 2020-07-17 | 2020-09-04 | 中南大学 | 基于星间时间延迟量测的深空探测器自主导航方法 |
CN111947652A (zh) * | 2020-08-13 | 2020-11-17 | 北京航空航天大学 | 一种适用于月球着陆器的惯性/视觉/天文/激光测距组合导航方法 |
Non-Patent Citations (3)
Title |
---|
X-ray pulsar/Doppler difference integrated navigation for deep space exploration with unstable solar spectrum;JinLiu 等;《Aerospace Science and Technology》;20150228;第41卷;第144-150页 * |
利用X射线脉冲星和多普勒频移的组合导航;刘劲 等;《宇航学报》;20100630;第31卷(第6期);第152-157页 * |
基于信息融合的深空探测器的自主导航方法;宁晓琳等;《中国空间科学技术》;20040225(第01期);第66-71页 * |
Also Published As
Publication number | Publication date |
---|---|
CN112525204A (zh) | 2021-03-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110501024B (zh) | 一种车载ins/激光雷达组合导航***的量测误差补偿方法 | |
CN101788296B (zh) | 一种sins/cns深组合导航***及其实现方法 | |
CN108226980B (zh) | 基于惯性测量单元的差分gnss与ins自适应紧耦合导航方法 | |
CN111156994B (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN102508275B (zh) | 多天线gps/gf-ins深度组合定姿方法 | |
Jiancheng et al. | Study on innovation adaptive EKF for in-flight alignment of airborne POS | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN103994763B (zh) | 一种火星车的sins/cns深组合导航***及其实现方法 | |
CN101413800B (zh) | 导航/稳瞄一体化***的导航、稳瞄方法 | |
Ali et al. | Attitude and position estimation on the mars exploration rovers | |
CN106289246B (zh) | 一种基于位置和姿态测量***的柔性杆臂测量方法 | |
CN103076015B (zh) | 一种基于全面最优校正的sins/cns组合导航***及其导航方法 | |
CN102519470B (zh) | 多级嵌入式组合导航***及导航方法 | |
CN112505737B (zh) | 一种gnss/ins组合导航方法 | |
CN111121766B (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN106597507B (zh) | Gnss/sins紧组合滤波平滑的高精度快速算法 | |
CN101825467A (zh) | 捷联惯性导航***与天文导航***实现组合导航的方法 | |
CN113063429B (zh) | 一种自适应车载组合导航定位方法 | |
CN112525204B (zh) | 一种航天器惯性和太阳多普勒速度组合导航方法 | |
CN110849360B (zh) | 面向多机协同编队飞行的分布式相对导航方法 | |
CN113203418A (zh) | 基于序贯卡尔曼滤波的gnssins视觉融合定位方法及*** | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN112880669B (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 |
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 |