【技术实现步骤摘要】
惯性/多维视觉联合定位方法
[0001]本专利技术属于惯性
/
视觉导航
,涉及一种惯性
/
多维视觉联合定位方法,尤其是一种面向城市场景的惯性
/
多维视觉联合定位方法
。
技术介绍
[0002]随着科技的智能化发展,面向无人设备的自主导航技术逐渐成为导航领域内的热门研究方向
。
传统方法多依赖于卫星获取实时的位置完成定位
。
但是在楼宇
、
巷道
、
室内等典型城市复杂环境中,卫星拒止频发,传统基于卫星的定位技术受到很多制约,
GPS
装备甚至无法正常工作
。
[0003]随着视觉传感器技术
、
计算机技术和人工智能技术的迅速发展,基于计算机视觉的识别定位技术作为一种新的导航方式,视觉导航开始在自主导航领域占据一席之地
。
视觉传感器具有隐蔽性
、
轻便
、
低功耗和价格低廉等特点,因此利用视觉传感器进 ...
【技术保护点】
【技术特征摘要】 【专利技术属性】
1.
一种惯性
/
多维视觉联合定位方法,其特征在于,所述联合定位方法包括:提取点特征并完成点特征匹配;提取线特征并完成线特征匹配;构造最小化重投影模型,根据所述点特征和线特征的匹配,获取相机位姿;进行惯性预积分计算,构造视觉点线
‑
惯性联合优化模型;完成视觉点线
‑
惯性联合优化模型的雅克比矩阵计算和状态更新,更新相机位姿
、
三维地图点坐标
。2.
根据权利要求1所述的一种惯性
/
多维视觉联合定位方法,其特征在于,采用参数优化的
LSD
线特征提取方法提取线特征,其中,所述
LSD
线特征提取方法中,设计
s
=
0.5,d
=
0.6
,其中,
s
为尺度参数,用于缩放各层金字塔图像,
d
为最小密度阈值,代表区域生长拟合矩形框内最少点的数量
。3.
根据权利要求1或2所述的一种惯性
/
多维视觉联合定位方法,其特征在于,所述
LSD
的线特征提取方法还包括:设置最短线长阈值其中
W
I
和
H
I
分别表示图像的宽和高,
η
为比例参数;设计检测直线段的长度低于所述阈值时被过滤
。4.
根据权利要求3所述的一种惯性
/
多维视觉联合定位方法,其特征在于,对提取得到的线特征还进行如下处理:若相邻的直线段在同一条直线上,即满足
S1(l1,l2)
·
S2(l1,l2)≥1
,则将相邻的直线段进行线段的合并;其中,其中,
S2(l1,l2)
表示距离相似性,
S1(l1,l2)
表示方向一致性,
∠(l1,l2)
表示直线段的角度差异,
d
max
(l1,l2)
表示直线段端点到另一直线段所在直线的最大距离,
σ
a
和
σ
p
是设置的标准差
。5.
根据权利要求4所述的一种惯性
/
多维视觉联合定位方法,其特征在于,对提取得到的特征点还进行如下筛选:对于线段端点构成的像素点矩形区域进行判定,如果存在特征点位于特征线上,则剔除冗杂的特征点
。6.
根据权利要求4所述的一种惯性
/
多维视觉联合定位方法,其特征在于,采用下述方法进行线特征匹配:基于所提取的线特征,采用改进的线特征匹配方法,基于几何约束辅助描述子匹配完成特征匹配,并剔除误匹配,包括:初步建立线匹配集合;采用双向最近邻结合比例测试的方式,选取出最优匹配线段;基于筛选出的最优匹配线段,通过衡量其他线匹配对此线特征对应地图线的支持,进一步剔除误匹配
。7.
根据权利要求6所述的一种惯性
/
多维视觉联合定位方法,其特征在于,采用双向最
近邻结合比例测试的方式,选取出最优匹配线段,具体包括:
1)
将第
i
关键帧的第
m
条检测直线段记作计算在第
j
关键帧上的最近邻线段特征和次优最近邻线段特征
2)
进行比例测试,分别计算两个线段特征描述子的距离,并判断是否具备较大的差异,若则,判定具备较大的差异,将记为优选匹配线段,其中
ρ
为比例阈值,
d
代表两个特征描述子距离;
3)
对步骤
2)
得到的优选匹配线段的进行最优距离筛选,判断是否满足
D
max
为特征距离的上限,若满足,则将使记为的最优匹配线段;
4)
按照步骤
1)
~
3)
方法筛选出所有最优线段匹配对
。8.
根据权利要求7所述的一种惯性
/
多维视觉联合定位方法,其特征在于,所述基于筛选出的最优匹配线段,通过衡量其他线匹配对此线特征对应地图线的支持,进一步剔除误匹配,具体包括:对于任意筛选出的最优线匹配对经过三角化获得地图线记作假设存在线匹配将投影至第
k
关键帧,得到投影直线段并衡量投影直线段与的相似度,若满足时,认为匹配对提供了支持;其中,函数
S1()
代表角度相似度,函数
S2()
代表位置相似性;为第
k
关键帧的的最优匹配线段;设计线匹配对在5个关键帧之内至少具有2票支持才被认为是正确匹配,否则被视作误匹配而删除相应匹配对和地图线
。9.
根据权利要求8所述的一种惯性
/
多维视觉联合定位方法,其特征在于,通过下述方式设计函数
S1()
和函数
S2()
:假设两条直线段
l1和
l2,其中,该两条直线段满足:其中,
∠(l1,l2)
技术研发人员:尚克军,李至,焦浩,李茜茜,明丽,王大元,赵亮,赵宇飞,扈光锋,徐策,刘崇亮,
申请(专利权)人:北京自动化控制设备研究所,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。