CN107703522A - 一种陨石坑特征误匹配的可观测度检测法 - Google Patents
一种陨石坑特征误匹配的可观测度检测法 Download PDFInfo
- Publication number
- CN107703522A CN107703522A CN201710844456.XA CN201710844456A CN107703522A CN 107703522 A CN107703522 A CN 107703522A CN 201710844456 A CN201710844456 A CN 201710844456A CN 107703522 A CN107703522 A CN 107703522A
- Authority
- CN
- China
- Prior art keywords
- matrix
- navigation system
- crater
- meteorite
- mismatching
- 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
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/14—Receivers specially adapted for specific applications
- G01S19/15—Aircraft landing systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/01—Satellite radio beacon positioning systems transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/13—Receivers
- G01S19/20—Integrity monitoring, fault detection or fault isolation of space segment
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V10/00—Arrangements for image or video recognition or understanding
- G06V10/70—Arrangements for image or video recognition or understanding using pattern recognition or machine learning
- G06V10/74—Image or video pattern matching; Proximity measures in feature spaces
- G06V10/75—Organisation of the matching processes, e.g. simultaneous or sequential comparisons of image or video features; Coarse-fine approaches, e.g. multi-scale approaches; using context analysis; Selection of dictionaries
- G06V10/751—Comparing pixel values or logical combinations thereof, or feature values having positional relevance, e.g. template matching
-
- G—PHYSICS
- G06—COMPUTING; CALCULATING OR COUNTING
- G06V—IMAGE OR VIDEO RECOGNITION OR UNDERSTANDING
- G06V20/00—Scenes; Scene-specific elements
- G06V20/10—Terrestrial scenes
- G06V20/13—Satellite images
Abstract
本发明公开的一种陨石坑特征误匹配的可观测度检测法,属于深空探测技术领域。本发明利用两幅下降图像中n对初步匹配的陨石坑,通过矩阵的克罗内克积,建立基于陨石坑边缘椭圆曲线的观测模型;从误差分析的角度对观测矩阵进行可观测度分析,得到导航系统可观测度的度量标准;基于得到的可观测度的度量标准进行可观测度判断,进而剔除陨石坑误匹配,实现导航系统可观,即实现对陨石坑特征误匹配的可观测度分析检测,提高导航系统精度,保证导航系统的稳定性。本发明不仅适用于行星着陆任务中,也适用于小天体着陆任务;同时本发明对基于陨石坑边缘椭圆曲线的绝对导航系统仍然适用。
Description
技术领域
本发明涉及一种陨石坑特征误匹配的可观测度检测法,属于深空探测技术领域。
背景技术
随着深空探测任务的不断开展,星际着陆探测日趋复杂,同时对着陆技术的要求也在不断提高,着陆器导航系统的设计逐渐成为整个探测任务的关键。在着陆过程中,着陆器通过导航相机从目标天体表面获取的视觉信息越来越丰富,通过利用图像的一些特征获取着陆器位置和姿态信息是必要的。陨石坑作为天体表面常见的视觉特征,具有清晰的轮廓和一致的几何形状,相对来说较易于识别和跟踪,是着陆器着陆过程中最为重要的导航路标之一。
陨石坑提取和匹配的有效性决定了基于陨石坑特征的着陆器视觉导航系统的精度和可靠性。然而,对陨石坑边缘椭圆曲线信息进行提取后,在所建立的初步匹配特征对中可能存在误匹配。误匹配的陨石坑边缘曲线对的存在极大地影响着陆器运动参数的求取,使估计结果出现较大偏差,因此必须剔除这些误匹配特征对。目前主要采用随机抽样一致性算法(RANSAC)和马氏距离算法删除误匹配,但RANSAC计算量大,匹配特征选取不当会影响变换矩阵精度,从而不能完全去除误匹配;利用马氏距离的仿射不变性进行不变特征相似性度量需要大量的矩阵运算,导致算法复杂度高,实时性下降。鉴于此,有必要针对陨石坑特征误匹配这一问题,设计一种快速有效地陨石坑误匹配检测与剔除算法,以保证着陆器导航系统的精度和稳定性。
发明内容
本发明的目的是为了解决陨石坑特征误匹配的问题,提供一种陨石坑特征误匹配的可观测度分析检测法,从运动参数估计误差的角度,以观测矩阵的奇异值作为导航系统可观测度的度量标准,能够有效地剔除陨石坑特征误匹配,保证导航系统的稳定性。
本发明公开的一种陨石坑特征误匹配的可观测度检测法,利用两幅下降图像中n对初步匹配的陨石坑,通过矩阵的克罗内克积,建立基于陨石坑边缘椭圆曲线的观测模型。从误差分析的角度对观测矩阵进行可观测度分析,得到导航系统可观测度的度量标准。基于得到的可观测度的度量标准进行可观测度判断,进而剔除陨石坑误匹配,实现导航系统可观,即实现对陨石坑特征误匹配的可观测度分析检测,提高导航系统精度,保证导航系统的稳定性。
本发明的目的是通过下述技术方案实现的:
本发明公开的一种陨石坑特征误匹配的可观测度检测法,包括如下步骤:
步骤1:建立基于陨石坑边缘椭圆曲线的观测模型。
在着陆过程中,给定下降图像中n对初步匹配的陨石坑,且n≥3。则利用两幅下降图像中任意两对初步匹配的陨石坑在着陆器本体坐标系下(与相机坐标系重合)建立着陆器的相对运动约束方程为:
其中,i<j且∈{1,2,…,n};矩阵Ai,Aj分别表示着陆器在位置cλ-1时两个陨石坑像的边缘椭圆曲线,其中λ=2,3,…;矩阵Bi,Βj分别表示着陆器在位置cλ时两个陨石坑像的边缘椭圆曲线;且矩阵Ai,Aj,Bi,Bj都为3×3的非奇异对称矩阵;矩阵H为3×3单应矩阵,表示着陆器的相对运动参数,满足:
式中向量表示着陆器在不同位置处的相对位置;矩阵表示着陆器在不同位置处的相对姿态;表示天体表面在着陆器本体坐标系下的单位法向量;表示天体表面距离着陆器本体坐标系原点的垂直距离。
结合着陆器相对运动约束方程(1),利用矩阵的克罗内克积建立关于着陆器相对位姿的观测模型为:
E9n(n-1)/2×9h=0 (3)
其中,为基于陨石坑边缘椭圆曲线的观测矩阵。两幅下降图像中任一对陨石坑边缘椭圆曲线的观测矩阵为 ΔA和ΔB分别表示两幅下降图像中的陨石坑边缘曲线噪声,其中噪声矩阵ΔA和ΔB的大小预先给定。此后,为避免使用过多符号,观测矩阵 仍用A,B表示。则观测矩阵E中的分块矩阵Ei,j表示为矩阵I为3×3的单位矩阵;向量h为单应矩阵H的向量化形式。
步骤1中两幅下降图像优选两幅相邻下降图像。
步骤1中噪声矩阵ΔA和ΔB的大小预先给定优选通过由经验给定。
步骤2:对观测矩阵E进行可观测度分析,得到可观测度的度量标准。
结合式(1)和式(3),观测矩阵E中存在的噪声表示为:
其中ΔEi,j为噪声矩阵ΔE中的分块矩阵,满足ΔAi,j和ΔBi,j分别满足:
其中i<j且∈{1,2,…,n}。
根据特征值分解的线性误差传播理论得到相对运动参数的估计误差Δh为:
Δh=GΛGT(ΔETΕ+ETΔE)h (6)
其中矩阵G为标准正交矩阵,满足 表示ETE的特征值;矩阵Λ满足:λ1,λ2,…,λ9表示观测矩阵E的奇异值,且满足λ1≥λ2≥…≥λ9≥0。
当测量数据无误差时,λ9=0。当测量数据存在误差时,矩阵ETE的最小特征值的扰动误差由下式得出:
其中向量g9是特征值对应的单位特征向量。
基于以上分析,取λ9/λ8和观测矩阵奇异值λ9作为衡量导航系统可观测度的度量标准。从式(6)和(7)看出,λ9/λ8的值趋近于1,或者如果观测矩阵奇异值λ9的平方远大于其扰动误差估计值运动参数估计误差较大,则导航系统是不可观的,从而说明导航系统存在误匹配。
步骤3:基于步骤2得到的可观测度的度量标准进行可观测度判断,进而剔除陨石坑误匹配,直至导航系统可观。
给定n(n≥3)对初始匹配的陨石坑特征对,设定阈值ε1和ε2,对陨石坑误匹配进行剔除方法包括如下步骤:
步骤3.1:当n=3时,若λ9≤ε1,且λ9/λ8≤ε2,则认为初始匹配的陨石坑特征对匹配正确;若λ9>ε1,或λ9/λ8>ε2,则认为初始匹配的陨石坑特征对存在误匹配,导航系统不可观,此时误匹配剔除后,陨石坑特征对数n<3,导航系统仍不可观,需引入新的陨石坑特征对进行误匹配剔除,转入步骤3.2;
步骤3.2:当n>3时,若λ9≤ε1,且λ9/λ8≤ε2,则认为初始匹配的陨石坑特征对匹配正确;若λ9>ε1,或λ9/λ8>ε2,则认为初始匹配的陨石坑特征对存在误匹配,导航系统不可观,令矩阵[E]k表示观测矩阵E删除第k个陨石坑特征对的子矩阵,其中k=1,2,…,n,分别判断观测矩阵[E]k的可观测度λ9和λ9/λ8,若导航系统可观,则认为第k个陨石坑特征对为误匹配,反之,根据观测矩阵[E]k中新的陨石坑特征对数n的大小重复迭代步骤3.1、步骤3.2,直至满足λ9≤ε1,且λ9/λ8≤ε2,导航系统可观,即实现对陨石坑特征误匹配的可观测度分析检测,提高导航系统精度,保证导航系统的稳定性。
有益效果:
1、本发明公开的一种陨石坑特征误匹配的可观测度检测法,从运动参数估计误差的角度,以观测矩阵的奇异值作为导航系统可观测度的度量标准,提供一种基于可观测度分析的陨石坑特征误匹配及异常值检测的方法,同时对阈值的选取提供定量的描述,能够保证导航系统的稳定性。
2、本发明公开的一种陨石坑特征误匹配的可观测度检测法,导航系统可观测度的度量标准能够由导航算法的中间值直接给出,降低算法复杂度,提高导航系统实时性。
3、本发明公开的一种陨石坑特征误匹配的可观测度检测法,不仅适用于行星着陆任务中,也适用于小天体着陆任务;同时本发明对基于陨石坑边缘椭圆曲线的绝对导航系统仍然适用。
附图说明
图1为陨石坑特征误匹配的可观测度检测法流程图;
图2为陨石坑特征是否存在误匹配时的λ9/λ8大小对比图;
图3为陨石坑特征是否存在误匹配时的λ9大小对比图。
具体实施方式
为了更好的说明本发明的目的和优点,下面结合附图和实例对发明内容做进一步说明。
实施例1:
本实施例公开的一种陨石坑特征误匹配的可观测度检测法,具体步骤如下:
步骤1:建立基于陨石坑边缘椭圆曲线的观测模型。
在着陆过程中,给定相邻下降图像中4对初步匹配的陨石坑。则利用两幅相邻图像中任意两对初步匹配的陨石坑在着陆器本体坐标系下(与相机坐标系重合)建立着陆器的相对运动约束方程为:
其中,i<j且∈{1,2,3,4};矩阵Ai,Aj分别表示着陆器在位置cλ-1时两个陨石坑像的边缘椭圆曲线,其中λ=2,3,…;矩阵Bi,Βj分别表示着陆器在位置cλ时两个陨石坑像的边缘椭圆曲线;且矩阵Ai,Aj,Bi,Bj都为3×3的非奇异对称矩阵;矩阵H为3×3单应矩阵,表示着陆器的相对运动参数,满足:
式中向量表示着陆器在不同位置处的相对位置;矩阵表示着陆器在不同位置处的相对姿态;表示天体表面在着陆器本体坐标系下的单位法向量;表示天体表面距离着陆器本体坐标系原点的垂直距离。
结合着陆器相对运动约束方程(8),利用矩阵的克罗内克积建立关于着陆器相对位姿的观测模型为:
E54×9h=0 (10)
其中,为基于陨石坑边缘椭圆曲线的观测矩阵。两幅相邻图像中任一对陨石坑边缘椭圆曲线的观测矩阵为, ΔA和ΔB分别表示两幅相邻图像中的陨石坑边缘椭圆曲线噪声,其中噪声矩阵ΔA和ΔB的大小可由经验给出。此后,为避免使用过多符号,观测矩阵仍用A,B表示。则观测矩阵E中的分块矩阵Ei,j表示为矩阵I为3×3的单位矩阵;向量h为单应矩阵H的向量化形式。
步骤2:对观测矩阵E进行可观测度分析,得到可观测度的度量标准。
结合式(8)和式(10),观测矩阵E中存在的噪声表示为:
其中ΔEi,j为噪声矩阵ΔE中的分块矩阵,满足ΔAi,j和ΔBi,j分别满足:
其中i<j且∈{1,2,3,4}。
根据特征值分解的线性误差传播理论得到相对运动参数的估计误差Δh为:
Δh=GΛGT(ΔETΕ+ETΔE)h (13)
其中矩阵G为标准正交矩阵,满足 表示ETE的特征值;矩阵Λ满足:λ1,λ2,…,λ9是观测矩阵E的奇异值,且满足λ1≥λ2≥…≥λ9≥0。
当测量数据无误差时,λ9=0。当测量数据存在误差时,矩阵ETE的最小特征值的扰动误差由下式得出:
其中向量g9是特征值对应的单位特征向量。
基于以上分析,取λ9/λ8和观测矩阵奇异值λ9作为衡量导航系统可观测度的度量标准。从式(13)和(14)可以看出,λ9/λ8的值趋近于1,或者如果观测矩阵奇异值λ9远大于其扰动误差估计值估计误差较大,则导航系统是不可观的,从而说明导航系统存在误匹配。
步骤3:基于步骤2得到的可观测度的度量标准进行可观测度判断,进而剔除陨石坑误匹配,直至导航系统可观。
给定4对初始匹配的陨石坑特征对,设定阈值和ε2=0.1,对陨石坑误匹配进行剔除方法包括如下步骤:
步骤3.1:若λ9≤ε1,且λ9/λ8≤ε2,则认为步初始匹配的陨石坑特征对匹配正确;若λ9>ε1,或λ9/λ8>ε2,则认为初始匹配的陨石坑特征对存在误匹配,导航系统不可观。
步骤3.2:当导航系统不可观时,令矩阵[E]k表示观测矩阵E删除第k个陨石坑特征对的子矩阵,其中k=1,2,3,4,分别判断观测矩阵[E]k的可观测度λ9和λ9/λ8,若导航系统可观,则认为第k个陨石坑特征对为误匹配;若导航系统仍不客观,说明存在的陨石坑误匹配对数大于1,需引入新的陨石坑特征对进行误匹配剔除,直至导航系统可观。
在matlab环境下,对陨石坑存在一对误匹配和匹配正确时的导航系统可观测度度量标准的大小分别进行对比分析,循环次数为500次,仿真结果如图2和图3所示。图2表示陨石坑特征是否存在误匹配时的λ9/λ8大小对比图;图3表示陨石坑特征是否存在误匹配时的λ9大小对比图。仿真结果表明,陨石坑存在误匹配时的导航可观测度λ9/λ8和λ9大小与匹配正确时的可观测度大小对比变化明显,因此可以选用λ9/λ8和λ9作为度量标准检测和剔除陨石坑误匹配,提到导航系统精度。
以上所述的具体描述,对发明的目的、技术方案和有益效果进行了进一步详细说明,所应理解的是,以上所述仅为本发明的具体实施例而已,并不用于限定本发明的保护范围,凡在本发明的精神和原则之内,所做的任何修改、等同替换、改进等,均应包含在本发明的保护范围之内。
Claims (4)
1.一种陨石坑特征误匹配的可观测度检测法,其特征在于:包括如下步骤,
步骤1:建立基于陨石坑边缘椭圆曲线的观测模型;
在着陆过程中,给定下降图像中n对初步匹配的陨石坑,且n≥3;则利用两幅下降图像中任意两对初步匹配的陨石坑在着陆器本体坐标系下建立着陆器的相对运动约束方程为:
<mrow>
<mo>(</mo>
<msubsup>
<mi>B</mi>
<mi>j</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>B</mi>
<mi>i</mi>
</msub>
<mo>)</mo>
<mi>H</mi>
<mo>=</mo>
<mi>H</mi>
<mo>(</mo>
<msup>
<msub>
<mi>A</mi>
<mi>j</mi>
</msub>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<msub>
<mi>A</mi>
<mi>i</mi>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,i<j且∈{1,2,…,n};矩阵Ai,Aj分别表示着陆器在位置cλ-1时两个陨石坑像的边缘椭圆曲线,其中λ=2,3,…;矩阵Bi,Βj分别表示着陆器在位置cλ时两个陨石坑像的边缘椭圆曲线;且矩阵Ai,Aj,Bi,Bj都为3×3的非奇异对称矩阵;矩阵H为3×3单应矩阵,表示着陆器的相对运动参数,满足:
<mrow>
<mi>H</mi>
<mo>=</mo>
<msubsup>
<mi>R</mi>
<msub>
<mi>c</mi>
<mi>&lambda;</mi>
</msub>
<msub>
<mi>c</mi>
<mrow>
<mi>&lambda;</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</msubsup>
<mo>+</mo>
<msubsup>
<mi>t</mi>
<msub>
<mi>c</mi>
<mi>&lambda;</mi>
</msub>
<msub>
<mi>c</mi>
<mrow>
<mi>&lambda;</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</msubsup>
<msubsup>
<mi>n</mi>
<msub>
<mi>c</mi>
<mrow>
<mi>&lambda;</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
<mi>T</mi>
</msubsup>
<mo>/</mo>
<msub>
<mi>d</mi>
<msub>
<mi>c</mi>
<mrow>
<mi>&lambda;</mi>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msub>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
式中向量表示着陆器在不同位置处的相对位置;矩阵表示着陆器在不同位置处的相对姿态;表示天体表面在着陆器本体坐标系下的单位法向量;表示天体表面距离着陆器本体坐标系原点的垂直距离;
结合着陆器相对运动约束方程(1),利用矩阵的克罗内克积建立关于着陆器相对位姿的观测模型为:
E9n(n-1)/2×9h=0 (3)
其中,为基于陨石坑边缘椭圆曲线的观测矩阵;两幅下降图像中任一对陨石坑边缘椭圆曲线的观测矩阵为 ΔA和ΔB分别表示两幅下降图像中的陨石坑边缘曲线噪声,其中噪声矩阵ΔA和ΔB的大小预先给定;此后,为避免使用过多符号,观测矩阵 仍用A,B表示;则观测矩阵E中的分块矩阵Ei,j表示为矩阵I为3×3的单位矩阵;向量h为单应矩阵H的向量化形式;
步骤2:对观测矩阵E进行可观测度分析,得到可观测度的度量标准;
结合式(1)和式(3),观测矩阵E中存在的噪声表示为:
<mrow>
<mi>&Delta;</mi>
<mi>E</mi>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msubsup>
<mi>&Delta;E</mi>
<mrow>
<mn>1</mn>
<mo>,</mo>
<mn>2</mn>
</mrow>
<mi>T</mi>
</msubsup>
<mo>,</mo>
<msubsup>
<mi>&Delta;E</mi>
<mrow>
<mn>1</mn>
<mo>,</mo>
<mn>3</mn>
</mrow>
<mi>T</mi>
</msubsup>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msubsup>
<mi>&Delta;E</mi>
<mrow>
<mn>1</mn>
<mo>,</mo>
<mi>n</mi>
</mrow>
<mi>T</mi>
</msubsup>
<mo>,</mo>
<mo>...</mo>
<mo>,</mo>
<msubsup>
<mi>&Delta;E</mi>
<mrow>
<mi>n</mi>
<mo>-</mo>
<mn>1</mn>
<mo>,</mo>
<mi>n</mi>
</mrow>
<mi>T</mi>
</msubsup>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
其中ΔEi,j为噪声矩阵ΔE中的分块矩阵,满足ΔAi,j和ΔBi,j分别满足:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&Delta;A</mi>
<mrow>
<mi>i</mi>
<mo>,</mo>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<msubsup>
<mi>A</mi>
<mi>j</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msubsup>
<mi>&Delta;AA</mi>
<mi>j</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>A</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>A</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<mi>&Delta;</mi>
<mi>A</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>&Delta;B</mi>
<mrow>
<mi>i</mi>
<mo>,</mo>
<mi>j</mi>
</mrow>
</msub>
<mo>=</mo>
<msubsup>
<mi>B</mi>
<mi>j</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msubsup>
<mi>&Delta;BB</mi>
<mi>j</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<msub>
<mi>B</mi>
<mi>j</mi>
</msub>
<mo>-</mo>
<msub>
<mi>B</mi>
<mi>i</mi>
</msub>
<mo>-</mo>
<mi>&Delta;</mi>
<mi>B</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
其中i<j且∈{1,2,…,n};
根据特征值分解的线性误差传播理论得到相对运动参数的估计误差Δh为:
Δh=GΛGT(ΔETΕ+ETΔE)h (6)
其中矩阵G为标准正交矩阵,满足 表示ETE的特征值;矩阵Λ满足:λ1,λ2,…,λ9表示观测矩阵E的奇异值,且满足λ1≥λ2≥…≥λ9≥0;
当测量数据无误差时,λ9=0;当测量数据存在误差时,矩阵ETE的最小特征值的扰动误差由下式得出:
<mrow>
<msubsup>
<mi>&Delta;&lambda;</mi>
<mn>9</mn>
<mn>2</mn>
</msubsup>
<mo>=</mo>
<msubsup>
<mi>g</mi>
<mn>9</mn>
<mi>T</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msup>
<mi>&Delta;E</mi>
<mi>T</mi>
</msup>
<mi>E</mi>
<mo>+</mo>
<msup>
<mi>E</mi>
<mi>T</mi>
</msup>
<mi>&Delta;</mi>
<mi>E</mi>
<mo>)</mo>
</mrow>
<msub>
<mi>g</mi>
<mn>9</mn>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
其中向量g9是特征值对应的单位特征向量;
基于以上分析,取λ9/λ8和观测矩阵奇异值λ9作为衡量导航系统可观测度的度量标准;从式(6)和(7)看出,λ9/λ8的值趋近于1,或者如果观测矩阵奇异值λ9的平方远大于其扰动误差估计值运动参数估计误差较大,则导航系统是不可观的,从而说明导航系统存在误匹配;
步骤3:基于步骤2得到的可观测度的度量标准进行可观测度判断,进而剔除陨石坑误匹配,直至导航系统可观。
2.如权利要求1所述的一种陨石坑特征误匹配的可观测度检测法,其特征在于:步骤3具体实现方法为,
给定n(n≥3)对初始匹配的陨石坑特征对,设定阈值ε1和ε2,对陨石坑误匹配进行剔除方法包括如下步骤,
步骤3.1:当n=3时,若λ9≤ε1,且λ9/λ8≤ε2,则认为初始匹配的陨石坑特征对匹配正确;若λ9>ε1,或λ9/λ8>ε2,则认为初始匹配的陨石坑特征对存在误匹配,导航系统不可观,此时误匹配剔除后,陨石坑特征对数n<3,导航系统仍不可观,需引入新的陨石坑特征对进行误匹配剔除,转入步骤3.2;
步骤3.2:当n>3时,若λ9≤ε1,且λ9/λ8≤ε2,则认为初始匹配的陨石坑特征对匹配正确;若λ9>ε1,或λ9/λ8>ε2,则认为初始匹配的陨石坑特征对存在误匹配,导航系统不可观,令矩阵[E]k表示观测矩阵E删除第k个陨石坑特征对的子矩阵,其中k=1,2,…,n,分别判断观测矩阵[E]k的可观测度λ9和λ9/λ8,若导航系统可观,则认为第k个陨石坑特征对为误匹配,反之,根据观测矩阵[E]k中新的陨石坑特征对数n的大小重复迭代步骤3.1、步骤3.2,直至满足λ9≤ε1,且λ9/λ8≤ε2,导航系统可观,即实现对陨石坑特征误匹配的可观测度分析检测,提高导航系统精度,保证导航系统的稳定性。
3.如权利要求1或2所述的一种陨石坑特征误匹配的可观测度检测法,其特征在于:步骤1中两幅下降图像选两幅相邻下降图像。
4.如权利要求1或2所述的一种陨石坑特征误匹配的可观测度检测法,其特征在于:步骤1中噪声矩阵ΔA和ΔB的大小预先给定通过由经验给定。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710844456.XA CN107703522B (zh) | 2017-09-19 | 2017-09-19 | 一种陨石坑特征误匹配的可观测度检测法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710844456.XA CN107703522B (zh) | 2017-09-19 | 2017-09-19 | 一种陨石坑特征误匹配的可观测度检测法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107703522A true CN107703522A (zh) | 2018-02-16 |
CN107703522B CN107703522B (zh) | 2020-10-16 |
Family
ID=61172887
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710844456.XA Active CN107703522B (zh) | 2017-09-19 | 2017-09-19 | 一种陨石坑特征误匹配的可观测度检测法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107703522B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101762274A (zh) * | 2010-02-01 | 2010-06-30 | 北京理工大学 | 基于观测条件数的深空探测器自主定位路标选取方法 |
CN102968795A (zh) * | 2012-12-03 | 2013-03-13 | 哈尔滨工业大学 | 基于阴影面积与外廓面积比值的陨石坑误匹配判断方法 |
CN105865459A (zh) * | 2016-03-31 | 2016-08-17 | 北京理工大学 | 一种考虑视线角约束的小天体接近段制导方法 |
CN106323271A (zh) * | 2016-08-01 | 2017-01-11 | 北京理工大学 | 基于特征奇异值的航天器相对姿态测量矢量选取方法 |
CN107144278A (zh) * | 2017-04-24 | 2017-09-08 | 北京理工大学 | 一种基于多源特征的着陆器视觉导航方法 |
-
2017
- 2017-09-19 CN CN201710844456.XA patent/CN107703522B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101762274A (zh) * | 2010-02-01 | 2010-06-30 | 北京理工大学 | 基于观测条件数的深空探测器自主定位路标选取方法 |
CN102968795A (zh) * | 2012-12-03 | 2013-03-13 | 哈尔滨工业大学 | 基于阴影面积与外廓面积比值的陨石坑误匹配判断方法 |
CN105865459A (zh) * | 2016-03-31 | 2016-08-17 | 北京理工大学 | 一种考虑视线角约束的小天体接近段制导方法 |
CN106323271A (zh) * | 2016-08-01 | 2017-01-11 | 北京理工大学 | 基于特征奇异值的航天器相对姿态测量矢量选取方法 |
CN107144278A (zh) * | 2017-04-24 | 2017-09-08 | 北京理工大学 | 一种基于多源特征的着陆器视觉导航方法 |
Non-Patent Citations (3)
Title |
---|
LIU YUFEI ET AL.: "Observability Analysis of Deep-space Autonomous Navigation System", 《2006 CHINESE CONTROL CONFERENCE》 * |
冯军华 等: "行星表面陨石坑检测与匹配方法", 《航空学报》 * |
崔平远 等: "基于可观测性分析的深空自主导航方法研究", 《宇航学报》 * |
Also Published As
Publication number | Publication date |
---|---|
CN107703522B (zh) | 2020-10-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Arrigoni et al. | Robust synchronization in SO (3) and SE (3) via low-rank and sparse matrix decomposition | |
CN107063228B (zh) | 基于双目视觉的目标姿态解算方法 | |
Li et al. | A 4-point algorithm for relative pose estimation of a calibrated camera with a known relative rotation angle | |
US8837811B2 (en) | Multi-stage linear structure from motion | |
CN102651132B (zh) | 一种基于交叉视觉皮质模型的医学图像配准方法 | |
US20130129154A1 (en) | Methods and Apparatus for Detecting Poorly Conditioned Points in Bundle Adjustment | |
CN103761768A (zh) | 一种三维重建的立体匹配方法 | |
CN111145232A (zh) | 一种基于特征信息变化度的三维点云自动配准方法 | |
CN107516322A (zh) | 一种基于对数极空间的图像物体大小和旋转估计计算方法 | |
CN109766903B (zh) | 一种基于曲面特征的点云模型曲面匹配方法 | |
CN103679720A (zh) | 一种基于小波分解与Harris角点检测的快速图像配准方法 | |
CN105488541A (zh) | 增强现实系统中基于机器学习的自然特征点识别方法 | |
Dor et al. | Visual SLAM for asteroid relative navigation | |
CN104406594A (zh) | 交会对接航天器相对位姿的测量算法 | |
Liang et al. | Hand-eye calibration with a new linear decomposition algorithm | |
CN107273877B (zh) | 加权的多尺度复合窗指纹方向场建立方法及分级平滑算法 | |
CN101295401A (zh) | 基于线性pca的红外点目标检测方法 | |
Sundaresan et al. | Robustness of change detection algorithms in the presence of registration errors | |
CN107703522B (zh) | 一种陨石坑特征误匹配的可观测度检测法 | |
CN112652003A (zh) | 一种基于ransac测度优化的三维点云配准方法 | |
Campa et al. | A comparison of pose estimation algorithms for machine vision based aerial refueling for UAVs | |
KR101528757B1 (ko) | 이분된 로컬 영역을 가지는 윤곽선 분할 기반 특징을 이용한 물체 인식 방법 | |
CN105184327A (zh) | 一种基于顶点三分策略的遥感图像特征点匹配方法 | |
CN115457127A (zh) | 基于特征观测数和imu预积分的自适应协方差方法 | |
Zhang et al. | Vision-based pose estimation for space objects by Gaussian process regression |
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 |