[发明专利]基于权重地图的融合定位方法、装置、介质及设备

说明书

本发明公开了一种基于权重地图的融合定位方法，通过构建权重地图，所述权重地图为包括实时动态测量RTK权重信息的激光点云地图；在进行融合定位时，获取当前的激光雷达定位信息；从所述权重地图中获取所述激光雷达定位信息对应的实时动态测量RTK定位信息以及权重信息；根据所述激光雷达定位信息、实时动态测量RTK定位信息以及权重信息进行融合定位，输出融合定位结果；有效地减弱了RTK设备的多路径效应对融合定位结果的影响，充分地考虑到了不同环境中实时动态测量RTK的可靠性差异，提高了激光雷达的定位精度和可靠性，避免了出现位置丢失的情况。

技术领域

本发明涉及机器人技术领域，尤其涉及一种基于权重地图的融合定位方法、装置、介质及设备。

背景技术

移动机器人基于3D激光雷达的自主导航流程顺序一般分为构建地图、基于地图定位、基于地图规划路径、行进。

在对机器人工作场景进行点云地图构建时，考虑到特定的工作场景存在动态干扰物、场景空旷等不利因素，现有技术会基于实时动态测量RTK进行融合定位，以提高机器人定位的鲁棒性。尽管基于实时动态测量RKT与点云地图激光雷达定位的融合方式多种多样，然而这些融合方式均没有考虑到“RTK多路径效应”，即由于受到周围建筑环境的影响接收机所接收到的卫星信号中包含各种反射和折射信号，而直接将实时动态测量RKT与点云地图激光雷达定位进行平等融合。可见，现有技术没有考虑到在每一段环境中基于实时动态测量RTK的可靠性并不完全一致的问题，从而降低了激光雷达的定位精度和可靠性，甚至会出现位置丢失的情况。

发明内容

本发明实施例提供了一种基于权重地图的融合定位方法、装置、介质及设备，以解决现有基于实时动态测量RTK的融合定位技术存在的定位误差大、可靠性不高的问题。

一种基于权重地图的融合定位方法，所述方法包括：

构建权重地图，所述权重地图为包括实时动态测量RTK权重信息的激光点云地图；

在进行融合定位时，获取当前的激光雷达定位信息；

从所述权重地图中获取所述激光雷达定位信息对应的实时动态测量RTK定位信息以及权重信息；

根据所述激光雷达定位信息、实时动态测量RTK定位信息以及权重信息进行融合定位，输出融合定位结果。

可选地，所述构建权重地图包括：

对3D激光雷达的传感器和RTK设备的天线进行外参标定；

获取移动机器人在预设场景中行走时3D激光雷达采集的激光点云数据、里程计采集的位姿信息、RTK设备采集的定位信息；

根据所述激光点云数据和位姿信息，采用SLAM技术构建所述预设场景对应的激光点云地图；

根据所述激光点云地图和RTK设备采集的定位信息生成权重信息，构建所述预设场景对应的权重地图。

可选地，所述根据所述激光点云地图和RTK设备采集的定位信息生成权重信息，构建所述预设场景对应的权重地图包括：

从激光点云地图中获取移动机器人的关键帧运动位姿轨迹信息，所述关键帧运动位姿轨迹信息包括若干个定位关键帧，每一所述定位关键帧包括旋转矩阵信息、位移变换信息以及时间戳；

对于每一个定位关键帧，获取所述定位关键帧中的位移变换信息以及时间戳；

根据所述时间戳获取所述定位关键帧对应的实时动态测量RTK定位信息；

根据所述位移变换信息和实时动态测量RTK定位信息计算所述定位关键帧对应的实时动态测量RTK权重信息；

遍历每一个定位关键帧，计算对应的权重信息并添加到所述激光点云地图，得到权重地图。