本发明属于信息定位,尤其涉及基于2d激光雷达与lightgbm的室外定位与构图方法及系统。
背景技术:
1、随着机器人技术的飞速发展,越来越多的科技产品如无人车、无人机等开始走进人们的生活,而其中实现各类移动机器人智能化的一项重要技术就是定位。在实际应用中,移动机器人在面对复杂场景,如光照变换、动态障碍物多时,容易导致跟踪失败,进而影响移动机器人的定位与建图过程。因而复杂环境下的同步定位与建图(simultaneouslocalization and mapping,slam)是当前移动机器人研究的热点与重要方向。
2、gbdt (gradient boosting decision tree)是深度学习中一个长盛不衰的模型,其主要思想是利用决策树迭代训练以得到最优模型,该模型具有训练效果好、不易过拟合等优点。gbdt不仅在工业界应用广泛,通常被用于多分类、点击率预测、搜索排序等任务。而lightgbm(light gradient boosting machine)是一个实现gbdt算法的框架,支持高效率的并行训练,并且具有更快的训练速度、更低的内存消耗、更好的准确率、支持分布式可以快速处理海量数据等优点。缺点在于容易过拟合,并且对噪点比较敏感。
3、回环检测部分的主要任务是检测移动机器人是否经过同一地点。正确地检测到回环可以建立当前帧与历史帧间的约束,从而消除来自前端里程计的累积误差,提高全局地图的精度。
4、现有技术研究表明在二维激光雷达中只需要考虑点到线的匹配,在此基础上提出了一种隐式滑动最小二乘icp的回环检测方法,并将其应用到行星车上去。同时现有技术针对2d激光雷达slam算法,提出了一种基于视觉词袋信息融合的回环检测方法,并利用multiscans-to-map的扫描匹配算法,提升了大尺度环境下回环检测的计算效率。再者,现有技术提出基于片段的回环检测方法,将训练好的点云片段加入回环检测,并提出一种空间约束方法,提升回环检测的鲁棒性和准确性。还有,现有技术将基于历史轨迹的关键帧加入到回环检测模块,构建了二维激光点云描述子,最后使用icp算法完成对回环帧的筛选。
5、通过上述分析,现有技术存在的问题及缺陷为:现有技术基于滤波器的激光slam复杂度高且定位精度不高,定位累计误差大,适用性差。
技术实现思路
1、为克服相关技术中存在的问题,本发明公开实施例提供了基于2d激光雷达与lightgbm的室外定位与构图方法及系统。
2、所述技术方案如下:一种基于2d激光雷达与lightgbm的室外定位与构图方法,包括以下步骤:
3、s1,利用pl-icp点云匹配算法进行前端扫描匹配;
4、s2,基于lightgbm回环检测方法进行回环检测;
5、s3,采用时间一致性检验和空间一致性检验结合的验证方式进行回环验证。
6、在步骤s1中,pl-icp点云匹配算法包括:在点云集中找到距离点云中的任意点欧氏距离最近的两点与,计算出由点到与连线的垂直距离。
7、进一步,所述pl-icp点云匹配算法改进后的误差方程为:
8、,
9、式中,为求解旋转矩阵和平移向量的结果,为旋转矩阵,为平移矩阵,为平移向量,为垂直于点与连线的法向量,为改进后的旋转矩阵,为点云中点的坐标,为改进后的平移矩阵,为点云中的点云;
10、对误差方程求解出值,使得取最小值;将点云按照进行旋转和平移后得到新的点云,并进行下一步的迭代;当最终的误差小于设定的阈值时,终止迭代并输出,获得两帧点云数据的相对位姿差。
11、在步骤s2中,基于lightgbm回环检测方法进行回环检测,包括:
12、s2.1,点云特征提取:提取旋转不变特征包括区域特征、距离特征、形状特征与聚类特征;
13、s2.2,点云特征分类:基于lightgbm扫描计算个旋转不变特征,定义为:
14、,
15、式中,为一类点云特征,为第次激光扫描,为旋转不变特征数量,,为扫描的总次数,为第i次扫描时,第m种旋转不变特征的值;
16、设两次激光扫描分别为与l,分类器的特征集定义为:
17、,
18、式中,为第k次激光扫描中的点云特征,为第l次激光扫描中的点云特征,为第m种旋转不变特征的差值,为第j种旋转不变特征的差值,为第k次扫描时,第j种旋转不变特征的值,为第l次扫描时,第j种旋转不变特征的值,为从1到实数m中的任意实数;
19、对于训练数据,提供一组个带标签的扫描对,表达式为:
20、,
21、式中,为处理后的分类点云特征,为点云横坐标,为点云纵坐标。
22、在步骤s2.2中,点云特征分类采用lightgbm作为由一系列决策树组成的分类器,首先从初始训练集训练出一个基分类器,然后根据分类误差调整训练样本的分布,使之前错误分类的样本在接下来的步骤中得到关注;再根据更新后的样本分布训练下一个弱分类器;重复以上步骤,直到达到最大迭代,最终的分类器是个弱分类器的加权组合。
23、进一步,回环检测包括:
24、获取当前时刻点云集;
25、点云特征提取;
26、点云特征分类;
27、闭环验证;
28、匹配得分是否大于设定阈值,若大于,则回环检测成功,若不大于设定阈值,则回环检测失败,返回获取当前时刻点云集步骤。
29、在步骤s3中,时间一致性检验包括:判断是否连续三个关键帧均能找到回环且回环帧来源于同一场景附近,若满足条件,则构建回环约束;
30、空间一致性检验包括:通过划分有效点和无效点,统计激光点云对的有效点数量,当有效点数量与匹配点数量的比值超过设定阈值时,通过空间一致性检验。
31、进一步,空间一致性检验中,计算当前帧对应特征点云与回环帧对应特征点云之间坐标变换关系,变换矩阵与特征点间的关系式为:
32、,
33、其中,为回环帧对应特征点的点云坐标,为当前帧对应特征点的点云坐标,为变换矩阵,为旋转矩阵,为平移向量。
34、进一步,设两帧包含对的匹配点,检验回环正确性具体包括:
35、(1)从对匹配点对中任意选六组对应点对,带入变换矩阵与特征点间的关系式,求解出变换矩阵;
36、(2)将当前帧中剩余点分别带入上式,即根据已求解的变换矩阵,计算投影点与对应点之间的欧式距离;若欧式距离小于设定的距离阈值时,该特征点归为有效点,反之视为无效点;
37、(3)记录步骤(2)获取的有效点数量;
38、(4)回到步骤(1)并重复若干次,计算有效点数量的平均值,若该平均值与匹配点数量的比值大于设定阈值,则认为通过空间一致性检验,证明该回环的正确性。
39、本发明的另一目的在于提供一种基于2d激光雷达与lightgbm的室外定位与构图系统,该系统实施所述的基于2d激光雷达与lightgbm的室外定位与构图方法,该系统包括:
40、前端扫描匹配模块,用于利用pl-icp点云匹配算法进行前端扫描匹配;
41、回环检测模块,用于基于lightgbm回环检测方法进行回环检测,
42、回环验证模块,用于采用时间一致性检验和空间一致性检验结合的验证方式进行回环验证。
43、结合上述的所有技术方案,本发明所具备的优点及积极效果为:本发明提供一种基于lightgbm的室外2d激光slam方案,该方法通过嵌入式计算平台、单线激光雷达、机器人移动平台等硬件,有效解决传统基于滤波器的激光slam复杂度高且定位精度不高的问题,同时该方法采用基于深度学习的回环检测进一步减小定位累计误差,该方法鲁棒性高、精度高、适用性强。
44、作为本发明的积极效果,还体现在以下几个重要方面:
45、(1)本发明选择2d激光雷达为slam方法使用的传感器,定位精度相对传统基于滤波器激光slam更高且复杂度低;
46、(2)本发明通过采用基于lightgbm的场景识别方法进行回环检测,相对传统检测方法,鲁棒性更好且基本上不存在漏检现象,保证回环检测的正确性。