CN111238485A - 一种基于导航敏感器拍摄火星图像的系统误差自补偿方法 - Google Patents
一种基于导航敏感器拍摄火星图像的系统误差自补偿方法 Download PDFInfo
- Publication number
- CN111238485A CN111238485A CN202010144111.5A CN202010144111A CN111238485A CN 111238485 A CN111238485 A CN 111238485A CN 202010144111 A CN202010144111 A CN 202010144111A CN 111238485 A CN111238485 A CN 111238485A
- Authority
- CN
- China
- Prior art keywords
- error
- mars
- navigation
- system error
- autonomous 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 32
- 230000003287 optical effect Effects 0.000 claims abstract description 24
- 238000003384 imaging method Methods 0.000 claims abstract description 9
- 239000011159 matrix material Substances 0.000 claims description 44
- 238000009434 installation Methods 0.000 claims description 16
- 230000009897 systematic effect Effects 0.000 claims description 12
- 239000000523 sample Substances 0.000 claims description 7
- 238000009795 derivation Methods 0.000 claims description 6
- 238000005259 measurement Methods 0.000 claims description 6
- 238000009499 grossing Methods 0.000 claims description 5
- 238000004422 calculation algorithm Methods 0.000 claims description 4
- 230000008569 process Effects 0.000 claims description 4
- 238000001914 filtration Methods 0.000 claims description 3
- 238000012546 transfer Methods 0.000 claims description 3
- 230000009466 transformation Effects 0.000 claims description 3
- 230000007704 transition Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000012937 correction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 238000003672 processing method 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/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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Astronomy & Astrophysics (AREA)
- Length Measuring Devices By Optical Means (AREA)
Abstract
本发明公开一种基于导航敏感器拍摄火星图像的系统误差自补偿方法,直接利用直接利用火星导航敏感器所拍摄的火星图像,实现对自主导航系统误差的高精度辨识与补偿,得到更加精确的火星探测器自主导航信息。本方法主要包括4个步骤:1)引入火星整体成像自主导航系统误差模型,建立包含光轴偏差及姿态确定偏差等系统误差的火星自主导航系统;2)求取导航时段的系统误差的条件期望,解算条件期望最大时的系统误差值;3)将更新的系统误差值回代火星导航系统,迭代更新;4)以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果。
Description
技术领域
本发明涉及火星自主导航系统的系统误差修正方法。具体涉及一种不增加测量单机及测量量,直接利用火星导航敏感器所拍摄的火星图像,通过计算系统误差的条件期望并令其最大化,实现对导航系统偏差的精确估计,并在导航系统中进行补偿,得到更加精确的火星探测器自主导航信息的方法。
背景技术
火星探测器在飞行过程中,离地面十分遥远,地面测控精度比地球轨道航天器要低2个量级,可以达到百千米量级,这远不能支撑火星轨道捕获制动的需要。因此需要火星自主导航技术,利用火星探测器搭载的火星导航敏感器拍摄火星图像,获取探测器相对于火星的视线矢量信息,通过的探测器上的自主导航算法计算出火星探测器相对于火星的位置及速度。
火星自主导航的精度不仅依赖于火星导航敏感器的精度,还受导航敏感器光轴指向偏差、探测器姿态偏差等系统误差的影响。提高导航系统误差的补偿能力,可以大大提高火星探测器自主导航精度。
发明内容
本发明的目的在于:克服现有技术的不足,提出了一种基于导航敏感器所拍摄火星图像的系统误差自补偿方法,直接利用直接利用火星导航敏感器所拍摄的火星图像,实现对自主导航系统误差的高精度辨识与补偿,得到更加精确的火星探测器自主导航信息。
为了解决上述技术问题,本发明通过以下的技术方案实现:
一种基于导航敏感器拍摄火星图像的系统误差自补偿方法,包括如下步骤:
步骤一:建立火星整体成像自主导航系统误差模型,建立包含光轴偏差及姿态确定偏差的火星自主导航系统;
步骤二:针对一段时间的导航观测,求取该时段的系统误差的条件期望,解算条件期望最大时的系统误差值;
步骤三:将更新的系统误差值回代火星自主导航系统,重复步骤二,迭代更新系统误差值,直到满足收敛条件;
步骤四:以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果。
进一步的,火星整体成像自主导航系统误差模型,具体为:自主导航系统误差包括星敏感器在轨安装偏差与导航敏感器的在轨安装偏差,对两种系统误差进行等效处理为惯性系下导航敏感器光轴指向误差[θx,θy,θz]。
进一步的,所述步骤一建立包含光轴偏差及姿态确定偏差的火星自主导航系统,具体为:
含等效系统误差的导航系统中的观测方程表示为:
进一步的,所述步骤二中条件期望EL为:
其中:为第r次光轴指向误差估计值,Tr为取迹,lg为取对数,P为估计误差协方差矩阵,Q为随机向量方差矩阵,R为随机向量方差矩阵,为估计误差协方差矩阵、μX0为概率函数一次距、N为总步数、n为状态量的维数、m为观测量的维数;
其中,Φ为状态转移矩阵、Y为完全数据集即[X0、Xk、Zk],Hk为第k步的观测转移矩阵、Zk是第k步的观测量Z。
条件期望分别对三轴的误差角θx,θy,θz求导如下:
求解上式,得到关于θx,θy,θz的标量函数,然后令
进一步的,步骤三中迭代过程如下:
(3)采用新的条件状态和误差方差矩阵Pk|N,计算根据该时段的系统误差的条件期望,解算条件期望最大时的系统误差值θ(r+1)后,进行下一次迭代,直到满足迭代收敛条件,输出最终的系统误差估计结果[θx,θy,θz]。
进一步的,所述步骤四以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果,具体为:以步骤三中输出的[θx,θy,θz]更新等效指向误差矩阵A,代回导航系统观测方程,按照新的系统观测方程进行EKF滤波,得到火星探测器精确的自主导航信息。
进一步的,等效指向误差矩阵A表示为:
进一步的,本发明还提出一种系统误差自补偿系统,包括:
导航系统误差模型建立模块:建立火星整体成像自主导航系统误差模型;
自主导航系统建立模块:建立包含光轴偏差及姿态确定偏差的火星自主导航系统;
条件期望确定模块:针对一段时间的导航观测,求取该时段的系统误差的条件期望,解算条件期望最大时的系统误差值;
迭代模块:将更新的系统误差值回代火星自主导航系统,重复步骤二,迭代更新系统误差值,直到满足收敛条件;
误差补偿模块:以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果。
自主导航系统误差包括星敏感器在轨安装偏差与导航敏感器的在轨安装偏差,对两种系统误差进行等效处理为惯性系下导航敏感器光轴指向误差[θx,θy,θz]。
本发明采用的方法与现有技术相比,其优点和有益效果是:
(1)本方法不需要增加测量量及测量单机,直接利用导航敏感器所拍摄的火星图像对光学导航敏感器的光轴偏差进行自动估计与补偿,提高火星探测器自主导航系统的精度。
(2)本方法不需要利用精确的动力学模型,可以回避建立高精度火星轨道动力学的困难。
(3)本方法能直接估计光轴指向偏差,无须分步估计星敏感器在轨安装偏差与导航敏感器的在轨安装偏差,更加方便高效。
附图说明
图1为本发明的迭代过程示意图;
图2为本发明的子迭代流程计算流程图。
具体实施方式
如图1、图2所示,本发明所述的基于导航敏感器所拍摄火星图像的系统误差自补偿方法,其步骤如下:
步骤一:引入火星整体成像自主导航系统误差模型,建立包含光轴偏差及姿态确定偏差等系统误差的火星自主导航系统;
自主导航系统误差主要包括星敏感器在轨安装偏差与导航敏感器的在轨安装偏差。这里对两种系统误差进行等效处理为惯性系下导航敏感器光轴指向误差[θx,θy,θz],后续不再区分星敏感器与导航敏感器的在轨安装偏差,而是对此等效误差[θx,θy,θz]进行补偿。
令等效惯性系下导航敏感器光轴指向误差为[θx,θy,θz],当[θx,θy,θz]为一小角度时,等效指向误差矩阵A可表示为:
则有
步骤二:针对一段时间的导航观测,求取该时段的系统误差的条件期望,解算条件期望最大时的系统误差值;
首先计算含惯性系下导航敏感器光轴指向系统误差的全部数据似然函数的条件期望。为简便计算,在计算对数似然函数的期望时去掉不相关的常数项。则条件期望为
其中:
其中:为第r次光轴指向误差估计值,Tr为取迹,lg为取对数,P为估计误差协方差矩阵,Q为随机向量方差矩阵,R为随机向量方差矩阵,上面式子里面,比如估计误差协方差矩阵、为概率函数一次距、N为总步数、n为状态量的维数、m为观测量的维数,Φ为状态转移矩阵、Y为完全数据集即[X0、Xk、Zk],Hk为第k步的观测转移矩阵、Zk是第k步的观测量Z。
求解上式,得到关于θx,θy,θz的标量函数,然后令
步骤三:将更新的系统误差值回代火星导航系统,重复步骤二,迭代更新系统误差值,直到满足收敛条件;
具体设计的迭代过程如下:
3、采用新的条件状态和误差方差矩阵Pk|N,按步骤二中的公式,计算根据该时段的系统误差的条件期望,解算条件期望最大时的系统误差值θ(r+1)后,转至步骤2进行下一次迭代,直到满足迭代收敛条件,输出最终的系统误差估计结果[θx,θy,θz]。
步骤四:以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果。
以步骤三中输出的[θx,θy,θz],更新等效指向误差矩阵A,代回导航系统观测方程。按照新的系统观测方程进行EKF滤波,得到火星探测器精确的自主导航信息。
其中,等效指向误差矩阵A表示为:
本发明方法不需要增加观测量,直接利用导航敏感器所拍摄的火星图像对光学导航敏感器的光轴偏差进行自动估计与补偿,提高火星探测器自主导航系统的精度,同时,本发明方法不需要利用精确的动力学模型,可以回避建立高精度火星轨道动力学的困难。
Claims (10)
1.一种基于导航敏感器拍摄火星图像的系统误差自补偿方法,其特征在于包括如下步骤:
步骤一:建立火星整体成像自主导航系统误差模型,建立包含光轴偏差及姿态确定偏差的火星自主导航系统;
步骤二:针对一段时间的导航观测,求取该时段的系统误差的条件期望,解算条件期望最大时的系统误差值;
步骤三:将更新的系统误差值回代火星自主导航系统,重复步骤二,迭代更新系统误差值,直到满足收敛条件;
步骤四:以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果。
2.根据权利要求1所述的一种基于导航敏感器拍摄火星图像的系统误差自补偿方法,其特征在于:火星整体成像自主导航系统误差模型,具体为:自主导航系统误差包括星敏感器在轨安装偏差与导航敏感器的在轨安装偏差,对两种系统误差进行等效处理为惯性系下导航敏感器光轴指向误差[θx,θy,θz]。
7.根据权利要求5所述的一种基于导航敏感器拍摄火星图像的系统误差自补偿方法,其特征在于:所述步骤四以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果,具体为:以步骤三中输出的[θx,θy,θz]更新等效指向误差矩阵A,代回导航系统观测方程,按照新的系统观测方程进行EKF滤波,得到火星探测器精确的自主导航信息。
9.一种根据权利要求1所述的系统误差自补偿方法实现的系统误差自补偿系统,其特征在于包括:
导航系统误差模型建立模块:建立火星整体成像自主导航系统误差模型;
自主导航系统建立模块:建立包含光轴偏差及姿态确定偏差的火星自主导航系统;
条件期望确定模块:针对一段时间的导航观测,求取该时段的系统误差的条件期望,解算条件期望最大时的系统误差值;
迭代模块:将更新的系统误差值回代火星自主导航系统,重复步骤二,迭代更新系统误差值,直到满足收敛条件;
误差补偿模块:以收敛的系统误差值更新火星自主导航系统,对系统误差进行补偿,得到后续精确的导航结果。
10.根据权利要求9所述的系统误差自补偿系统,其特征在于:火星整体成像自主导航系统误差模型,具体为:自主导航系统误差包括星敏感器在轨安装偏差与导航敏感器的在轨安装偏差,对两种系统误差进行等效处理为惯性系下导航敏感器光轴指向误差[θx,θy,θz]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010144111.5A CN111238485B (zh) | 2020-03-04 | 2020-03-04 | 一种基于导航敏感器拍摄火星图像的系统误差自补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010144111.5A CN111238485B (zh) | 2020-03-04 | 2020-03-04 | 一种基于导航敏感器拍摄火星图像的系统误差自补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111238485A true CN111238485A (zh) | 2020-06-05 |
CN111238485B CN111238485B (zh) | 2021-11-16 |
Family
ID=70875220
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010144111.5A Active CN111238485B (zh) | 2020-03-04 | 2020-03-04 | 一种基于导航敏感器拍摄火星图像的系统误差自补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111238485B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114003045A (zh) * | 2021-12-30 | 2022-02-01 | 成都星宇融科电力电子股份有限公司 | 一种光电跟踪仪的目标跟踪方法、终端、可读存储介质 |
CN114577222A (zh) * | 2022-02-10 | 2022-06-03 | 北京空间飞行器总体设计部 | 一种基于自主导航系统误差有限扩维的状态空间重构方法 |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114543795B (zh) * | 2021-12-31 | 2024-01-02 | 文远苏行(江苏)科技有限公司 | 双天线航向角的安装误差估计方法和调整方法及相关设备 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110282636A1 (en) * | 2010-05-12 | 2011-11-17 | The Government Of The United States, As Represented By The Secretary Of The Navy | Variable Resolution Uncertainty Expert System for Digital Bathymetry Database |
CN103335654A (zh) * | 2013-06-19 | 2013-10-02 | 北京理工大学 | 一种行星动力下降段的自主导航方法 |
CN104567880A (zh) * | 2014-12-23 | 2015-04-29 | 北京理工大学 | 一种基于多源信息融合的火星最终接近段自主导航方法 |
CN107806887A (zh) * | 2017-09-22 | 2018-03-16 | 上海卫星工程研究所 | 火星导航敏感器安装误差在轨定标方法 |
CN110398252A (zh) * | 2018-04-24 | 2019-11-01 | 下龙有限公司 | 路径搜索装置、驾驶控制装置以及自动行驶装置 |
-
2020
- 2020-03-04 CN CN202010144111.5A patent/CN111238485B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20110282636A1 (en) * | 2010-05-12 | 2011-11-17 | The Government Of The United States, As Represented By The Secretary Of The Navy | Variable Resolution Uncertainty Expert System for Digital Bathymetry Database |
CN103335654A (zh) * | 2013-06-19 | 2013-10-02 | 北京理工大学 | 一种行星动力下降段的自主导航方法 |
CN104567880A (zh) * | 2014-12-23 | 2015-04-29 | 北京理工大学 | 一种基于多源信息融合的火星最终接近段自主导航方法 |
CN107806887A (zh) * | 2017-09-22 | 2018-03-16 | 上海卫星工程研究所 | 火星导航敏感器安装误差在轨定标方法 |
CN110398252A (zh) * | 2018-04-24 | 2019-11-01 | 下龙有限公司 | 路径搜索装置、驾驶控制装置以及自动行驶装置 |
Non-Patent Citations (3)
Title |
---|
SHUANG LI 等: "InnovativeMarsentryintegratednavigationusingmodifiedmultiple", 《AEROSPACESCIENCEANDTECHNOLOGY》 * |
吴纵横: "基于自适应零速修正及情境融合的室内定位系统研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
王汀: "多约束火星精确着陆制导与控制律研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114003045A (zh) * | 2021-12-30 | 2022-02-01 | 成都星宇融科电力电子股份有限公司 | 一种光电跟踪仪的目标跟踪方法、终端、可读存储介质 |
CN114003045B (zh) * | 2021-12-30 | 2022-04-15 | 成都星宇融科电力电子股份有限公司 | 一种光电跟踪仪的目标跟踪方法、终端、可读存储介质 |
CN114577222A (zh) * | 2022-02-10 | 2022-06-03 | 北京空间飞行器总体设计部 | 一种基于自主导航系统误差有限扩维的状态空间重构方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111238485B (zh) | 2021-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111238485B (zh) | 一种基于导航敏感器拍摄火星图像的系统误差自补偿方法 | |
CN107449444B (zh) | 一种多星图姿态关联的星敏感器内参数标定方法 | |
CN105698764B (zh) | 一种光学遥感卫星影像时变系统误差建模补偿方法及系统 | |
CN111366148B (zh) | 适用于机载光电观瞄系统多次观察的目标定位方法 | |
CN113551668B (zh) | 一种航天器惯性/恒星星光矢量/星光折射组合导航方法 | |
CN112577493A (zh) | 一种基于遥感地图辅助的无人机自主定位方法及系统 | |
US5852792A (en) | Spacecraft boresight calibration filter | |
CN112197765B (zh) | 一种实现水下机器人精细导航的方法 | |
CN114754798A (zh) | 一种陀螺误差特性参数在轨辨识与标定方法 | |
CN112146655A (zh) | 一种BeiDou/SINS紧组合导航系统弹性模型设计方法 | |
CN116105730A (zh) | 基于合作目标卫星甚短弧观测的仅测角光学组合导航方法 | |
CN116007620A (zh) | 一种组合导航滤波方法、系统、电子设备及存储介质 | |
CN115878939A (zh) | 基于飞行器舵面偏转的高精度动态测量方法 | |
CN110388942B (zh) | 一种基于角度和速度增量的车载姿态精对准系统 | |
CN116222551A (zh) | 一种融合多种数据的水下导航方法及装置 | |
CN108981691B (zh) | 一种天空偏振光组合导航在线滤波与平滑方法 | |
CN117073720A (zh) | 弱环境与弱动作控制下快速视觉惯性标定与初始化方法及设备 | |
CN113503891B (zh) | 一种sinsdvl对准校正方法、系统、介质及设备 | |
CN115574766A (zh) | 一种面向遮挡环境的偏振融合定向方法 | |
CN107228683B (zh) | 一种多星敏感器间慢变误差实时在轨修正方法 | |
CN115630254A (zh) | 高精度星敏感器光学系统内参数微变化量的在轨标定方法 | |
Candan et al. | Estimation of attitude using robust adaptive Kalman filter | |
CN115127591A (zh) | 一种基于统计置信距离量测自举的机载dpos传递对准方法 | |
CN114526726B (zh) | 基于可观性分析的星光折射导航观星方案优化设计方法 | |
CN115752515B (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 |