基于多信息源的机器人即时定位与地图构建方法及系统技术方案

本发明专利技术公开了一种基于多信息源的机器人即时定位与地图构建方法及系统，该方法包括：获取激光点云数据并对点云数据进行预处理；基于点云数据的几何特征和激光点反射强度信息，对预处理后的每一帧的点云进行特征点提取；利用聚类标签和激光点反射强度信息作为联合的约束条件，根据特征点进行点云配准；基于点云配准结果，结合IMU数据和回环检测信息，得到全局位姿和地图。本发明专利技术采用紧耦合的方式，利用IMU和激光雷达的信息，引入激光反射强度信息，避免了单一几何信息的不足。同时融合了目前先进的scan context描述符进行回环检测，从而提升了定位以及建图精度，提高了系统整体的鲁棒性。性。性。

【技术实现步骤摘要】
基于多信息源的机器人即时定位与地图构建方法及系统


[0001]本专利技术涉及机器人
，特别涉及一种基于多信息源的机器人即时定位与地图构建方法及系统。

技术介绍

[0002]SLAM(即时定位与地图构建)作为移动机器人的核心功能，在过去的几十年时间里得到了飞速的发展，引起了国际社会学者们的广泛兴趣。
[0003]为了构建良好的激光惯导SLAM系统，人们也提出了诸如LOAM，Lego
‑
loam，LIO
‑
Mapping、LIO
‑
SAM等算法，但是这些现有的算法都不可避免的采取单一的几何特征，信息源较为单一，并且这些现有的惯导系统大多没有对地面进行优化，缺少地平面这一有明显特征的几何约束，因此，需要改进。

技术实现思路

[0004]本专利技术提供了一种基于多信息源的机器人即时定位与地图构建方法及系统，以解决目前SLAM大多以3D激光雷达为主，信息源大多采取几何信息的特征，在一些场景下，如室外，发生纯旋转等情况下的鲁棒性不高的技术问题。
[0005]为解决上本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于多信息源的机器人即时定位与地图构建方法，其特征在于，包括：获取激光点云数据，并对获取的激光点云数据进行预处理，以去除激光点云数据中的杂点，并且获得激光点反射强度信息和激光点云数据的聚类标签；基于激光点云数据的几何特征和激光点反射强度信息，对预处理后的激光点云数据中的每一帧的点云进行特征点提取，以获取每一帧点云的特征点；利用提取到的特征点进行点云配准；其中，在点云配准过程中，利用所述聚类标签和所述激光点反射强度信息作为联合的约束条件；基于点云配准结果，结合IMU数据和回环检测信息，得到全局位姿和地图。2.如权利要求1所述的基于多信息源的机器人即时定位与地图构建方法，其特征在于，所述对获取的激光点云数据进行预处理，包括：根据反射强度的生成原理，建立数学模型，利用所述数学模型进行激光点反射强度的矫正和归一化处理，获得激光点反射强度信息，所述数学模型如下：其中，ρ是反射率，表示反射强度消除外在因素干扰后的信息，I是测得的反射强度信息，R是激光点距离激光雷达的距离，α是入射角度，
∝
表示正相关。3.如权利要求2所述的基于多信息源的机器人即时定位与地图构建方法，其特征在于，所述对获取的激光点云数据进行预处理，还包括：利用激光点间的角度关系进行线束分割，以确定每个激光点属于哪个线束；利用相邻点与地平线的夹角关系进行地面点与非地面点的点云分割；利用惯性传感器IMU信息进行点云数据的运动畸变去除；对非地面点投影聚类，对每个聚类分配一个唯一的聚类标签并去除边缘点。4.如权利要求3所述的基于多信息源的机器人即时定位与地图构建方法，其特征在于，所述利用惯性传感器IMU信息进行运动畸变去除，包括：将IMU直接测得的角速度和线加速度进行积分；根据积分结果将速度补偿给激光点，以实现点云数据的运动畸变去除。5.如权利要求1所述的基于多信息源的机器人即时定位与地图构建方法，其特征在于，所述基于激光点云数据的几何特征和激光点反射强度信息，对预处理后的激光点云数据中的每一帧的点云进行特征点提取，包括：基于激光点云数据的几何特征和激光点反射强度信息，构建平滑度公式，设置特征点判断阈值，表达式如下：其中，代表两个激光点的距离，d
I
＝‖ρ
j
‑
ρ
l
‖代表两个反射率的差值，S指计算平滑度选取相邻点的个数，指的是S个激光点到激光雷达的距离和；α和β为预设参数，并且α∈[0,1]，β∈[0,1]；x
j
指第j个激光点到激光雷达的距离,T表示
向量的转置；ρ
j
表示第j个激光点的反射率；x
l
指第l个激光点到激光雷达的距离；ρ
l
表示第l个激光点的反射率。将每一帧点云均匀的分为8个部分，每个部分的扫描范围均为45度；在提取特征点时，在...

【专利技术属性】
技术研发人员：丁大伟，王旭，爨朝阳，王恒，安翠娟，田震松，任莹莹，
申请(专利权)人：北京科技大学，
类型：发明
国别省市：