CN102052925A - 基于空间关系约束的适配区景象匹配方法 - Google Patents

基于空间关系约束的适配区景象匹配方法 Download PDF

Info

Publication number
CN102052925A
CN102052925A CN 201010598599 CN201010598599A CN102052925A CN 102052925 A CN102052925 A CN 102052925A CN 201010598599 CN201010598599 CN 201010598599 CN 201010598599 A CN201010598599 A CN 201010598599A CN 102052925 A CN102052925 A CN 102052925A
Authority
CN
China
Prior art keywords
scene matching
spatial relationship
constraint
prime
triangle
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.)
Pending
Application number
CN 201010598599
Other languages
English (en)
Inventor
赵春晖
李耀军
李军伟
禹亮
曲圣杰
潘泉
梁彦
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Northwestern Polytechnical University
Original Assignee
Northwestern Polytechnical University
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Northwestern Polytechnical University filed Critical Northwestern Polytechnical University
Priority to CN 201010598599 priority Critical patent/CN102052925A/zh
Publication of CN102052925A publication Critical patent/CN102052925A/zh
Pending legal-status Critical Current

Links

Images

Landscapes

  • Navigation (AREA)

Abstract

本发明涉及一种基于空间关系约束的适配区景象匹配方法,技术特征在于:以无人机定位导航为应用背景,将多区域空间关系约束引入到适配区,提出了一种基于空间关系约束的适配区景象匹配方法。本方法首先将传统的单区域分裂为多区域进行景象匹配,然后采用基于边缘测度的加权Hausdorff景象匹配方法,运用分布式并行景象匹配计算提高景象匹配的实时性,通过对多匹配区空间关系约束的计算以及最优配准点坐标的估计,最后解算出实时图中心在基准图上的精确定位。本发明方案与传统方法相比,不仅增强了景象匹配的鲁棒性,而且符合无人机实时景象匹配复杂性工作环境对景象匹配实时性要求,对于景象匹配工程实际应用具有非常重要的意义。

Description

基于空间关系约束的适配区景象匹配方法
技术领域
本发明涉及一种在强干扰复杂环境下,抗电子干扰能力强的景象匹配方法,是一项应用无人机景象匹配的分析方法。
背景技术
景象匹配导航系统可作为卫星导航失效时的一种有效替代方式,也可以辅助INS克服陀螺漂移带来的误差。无人机任务的复杂性对导航系统的准确性和可靠性提出了更高要求,促使导航系统向综合化和容错化方向发展。由于卫星导航信号功率很弱,极易受到电磁干扰和欺骗,接收机数据更新率较低。因此,在强干扰复杂环境下单独使用卫导航系统并不可靠,且难以满足瞬息万变的战场对导航系统实时测量与控制的要求。研究抗电子干扰能力强、不依赖气象条件、可昼夜工作、寂静(低截获概率)的景象匹配导航具有重要的理论意义和国防应用价值。
发明内容
本发明涉及一种无人机景象匹配方法。本方案以无人机定位导航为应用背景,将多区域空间关系约束引入到适配区,提出了一种基于空间关系约束的适配区景象匹配(SA-SRCSM)方法。本发明方案与传统方法相比,不仅增强了景象匹配的鲁棒性,而且符合无人机实时景象匹配复杂性工作环境对景象匹配实时性要求,对于景象匹配工程实际应用具有非常重要的意义。
本发明中基于基于空间关系约束的适配区景象匹配方法包括如下步骤:
第一步,对实时图进行预处理,为景象匹配作准备:
1、利用INS的位置信息截取基准图中相应数据,利用INS的姿态信息对实时图进行几何校正。
2、利用无人机平台高度计对实时图进行尺度校正,使得当前实时图在尺度、旋转方面与基准图相近,便于后期的景象匹配。
第二步,选择多区域空间关系的约束,采用分布式并行计算策略,进行多区域空间约束计算:
1、在景象匹配区域数目给定的情况下,选择所有的独立空间关系约束,以达到充分利用各个匹配区域的配准信息的目的;
2、由于各个匹配区相互独立、计算过程互不影响,可采用分布式并行计算策略,减少配准时间消耗,提高景象匹配的实时性;
3、通过确定的空间关系约束,由某一个顶点坐标计算构成已知三角形的其他两个顶点的坐标;
第三步,对最优配准点进行估计,并修正配准点坐标,输出精确定位信息:
1、针对各区域景象匹配结果,计算三角形空间关系约束的各个顶点坐标与其估计坐标在赋范空间的二范数,通过比较选择“空间距离”最近的配准点作为三角形空间关系约束的最终配准点;
2、在基准图上通过缩小搜索范围重匹配并利用历史配准信息对实时图中心坐标进行修正。
3、输出SRC-SRPSM框架对无人机当前位置的精确定位坐标。
附图说明
图1为SA-SRCSM框架流程图。
图2为多区域空间关系。
图3为多区域空间关系约束模型。
图4为直线型三角形SA-SRCSM框架原理图解。
图5为三角形SA-SRCSM框架原理图解。
具体实施方式
以下对本发明方法作进一步具体的描述。
如图1所示的SA-SRCSM框架流程图,各部分具体实施细节如下:
1、实时图预处理
1.1灰度校正
实测图不可避免会带有噪音,一般的方法都能抵抗一定范围内的噪音,但噪音污染超过一定限度,匹配的精度就不能得到保证。采用直方图均衡化来进行灰度校正,消除图像灰度值过于集中的问题,使得图像灰度的分布分散,景物间的界线鲜明、对比度增强。采用小波滤波工具将图像进行分解,滤除高频噪声,增强图像边缘特征。
1.2几何校正
假设摄像机固定安装在无人机下,光心与飞机质心重合,摄像机坐标系与体轴系重合(实际情况中,考虑光电平台姿态信息只需再进行一次旋转矩阵变换);采用前投影模型对成像过程进行描述。若当前无人机的俯仰角为θ、偏航角
Figure BSA00000393247100031
滚转角为ψ。
OXYZ为机体坐标轴系,简称体轴系。OXgYgZg为飞机铅垂地面坐标轴系。OXdYdZd为当地水平坐标系,其坐标轴方向与OXgYgZg坐标轴同向。铅垂地面固定坐标轴系与机体坐标轴系的坐标变换关系为
X Y Z = R X g Y g Z g - - - ( 1 - 1 )
R = 1 0 0 0 cos φ sin φ 0 - sin φ cos φ cosθ 0 - sin θ 0 1 0 sin θ 0 cos θ cos ψ sin ψ 0 - sin ψ cos ψ 0 0 0 1 - - - ( 1 - 2 )
= cos θ cos ψ cos θ sin ψ - sin θ sin φ sin θ cos ψ - cos φ sin ψ sin φ sin θ sin ψ + cos φ cos ψ sin φ cos θ cos φ sin θ cos ψ + sin φ sin ψ cos φ sin θ sin ψ - sin φ cos ψ cos φ cos θ
根据透视成像模型,实际像平面坐标为:
x = f X Z y = f Y Z - - - ( 1 - 3 )
式中f为相机焦距。矫正后像平面坐标为:
x g = f X g Z g y g = f Y g Z g - - - ( 1 - 4 )
假设
R - 1 = r 11 r 12 r 13 r 21 r 22 r 23 r 31 r 32 r 33 - - - ( 1 - 5 )
则实际像平面坐标到矫正后像平面坐标的坐标变换关系为:
x g = f r 11 x + r 12 y + r 13 f r 13 x + r 32 y + r 33 f y g = f r 21 x + r 22 y + r 23 f r 31 x + r 32 y + r 33 f - - - ( 1 - 6 )
2、多区域空间关约束方法
2.1多区域空间关约束的选择
假设中心点坐标为P0(x0,y0),四邻域匹配点坐标逆时针顺序为P1(x1,y1),P2(x2,y2),P3(x3,y3),P4(x4,y4)。多区域之间的空间关系如图2所示。由点P0,P1,P2,P3,P4可组成直线、三角形、矩形等,其空间关系由相应的直线、三角形、矩形来描述。
实际匹配中由于存在配准误差,原本在一条直线上的三个配准点通常不在一条直线上而是构成了三角形,称为直线型三角形。由于矩形不如三角形稳定,对于SA-SRCSM框架多区域空间关系约束模型选择了三角形,图3显示了五个匹配区构成的所有三角形空间关系。
2.2多区域空间关系约束数目的选择
对于匹配区数目已经确定的情况,通过排列组合计算的三角形空间关系约束,由于这些三角形很多是共边的,称为“冗余空间关系约束”。对于只共用一个顶点的两个三角形构成的空间关系约束称为“独立空间关系约束”。对于三个匹配区将只有一组“独立空间关系约束”,而对于五个匹配区,将计算出五个配准点,最多只能构成两个独立三角形,即构成两组“独立空间关系约束”。随着空间关系约束数目的增加景象匹配的配准精度未必随之提高,配准精度的提高随着“独立空间关系约束”数目的增加有所提高,而几乎不受“冗余空间关系约束”数目增加的影响。
2.3多区域空间关系约束
选择了五个匹配区进行并行景象匹配,下文将对各匹配区之间的空间关系约束进行详细讨论。
(1)直线型三角形空间关系约束
直线型三角形空间关系约束一共两组:第一组由点P1(x1,y1),P0(x0,y0),P3(x3,y3)构成,第二组由点P2(x2,y2),P0(x0,y0),P4(x4,y4)构成。下面以第一组为例详述SA-SRCSM框架原理。
假设P1,P0,P3为先验配准点,P′1,P′0,P′3为并行景象匹配配准点。分别以P′1,P′0,P′3为顶点按照先验配准点的空间关系约束,计算其余两个配准点的坐标。基于直线型三角形的SA-SRCSM框架原理图解如图4所示。
图4中,P′1,P′0,P′3先验空间关系为
P 0 ( x , y ) = 1 2 [ P 1 ( x , y ) + P 3 ( x , y ) ] - - - ( 2 - 1 )
由于多匹配区的长和宽在景象匹配前已预先确定,故以P′1点为参考的P′1,P′0,P′3的先验空间关系计算表达式为
g 10 : x P 0 = x P 1 + Width / 2 y P 0 = y P 1 + Height / 2 - - - ( 2 - 2 )
g 13 : x P 3 = x P 1 + Width y P 3 = y P 1 + Height - - - ( 2 - 3 )
式中函数g表示构成先验空间关系约束的映射关系。
(2)三角形空间关系约束
假设P0,P1,P2经过并行景象匹配后的配准点分别为P′0,P′1,P′2,分别以P′1,P′0,P′3为顶点按照先验配准点的空间关系约束,计算其余两个配准点的坐标。基于三角形的SA-SRCSM框架原理图解如图5中(a)与(b)所示。
图2-4中,假设以P′1点为参考的P′0,P′1,P′2先验空间关系计算表达式为
g 10 : x P 0 = x P 1 + Width / 2 y P 0 = y P 1 + Height / 2 - - - ( 2 - 4 )
g 12 : x P 2 = x P 1 y P 2 = y P 1 + Height - - - ( 2 - 5 )
式中函数g表示构成先验空间关系约束的映射关系。
(3)最优配准点估计
假设并行景象匹配计算得到五个配准点在基准图上的坐标分别为P′0(X′0,Y′0),P′1(X′1,Y′1),P′2(X′2,Y′2),P′3(X′3,Y′3),P′4(X′4,Y′4),三角形空间关系约束参考模型为mi(i=1,...,k)。那么,对于构成第mi组三角形空间关系约束的三个配准点P′i(X′i,Y′i),P′j(X′j,Y′j),P′k(X′k,Y′k)分别以P′i(X′i,Y′i),P′j(X′j,Y′j),P′k(X′k,Y′k)为顶点,重构第mi组的先验三角形空间关系约束(详细图解如图2-3、图2-4所示)。假设新的配准点坐标为P″i(X″i,Y″i),P″j(X″j,Y″j),P″k(X″k,Y″k),则相应计算公式如下表述
P j ′ ′ ( X j ′ ′ , Y j ′ ′ ) = g ij ( P i ′ ( X i ′ , Y i ′ ) ) P k ′ ′ ( X k ′ ′ , Y k ′ ′ ) = g ik ( P i ′ ( X i ′ , Y i ′ ) ) - - - ( 2 - 6 )
P i ′ ′ = ( X i ′ ′ , Y i ′ ′ ) = g ji ( P j ′ ( X j ′ , Y j ′ ) ) P k ′ ′ ( X k ′ ′ , Y k ′ ′ ) = g jk ( P j ′ ( X j ′ , Y j ′ ) ) - - - ( 2 - 7 )
P i ′ ′ ( X i ′ ′ , Y i ′ ′ ) = g ki ( P k ′ ( X k ′ , Y k ′ ) ) P j ′ ′ ( X j ′ ′ , Y j ′ ′ ) = g kj ( P k ′ ( X k ′ , Y k ′ ) ) - - - ( 2 - 8 )
式中函数g表示P′i(X′i,Y′i),P′j(X′j,Y′j),P′k(X′k,Y′k)构成先验空间关系约束的映射关系。
针对第mi组空间关系约束下的各区域景象匹配结果,根据(2-6)式,(2-7)式与(2-8)式计算出第mi组空间关系约束计算各先验配准点的估计坐标。通过计算各个估计坐标与相应的景象匹配结果在赋范空间的二范数,以此作为第mi组空间关系约束下的三个配准点误差dij,dik,djk,其计算公式分别表述如下:
d ij = Min { | | P i ′ - P i ′ ′ | | , | | P j ′ - P j ′ ′ | | } d ik = Min { | | P i ′ - P i ′ ′ | | , | | P k ′ - P k ′ ′ | | } d jk = Min { | | P j ′ - P j ′ ′ | | , | | P k ′ - P k ′ ′ | | } - - - ( 2 - 9 )
假设该组最终配准点估计误差为
Figure BSA00000393247100065
则其计算公式如下表述
d m i = Min { d ij , d ik , d jk } - - - ( 2 - 10 )
Figure BSA00000393247100072
作为第mi组空间关系约束的最终配准点估计误差。假设该组的配准点估计误差在K组空间关系约束中符合全局最小,则由
Figure BSA00000393247100074
反推P″i(X″i,Y″i),P″j(X″j,Y″j),P″k(X″k,Y″k)点的坐标,进而计算出实时图的中心在基准图上的定位坐标
Figure BSA00000393247100075
对于k组空间关系约束,其最终配准点估计误差集合为
Figure BSA00000393247100076
由此计算实时图中心P0(x0,y0)在基准图上的定位坐标
Figure BSA00000393247100077
则计算公式如下:
Figure BSA00000393247100078
(i=1,2,...,k)  (2-11)
式中决策函数
Figure BSA00000393247100079
可根据景象匹配实际工作环境适当选择。针对实时图与基准图差异未知的情况,选择了最小化决策函数,计算公式如(2-12)式所示:
Figure BSA000003932471000710
(i=1,2,...,k)  (2-12)
Figure BSA000003932471000711
即为实时图中心坐标的最终估计结果。

Claims (1)

1.基于空间关系约束的适配区景象匹配方法,包括以下步骤:
A、实时图预处理与校正:先对实时图进行灰度校正,然后基于INS的位置信息在基准图中截取相应数据,利用INS的姿态信息对实时图进行几何校正,运用无人机平台高度计对实时图进行尺度校正,使得当前实时图在尺度、旋转方面与基准图相近,便于后期的景象匹配;
B、将单匹配区分裂成等面积的多区域:多区域空间关系约束分为两个层次:第一层为中心匹配区,第二层是四邻域匹配区,其空间位置分布于矩形的中心与四个顶点,这五个点作为配准点。实际匹配中由于存在配准误差,原本在一条直线上的三个配准点通常不在一条直线上而是构成了三角形,此处称为直线型三角形。由于矩形不如三角形稳定,此处选择了三角形,选择所有的独立空间关系约束,以达到充分利用各个匹配区域的配准信息的目的;
C、确定最终配准点:通过确定的空间关系约束,由某一个顶点坐标计算构成已知三角形的其他两个顶点的坐标,计算三角形空间关系约束的各个顶点坐标与其估计坐标在赋范空间的二范数,通过比较选择“空间距离”最近的配准点作为三角形空间关系约束的最终配准点;
D、对最优配准点进行估计,并修正配准点坐标,输出精确定位信息:
a.针对各区域景象匹配结果,计算三角形空间关系约束的各个顶点坐标与其估计坐标在赋范空间的二范数,通过比较选择“空间距离”最近的配准点作为三角形空间关系约束的最终配准点;
b.在基准图上通过缩小搜索范围重匹配并利用历史配准信息对实时图中心坐标进行修正;
c.输出当前位置的精确定位坐标。
CN 201010598599 2010-12-16 2010-12-16 基于空间关系约束的适配区景象匹配方法 Pending CN102052925A (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN 201010598599 CN102052925A (zh) 2010-12-16 2010-12-16 基于空间关系约束的适配区景象匹配方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN 201010598599 CN102052925A (zh) 2010-12-16 2010-12-16 基于空间关系约束的适配区景象匹配方法

Publications (1)

Publication Number Publication Date
CN102052925A true CN102052925A (zh) 2011-05-11

Family

ID=43957490

Family Applications (1)

Application Number Title Priority Date Filing Date
CN 201010598599 Pending CN102052925A (zh) 2010-12-16 2010-12-16 基于空间关系约束的适配区景象匹配方法

Country Status (1)

Country Link
CN (1) CN102052925A (zh)

Cited By (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102322864A (zh) * 2011-07-29 2012-01-18 北京航空航天大学 一种机载光学鲁棒景像匹配导航定位方法
CN102353377A (zh) * 2011-07-12 2012-02-15 北京航空航天大学 一种高空长航时无人机组合导航系统及其导航定位方法
CN103456014A (zh) * 2013-09-04 2013-12-18 西北工业大学 一种基于多特征整合视觉注意模型的景象匹配适配性分析方法
CN105004337A (zh) * 2015-08-19 2015-10-28 青岛科技大学 基于直线匹配的农用无人机自主导航方法
CN114509070A (zh) * 2022-02-16 2022-05-17 中国电子科技集团公司第五十四研究所 一种无人机导航定位方法

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
《计算机应用研究》 20101031 李耀军等 基于空间关系几何约束的无人机景象匹配导航 第3822-3825,3846页 1 第27卷, 第10期 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102353377A (zh) * 2011-07-12 2012-02-15 北京航空航天大学 一种高空长航时无人机组合导航系统及其导航定位方法
CN102353377B (zh) * 2011-07-12 2014-01-22 北京航空航天大学 一种高空长航时无人机组合导航系统及其导航定位方法
CN102322864A (zh) * 2011-07-29 2012-01-18 北京航空航天大学 一种机载光学鲁棒景像匹配导航定位方法
CN102322864B (zh) * 2011-07-29 2014-01-01 北京航空航天大学 一种机载光学鲁棒景像匹配导航定位方法
CN103456014A (zh) * 2013-09-04 2013-12-18 西北工业大学 一种基于多特征整合视觉注意模型的景象匹配适配性分析方法
CN105004337A (zh) * 2015-08-19 2015-10-28 青岛科技大学 基于直线匹配的农用无人机自主导航方法
CN105004337B (zh) * 2015-08-19 2017-12-08 青岛科技大学 基于直线匹配的农用无人机自主导航方法
CN114509070A (zh) * 2022-02-16 2022-05-17 中国电子科技集团公司第五十四研究所 一种无人机导航定位方法
CN114509070B (zh) * 2022-02-16 2024-03-15 中国电子科技集团公司第五十四研究所 一种无人机导航定位方法

Similar Documents

Publication Publication Date Title
US10878243B2 (en) Method, device and apparatus for generating electronic map, storage medium, and acquisition entity
US20200249032A1 (en) Apparatus and method for updating high definition map for autonomous driving
CN108802785A (zh) 基于高精度矢量地图和单目视觉传感器的车辆自定位方法
CN109900298A (zh) 一种车辆定位校准方法及系统
Xiao et al. Monocular vehicle self-localization method based on compact semantic map
CN104156968A (zh) 大面积地形复杂区域无人机序列影像快速无缝拼接方法
CN104748750A (zh) 一种模型约束下的在轨三维空间目标姿态估计方法及系统
CN104677361B (zh) 一种综合定位的方法
CN105203023A (zh) 一种车载三维激光扫描系统安置参数的一站式标定方法
CN114877883B (zh) 车路协同环境下考虑通信延迟的车辆定位方法及系统
CN112698664B (zh) 一种用于无人机集群协同导航优化的视线扇区动态估计方法
CN107300697A (zh) 基于无人机的运动目标ukf滤波方法
CN102052925A (zh) 基于空间关系约束的适配区景象匹配方法
CN111273312A (zh) 一种智能车辆定位与回环检测方法
CN104655135A (zh) 一种基于地标识别的飞行器视觉导航方法
CN106772516A (zh) 一种基于模糊理论的复合定位新方法
CN110441760A (zh) 一种基于先验地形图的大范围海底地形图拓展构图方法
He et al. Research on GNSS INS & GNSS/INS integrated navigation method for autonomous vehicles: A survey
CN101806905A (zh) 农业机械导航定位方法和装置
Yu et al. Automatic extrinsic self-calibration of mobile LiDAR systems based on planar and spherical features
CN115063465A (zh) 一种基于激光雷达的无人车行驶路况建模方法
CN102620745B (zh) 一种机载imu视准轴误差检校方法
CN103453875A (zh) 一种用于无人机俯仰角与滚转角实时计算方法
CN111964665B (zh) 基于车载环视图像的智能车定位方法、系统及存储介质
CN113552585A (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
C02 Deemed withdrawal of patent application after publication (patent law 2001)
WD01 Invention patent application deemed withdrawn after publication

Application publication date: 20110511