一种极坐标系下的激光雷达扫描匹配SLAM方法

一种极坐标系下的激光雷达扫描匹配SLAM方法
雷道竖;刘海波
flag标签抗体【摘 要】药盒激光雷达扫描匹配是创建室内地图以及实时导航的重要手段之一.提出一种极坐标系下激光雷达扫描匹配SLAM方法.该方法首先将室内周边环境面积表征为极坐标系下激光雷达测量角度和距离的函数形式,以此描述激光雷达在不同位置上的距离测量分布.考虑到室内环境中广泛存在的线段特性,通过线段检测的方式获取扫描数据中的若干线段特征.通过在极坐标系表征线段并优化目标函数求解相邻激光雷达扫描之间的相对变换关系从而实现室内地图创建和定位.最后,基于公共数据集进行了验证实验,证明了提出方法的有效性.
【期刊名称】《中国电子科学研究院学报》
【年(卷),期】安全二维码2019(014)006
【总页数】5页(P563-567)
【关键词】激光雷达;扫描匹配;极坐标系;线段
【作 者】雷道竖;刘海波
【作者单位】河南省航空物探遥感中心,河南郑州450053;常州机电职业技术学院,江苏常州 213164
【正文语种】中 文
【中图分类】TP24
氮化硅结合碳化硅制品0 引 言
近年来,激光雷达(Light Detection and Ranging, LIDAR)因其便利、快速、准确等优势,在航天、林业、气象等领域得以广泛应用[1-4]。随着智能机器人技术的发展,激光测距雷达在室内结构化未知环境的即时定位与地图构建(Simultaneous Localization and Mapping, SLAM)上发挥着越来越重要的作用[3-4]。
现有的SLAM技术主要可分为基于概率和基于扫描匹配的方法。其中,基于概率的方法包括基于卡尔曼滤波和基于粒子滤波的方法[5]。基于卡尔曼滤波的方法目前在SLAM技术中
应用最为广泛,但是随着时间状态维数的增加,该方法计算量显著增大,并且难以有效解决闭环回路问题。基于粒子滤波的算法能很好地适用于非线性模型,有效解决闭环回路问题,但是存在粒子重采样及粒子衰竭等问题。基于扫描匹配的SLAM算法较为简单,其基本思想是匹配相邻两帧扫描数据解算两者之间的2维姿态转换矩阵从而更新平台位置实现地图的创建与自主导航[6-7]。
制作简单机械
目前大部分的扫描匹配都是通过迭代实现的,如Interactive Closest Points (ICP)及其改进算法等[8]。ICP算法通常用于点与点的局部匹配,尽管许多学者对ICP算法进行了研究改进,但这些算法都需要通过最近邻搜索等方式预先构建有效的点集对应关系。进而在确定的对应关系的基础进行迭代,获取最优解。因此,基于ICP的方法运算量较大,实时性较差,限制了该方法在SLAM技术中的有效应用。
室内环境中存在广泛的直线段特性[6]。这些特性的引入和利用可以有效提高扫描匹配的效率和性能。文献[6]基于线段、角点等几何特征实现室内激光雷达的扫描匹配,取得了较好的效果。本文利用室内扫描数据中的线段特性,提出了一种极坐标系下的激光雷达扫描匹配方法。与以往在空间坐标系下的线段匹配方法不同,本文直接在极坐标下描述扫描数据
电玉粉中的线段特征以及构建最终的匹配代价函数。这种方法有效避免了空间坐标系下对点集的对应关系的要求。针对极坐标系下的扫描特性,采用周边环境面积函数进行描述。该函数描述了测量平台在室内不同位置时各个角度下的距离测量分布。最后,在极坐标系下通过相邻扫描之间的线段特性构建匹配代价函数。线段特性的引入使得最终需要优化的匹配代价函数具有良好的解析形式,从而大大提高了优化求解的效率和精度。通过优化目标函数,获得两幅扫描数据之间的2维姿态变换矩阵,实现未知环境中地图的更新和创建。实验中,基于公开数据集对提出方法进行了验证,证明了其有效性。
1 极坐标下的扫描匹配的基本思路
如图1所示,激光雷达可以采集平台在室内某一位置时不同角度的距离测量值。平台在室内某一位置向周围各个角度发射激光,从而测量其到各个方向最近障碍物的距离。这些距离值的分布实际上就反映了平台当前在室内所处的位置。因此,通过分析比对两幅相邻扫描数据在不同角度下的距离分布可以求解它们之间的相对位姿关系,从而更新平台的位置。为了便于求解,本文首先定义周围环境面积函数如公式(1)所示。
S=F(φ)dφ
(1)
其中F(φ)代表角度φ下的距离测量值;S为定义的周围环境面积。
此时,相邻扫描数据之间的匹配误差可以表示为:
E(Γ)=(F(φ)-F′(φ))2dφ
(2)
其中F′(φ)代表变换后的扫描结果。Γ代表两条扫描之间的姿态变换矩阵,采用仿射变换的形式,如公式(3)所示。
(3)
其中θ代表旋转角度;tx,ty分别代表位置偏移量。
理论上,通过对公式(2)中的目标函数进行优化即可求出最佳的变化矩阵。然而,直接对公式(2)进行优化收敛速度很慢,不利于实现实时的地图更新。并且,复杂的目标函数容易陷
入局部最优解,导致定位精度下降。因此,本文通过考察室扫描数据固有的线段特性提高优化求解的效率和精度。
图1 激光雷达扫描数据示意图
2 极坐标下的线段描述
室内激光雷达扫描数据广泛存在线段特征。这些线段可以通过直线检测的方法得以获取[6,9]。通过利用这些线段特性可以有效提高扫描匹配的效率和精度。在极坐标系下,直线可以采用如下形式表达:
(4)
其中l为该直线到坐标原点的距离;α代表直线与x轴的夹角。L(φ)表示扫描角度为φ时的距离测量值,函数定义域为假设一幅扫描数据包含n段线段,则其扫描距离值可以近似表达为如下形式:
(5)
对公式(4)中的线段按照公式(3)中的变换矩阵进行仿射变换可以得到:
(6)
公式(6)中的和分别表示变换后线段的距离和角度参数。
3 优化求解
通过考察室内扫描数据中的线段特性,将原始稠密的距离点的匹配问题转化为少量的线段的匹配问题。对于来源于相邻扫描数据中两段对应的线段Li和它们之间的部分匹配误差如公式(7)所示:
(7)
其中为两条直线的公共定义域。公式(7)可以展开为如下的解析形式:
(8)
其中Pi(φ)定义如下:
(9)
最终,两幅扫描数据的整体匹配误差定义为所有线段的部分匹配误差之后,如公式(10)所示。
(10)
其中C为调和参数,定义如下:
(11)
相比直接从公式(2)获取姿态变换矩阵,线段特性的引入使得公式(10)中的目标函数形式更为简洁,便于后续的优化求解。本文采用经典的梯度下降法[10]最小化公式(10)中的目标函数从而求解最佳的姿态变换矩阵。由于目标函数具有良好的解析形式,此时梯度下降法可以较为迅速地收敛并获得全局最优解。

本文发布于:2024-09-24 02:31:21,感谢您对本站的认可!

本文链接:https://www.17tex.com/tex/4/315363.html

版权声明:本站内容均来自互联网,仅供演示用,请勿用于商业和其他非法用途。如果侵犯了您的权益请与我们联系,我们将在24小时内删除。

标签:扫描   线段   匹配   方法
留言与评论(共有 0 条评论)
   
验证码:
Copyright ©2019-2024 Comsenz Inc.Powered by © 易纺专利技术学习网 豫ICP备2022007602号 豫公网安备41160202000603 站长QQ:729038198 关于我们 投诉建议