CN111637896A - 一种基于星历约束辅助的自主天文导航方法 - Google Patents
一种基于星历约束辅助的自主天文导航方法 Download PDFInfo
- Publication number
- CN111637896A CN111637896A CN202010398979.8A CN202010398979A CN111637896A CN 111637896 A CN111637896 A CN 111637896A CN 202010398979 A CN202010398979 A CN 202010398979A CN 111637896 A CN111637896 A CN 111637896A
- Authority
- CN
- China
- Prior art keywords
- navigation
- constraint
- mars
- ephemeris
- celestial body
- 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
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
-
- 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)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明公开一种基于星历约束辅助的自主天文导航方法,属于深空探测技术领域。本方法基于火星环绕段动力学模型建立导航状态方程,以火星卫星为导航目标天体建立导航观测模型,结合非线性滤波算法进行自主天文导航,在此基础上引入导航目标天体星历误差约束,采用概率密度函数截断法对滤波结果做进一步修正,能够保证滤波收敛并有效提高导航精度。
Description
技术领域
本发明涉及一种基于星历约束辅助的自主天文导航方法,属于深空探测技术领域。
背景技术
深空探测任务飞行距离远、空间环境复杂,仅依赖地面测控网进行导航在定位精度、实时性及可靠性方面存在诸多限制。基于光学测量的自主天文导航技术是解决这一问题的有效途径。在接近和环绕目标天体的探测阶段,可以利用行星及其卫星的视线方向或与背景恒星的角距等信息,估计探测器的位置和速度。然而在具体实施过程中,目标天体的星历误差会对导航性能产生很大影响,引起估计误差增大甚至滤波发散现象。以火星系统为例,两颗火星卫星(Phobos,Deimos)是接近和环绕过程中的理想导航天体,但其星历误差在公里量级,并呈现出周期性变化。另外,由于受火星遮挡、太阳光照等因素影响,可见弧段受限。因此,需要采取适当措施,避免导航性能劣化。
发明内容
本发明解决的技术问题是克服现有技术的不足,提出一种基于星历约束辅助的自主天文导航方法,解决了星历误差和观测受限引起的导航性能劣化。
本发明的技术方案是:一种基于星历约束辅助的自主天文导航方法,实现具体步骤如下:
步骤1:建立基于火星环绕段动力学模型的导航状态方程
E(w)=0,E(wwT)=Q (2)
步骤2:建立探测器导航观测模型
z=h(x)+ν (3)
其中,z为导航系统的观测量,ν为测量噪声;
以火星卫星为导航目标天体进行光学测量,观测量为光学相机提供的导航目标天体视线方向矢量或导航目标天体与背景恒星的夹角;
步骤3:根据火星遮挡、太阳光照的影响,对导航目标天体的可见性作出预测,在可见弧段内,利用非线性滤波算法同步对探测器和导航目标天体的位置、速度状态进行联合估计,不可见时,仅利用动力学递推进行轨道预报;
步骤4:将导航目标天体的位置、状态转换为轨道要素,以常量要素为约束建立约束方程
步骤5:根据已知星历误差范围确定约束边界,利用概率密度函数截断法对原状态估计及其协方差进行修正。
所述步骤1中火星环绕段动力学模型采用火星中心惯性坐标系下考虑J2扰动项的二体动力学模型,具体形式如下
其中rx,s,ry,s,rz,s是探测器位置矢量rs的三轴分量,rs=|rs|为探测器到火心的距离,rx,p,ry,p,rz,p是火星卫星位置矢量rp的三轴分量,rp=|rp|为探测器到火心的距离,μ是火星引力常数,J2为二阶带谐系数,RM为火星的平均赤道半径。
若采用导航目标天体视线方向矢量作为导航观测量,则观测模型的具体形式为
其中,(p,l)为火星卫星在成像平面上的像素坐标,kx,ky为坐标像素转换系数,νp,νl为像素测量噪声,xc,yc为成像点在像平面上的位置,表示为
若采用导航目标天体与背景恒星的夹角作为导航观测量,则观测模型的具体形式为
其中,θp火星卫星与背景恒星的星光角距,ns为背景恒星相对探测器的单位方向矢量,νθ为角距测量噪声。
步骤3中对导航目标天体的可见性作出预测的具体方法为:计算并判断探测器到火星卫星与探测器到火星中心的矢量夹角α是否大于火星视半径θM
若满足条件:
α>θM (11)
则导航目标天体可见,否则,导航目标天体不可见。
所述步骤3中非线性滤波算法采用无迹卡尔曼滤波算法。
步骤4中将导航目标天体的位置、状态转换为轨道要素的计算公式为:
h=r×v=[hx,hy,hz]T,n=[nx,ny,nz]=[-hy,hx,0] (12)
其中,轨道半长轴a,偏心率e,轨道倾角i,升交点赤经Ω和近心点幅角ω作为近似常量要素用于建立约束方程。
所述步骤5中建立星历双边约束方程为:
其中,s为约束条件个数,ai,bi分别为第i个约束条件的上下边界。
所述步骤5中概率密度函数截断法对原状态估计及其协方差进行修正,具体计算方法如下:
对滤波误差协方差进行规范化分解,使之满足条件
Pi=TWTT (19)
其中,T为正交矩阵,W为对角矩阵;采用Gram-Schmidt正交化计算矩阵ρ,使之满足条件
将原约束边界进行变换
得到规范化的标量上下界ci和di,则截断部分的概率密函数记为
其中erf(·)为误差函数,定义为
将截断后的概率密度函数进行归一化,并计算均值μ和方差σ2
其中,α为归一化系数
约束后的变换后状态变量z及其方差C为
z=[μ 0 … 0]T (27)
C=diag(σ2,1,…,1) (28)
对状态变量及其方差进行反变换,得到约束修正后的状态估计均值和方差为:
xi+1=TW1/2ρTz+xi (29)
Pi+1=TW1/2ρTCρW1/2TT (30)
对i加1并重复上述操作,获得下一条约束条件修正后的状态估计及方差。
本发明与现有技术相比的优点在于:
(1)传统导航方法主要结合动力学与外部测量对导航状态进行预报和更新,未能充分考虑其他导航系统已知信息,本方法在此基础上引入了导航目标天体星历误差约束,对滤波结果做进一步修正,能够保证滤波收敛并有效提高导航精度。
(2)本方法对导航目标天体的星历进行实时估计,适用于环绕探测任务等长期导航需求。
(3)本方法无需新增其他外部信息源,仅从导航算法层面做出改进,实施简单,具备可操作性。
附图说明
图1为一种基于星历约束辅助的自主天文导航方法实施流程图。
具体实施方式
下面结合附图1对本发明做进一步介绍。首先基于火星环绕段动力学模型,建立导航状态方程,形式如下
E(w)=0,E(wwT)=Q (2)
火星环绕段动力学模型采用火星中心惯性坐标系下考虑J2扰动项的二体动力学模型,形式如下
其中rx,s,ry,s,rz,s是探测器位置矢量rs的三轴分量,rs=|rs|为探测器到火心的距离,rx,p,ry,p,rz,p是火星卫星位置矢量rp的三轴分量,rp=|rp|为探测器到火心的距离,μ是火星引力常数,J2为二阶带谐系数,RM为火星的平均赤道半径。
随后建立探测器导航观测模型,形式如下
z=h(x)+ν (4)
其中,z为导航系统的观测量,ν为测量噪声;以火星卫星为导航目标天体进行光学测量,观测量为光学相机提供的导航目标天体视线方向矢量,观测模型的具体形式为
其中,(p,l)为火星卫星在成像平面上的像素坐标,kx,ky为坐标像素转换系数,νp,νl为像素测量噪声,xc,yc为成像点在像平面上的位置,表示为
综合考虑火星遮挡、太阳光照的影响,对导航目标天体的可见性作出预测,计算并判断探测器到火星卫星与探测器到火星中心的矢量夹角α是否大于火星视半径θM
若满足条件:
α>θM (9)
则导航目标天体可见,否则,导航目标天体不可见;在可见弧段内,利用无迹卡尔曼滤波算法同步对探测器和导航目标天体的位置、速度状态进行联合估计,不可见时,仅利用动力学递推进行轨道预报;
将导航目标天体的位置、状态转换为轨道要素(在此省略目标天体状态变量下标p)
h=r×v=[hx,hy,hz]T,n=[nx,ny,nz]=[-hy,hx,0] (10)
其中,轨道半长轴a,偏心率e,轨道倾角i,升交点赤经Ω和近心点幅角ω可作为近似常量要素用于建立约束方程。在此,以轨道半长轴a为约束建立约束方程,根据星历误差范围确定约束边界
其中,a1=9374,b1=9376分别为半长轴约束条件的上下边界。
利用概率密度函数截断法对原状态估计及其协方差进行修正:对滤波误差协方差进行规范化分解,使之满足条件
P1=TWTT (16)
其中,T为正交矩阵,W为对角矩阵;采用Gram-Schmidt正交化计算矩阵ρ,使之满足条件
将原约束边界进行变换
得到规范化的标量上下界c1和d1,则截断部分的概率密函数可以记为
其中erf(·)为误差函数,定义为
将截断后的概率密度函数进行归一化,并计算均值μ和方差σ2
其中,α为归一化系数
因此约束后的变换后状态变量z及其方差C为
z=[μ 0 … 0]T (24)
C=diag(σ2,1,…,1) (25)
最后对状态变量及其方差进行反变换,得到约束修正后的状态估计均值和方差为:
x2=TW1/2ρTz+x1 (26)
P2=TW1/2ρTCρW1/2TT (27)
若需要利用其它约束条件进行修正,可重复上述操作,获得下一条约束条件修正后的状态估计及方差。
本发明未详细说明部分属本领域技术人员公知常识。
Claims (9)
1.一种基于星历约束辅助的自主天文导航方法,其特征在于实现具体步骤如下:
步骤1:建立基于火星环绕段动力学模型的导航状态方程
E(w)=0,E(wwT)=Q (2)
步骤2:建立探测器导航观测模型
z=h(x)+ν (3)
其中,z为导航系统的观测量,ν为测量噪声;
以火星卫星为导航目标天体进行光学测量,观测量为光学相机提供的导航目标天体视线方向矢量或导航目标天体与背景恒星的夹角;
步骤3:根据火星遮挡、太阳光照的影响,对导航目标天体的可见性作出预测,在可见弧段内,利用非线性滤波算法同步对探测器和导航目标天体的位置、速度状态进行联合估计,不可见时,仅利用动力学递推进行轨道预报;
步骤4:将导航目标天体的位置、状态转换为轨道要素,以常量要素为约束建立约束方程
步骤5:根据已知星历误差范围确定约束边界,利用概率密度函数截断法对原状态估计及其协方差进行修正。
6.如权利要求1所述的基于星历约束辅助的自主天文导航方法,其特征在于:所述步骤3中非线性滤波算法采用无迹卡尔曼滤波算法。
9.如权利要求1所述的基于星历约束辅助的自主天文导航方法,其特征在于:所述步骤5中概率密度函数截断法对原状态估计及其协方差进行修正,具体计算方法如下:
对滤波误差协方差进行规范化分解,使之满足条件
Pi=TWTT (19)
其中,T为正交矩阵,W为对角矩阵;采用Gram-Schmidt正交化计算矩阵ρ,使之满足条件
将原约束边界进行变换
得到规范化的标量上下界ci和di,则截断部分的概率密函数记为
其中erf(·)为误差函数,定义为
将截断后的概率密度函数进行归一化,并计算均值μ和方差σ2
其中,α为归一化系数
约束后的变换后状态变量z及其方差C为
z=[μ 0…0]T (27)
C=diag(σ2,1,…,1) (28)
对状态变量及其方差进行反变换,得到约束修正后的状态估计均值和方差为:
xi+1=TW1/2ρTz+xi (29)
Pi+1=TW1/2ρTCρW1/2TT (30)
对i加1并重复上述操作,获得下一条约束条件修正后的状态估计及方差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010398979.8A CN111637896B (zh) | 2020-05-12 | 2020-05-12 | 一种基于星历约束辅助的自主天文导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010398979.8A CN111637896B (zh) | 2020-05-12 | 2020-05-12 | 一种基于星历约束辅助的自主天文导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111637896A true CN111637896A (zh) | 2020-09-08 |
CN111637896B CN111637896B (zh) | 2021-12-07 |
Family
ID=72331988
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010398979.8A Active CN111637896B (zh) | 2020-05-12 | 2020-05-12 | 一种基于星历约束辅助的自主天文导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111637896B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112985421A (zh) * | 2020-12-14 | 2021-06-18 | 北京航空航天大学 | 一种基于角度约束辅助测量的航天器自主天文导航方法 |
CN113485395A (zh) * | 2021-06-29 | 2021-10-08 | 北京控制工程研究所 | 一种误差约束下固定时间相对姿轨跟踪控制方法 |
CN113654512A (zh) * | 2021-08-13 | 2021-11-16 | 中国电子科技集团公司第十四研究所 | 一种空间目标光学可见性分析方法 |
CN112985421B (zh) * | 2020-12-14 | 2024-06-07 | 北京航空航天大学 | 一种基于角度约束辅助测量的航天器自主天文导航方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101464506A (zh) * | 2008-12-26 | 2009-06-24 | 大连海事大学 | 一种天文辅助的单星定位方法 |
CN101968361A (zh) * | 2009-07-28 | 2011-02-09 | 韩春好 | 基于星光观测的空间绝对定向技术 |
CN103063217A (zh) * | 2013-01-08 | 2013-04-24 | 北京航空航天大学 | 一种基于星历修正的深空探测器天文/无线电组合导航方法 |
CN104764449A (zh) * | 2015-04-23 | 2015-07-08 | 北京航空航天大学 | 一种基于星历修正的捕获段深空探测器自主天文导航方法 |
CN107655485A (zh) * | 2017-09-25 | 2018-02-02 | 北京理工大学 | 一种巡航段自主导航位置偏差修正方法 |
CN110146092A (zh) * | 2019-06-19 | 2019-08-20 | 北京理工大学 | 基于导航信息评价的双体小行星探测轨迹优化方法 |
-
2020
- 2020-05-12 CN CN202010398979.8A patent/CN111637896B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101464506A (zh) * | 2008-12-26 | 2009-06-24 | 大连海事大学 | 一种天文辅助的单星定位方法 |
CN101968361A (zh) * | 2009-07-28 | 2011-02-09 | 韩春好 | 基于星光观测的空间绝对定向技术 |
CN103063217A (zh) * | 2013-01-08 | 2013-04-24 | 北京航空航天大学 | 一种基于星历修正的深空探测器天文/无线电组合导航方法 |
CN104764449A (zh) * | 2015-04-23 | 2015-07-08 | 北京航空航天大学 | 一种基于星历修正的捕获段深空探测器自主天文导航方法 |
CN107655485A (zh) * | 2017-09-25 | 2018-02-02 | 北京理工大学 | 一种巡航段自主导航位置偏差修正方法 |
CN110146092A (zh) * | 2019-06-19 | 2019-08-20 | 北京理工大学 | 基于导航信息评价的双体小行星探测轨迹优化方法 |
Non-Patent Citations (4)
Title |
---|
XIAOLIN NING, ET AL: "Analysis of Ephemeris Errors in Autonomous Celestial Navigation during Mars Approach Phase", 《THE JOURNAL OF NAVIGATION》 * |
宁晓琳等: "一种深空天文测角导航中的星历误差抑制方法", 《宇航学报》 * |
董唯光等: "改进的 CRPF 在自主天文导航中的应用", 《计算机测量与控制》 * |
马辛等: "一种平面约束辅助测量的深空探测器自主天文导航方法", 《深空探测学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN112985421A (zh) * | 2020-12-14 | 2021-06-18 | 北京航空航天大学 | 一种基于角度约束辅助测量的航天器自主天文导航方法 |
CN112985421B (zh) * | 2020-12-14 | 2024-06-07 | 北京航空航天大学 | 一种基于角度约束辅助测量的航天器自主天文导航方法 |
CN113485395A (zh) * | 2021-06-29 | 2021-10-08 | 北京控制工程研究所 | 一种误差约束下固定时间相对姿轨跟踪控制方法 |
CN113485395B (zh) * | 2021-06-29 | 2024-03-15 | 北京控制工程研究所 | 一种误差约束下固定时间相对姿轨跟踪控制方法 |
CN113654512A (zh) * | 2021-08-13 | 2021-11-16 | 中国电子科技集团公司第十四研究所 | 一种空间目标光学可见性分析方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111637896B (zh) | 2021-12-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106871927B (zh) | 一种无人机光电吊舱安装误差标校方法 | |
US9073648B2 (en) | Star tracker rate estimation with kalman filter enhancement | |
CN108710379B (zh) | 静止卫星成像偏航导引角计算方法 | |
CN106595674B (zh) | 基于星敏感器和星间链路的heo卫星编队飞行自主导航方法 | |
CN104792340A (zh) | 一种星敏感器安装误差矩阵与导航系统星地联合标定与校正的方法 | |
CN111238467B (zh) | 一种仿生偏振光辅助的无人作战飞行器自主导航方法 | |
CN107655485B (zh) | 一种巡航段自主导航位置偏差修正方法 | |
WO2017113567A1 (zh) | 火星探测器自主导航方法 | |
EP0245562B1 (en) | Spacecraft camera image registration | |
CN111637896B (zh) | 一种基于星历约束辅助的自主天文导航方法 | |
CN111366148B (zh) | 适用于机载光电观瞄系统多次观察的目标定位方法 | |
CN111307139A (zh) | 一种基于偏振/天文信息融合的航向与姿态确定方法 | |
RU2454631C1 (ru) | Способ автономной навигации и ориентации космических аппаратов на основе виртуальных измерений зенитных расстояний звезд | |
CN108458709B (zh) | 基于视觉辅助测量的机载分布式pos数据融合方法和装置 | |
CN111366984B (zh) | 一种基于重力卫星星间激光测距系统确定引力场模型的方法 | |
CN109633720B (zh) | 基于视频卫星的地面运动目标测量方法及其装置 | |
CN113029132B (zh) | 一种结合地面影像与恒星光行差测量的航天器导航方法 | |
CN112179334B (zh) | 基于两步Kalman滤波的星光导航方法及系统 | |
CN110388942B (zh) | 一种基于角度和速度增量的车载姿态精对准系统 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN113091731A (zh) | 一种基于恒星视线相对论效应的航天器自主导航方法 | |
CN115356754A (zh) | 一种基于gnss和低轨卫星的组合导航定位方法 | |
CN111060077A (zh) | 基于稀疏控制点的遥感卫星图像定位方法 | |
CN113776527B (zh) | 一种民航飞机全时空的组合导航系统和导航方法 | |
Wolfe | MODIS geolocation |
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 |