[发明专利]一种激光点云与地图的匹配评价方法、介质、终端和装置

说明书

本发明公开一种激光点云与地图的匹配评价方法、介质、终端和装置，方法包括以下步骤：根据激光点云在当前时刻的先验位姿将激光点云在环境地图上栅格化；计算每个激光点在环境地图上分别对应的最近点集；计算最近点集中所有最近点的均值点，并根据激光点与对应均值点的距离生成激光点的匹配得分；对所有激光点的匹配得分进行求和生成激光点云与环境地图的匹配总分。本发明对于误差较大点具有更强的适应性，能更准确反应出点云与地图匹配的实际效果，不容易陷入局部极小值，提高了匹配精度与容错性，同时在保证运算速度的情况下，能更快地收敛到最优解，在实际应用中具有重要意义。

【技术领域】

本发明涉及导航定位领域，尤其涉及一种激光点云与地图的匹配评价方法、介质、终端和装置。

【背景技术】

激光slam(simultaneous localization and mapping)是移动机器人定位导航的核心技术，全称为同时定位与建图。当机器人处于未知环境中的未知位置时，基于自身携带的传感器通过激光slam技术可以实现机器人边移动边估计出机器人实时位姿，然后不断扩展与更新地图，逐渐构建环境的完整地图。目前激光slam的两大主流的方向是粒子滤波与图优化的方法，两种方法都涉及点云与栅格地图的匹配，是激光slam的核心组成部分。匹配的精度对定位建图精度有较大的影响，同时匹配的速度影响了定位建图的实时性，进一步影响机器人导航控制的响应速度与平滑性。因此提高点云与地图的匹配精度与速度是机器人高精度高效运行的关键技术。已知正在构建的环境地图，根据点云原点在地图上的先验位姿将点云栅格化，计算得到点云的每个点所在地图的栅格，将栅格化的点云与地图进行匹配得到点云原点在地图的后验位姿，从而可以确定所携带该激光的机器人在地图中的精确后验位姿。理想情况下点云所在的栅格都为占用状态，即表示环境中的物体或障碍点。点云与地图的匹配评价标准采用残差或者转化为得分的方式。根据一些搜索方法确定点云在栅格地图中最近点，计算点云与最近点的距离称为残差，或者根据该距离计算正相关的得分，点云匹配的总体残差越小或者得分越高说明匹配效果越好。良好的匹配效果评价方法，能反映实际的匹配效果，而且受误差较大点的影响较小，容错性强。点云与地图匹配是沿着残差更小或得分更高的方向变换，因此更好的匹配评价方法不仅得到更好的点云地图匹配精度，而且更快收敛到最优值，避免陷入局部极小值。当前主要采用点到点距离的评价方法，该方法使用激光点云周围最近点信息较少，且地图上有些最近点误差较大，导致该点的评价出现偏差，不能反应实际环境的信息。再比如有些点是移动物体在地图上生成的障碍点，那么随着物体的移动，利用当前障碍点再用于匹配的评价，容易导致评价指标不够准确，无法准确反应点云与地图匹配的实际效果。点云与地图的匹配方法是沿着评价得分较高或残差较小的方向移动，并估计出激光点云在地图的后验位姿，如果匹配的评价指标不准确，容易导致较低的匹配精度，有可能错过匹配的最优解，甚至陷入局部极小值。其它方法采用双二次线性插值，选取点云附近的几个距离较近的点及其对应概率值，计算激光点所在栅格的概率值。占用栅格地图的离散性限制了该方法可以实现的精度，也不允许直接计算插值值或导数，因此只能近似计算，导致较大的计算量，同时近似结果受栅格地图分辨率影响。

【发明内容】

本发明提供了一种激光点云与地图的匹配评价方法、介质、终端和装置，解决了以上所述的技术问题。

本发明解决上述技术问题的技术方案如下：一种激光点云与地图的匹配评价方法，包括以下步骤：

步骤1，根据激光点云在当前时刻的先验位姿将所述激光点云在环境地图上栅格化；

步骤2，计算所述激光点云中每个激光点在所述环境地图上分别对应的最近点集；

步骤3，计算所述最近点集中所有最近点的均值点，并根据激光点与对应均值点的距离生成所述激光点的匹配得分；

步骤4，对所述激光点云中所有激光点的匹配得分进行求和，生成所述激光点云与所述环境地图的匹配总分。