[发明专利]地图构建方法及装置

说明书

本申请提供了地图构建方法及装置，在建立点云数据和位姿的关联关系的过程中，针对任一帧点云数据，获取在采集所述点云数据的过程中，位姿采集模块采集的激光雷达的多个位姿以及所述多个位姿分别对应的时间戳；获得在采集该帧点云数据的过程中激光雷达的目标位姿变化信息；基于所述多个位姿、所述多个位姿分别对应的时间戳、所述目标位姿变化信息以及所述点云数据的时间戳，确定的所述点云数据关联的位姿更加准确，从而使得得到两两相邻两帧点云数据之间的相对位姿更加准确，基于所述多帧点云数据中两两相邻两帧点云数据之间的相对位姿以及所述多帧点云数据，构建得到的所述被测对象的三维图像更加准确。

技术领域

本申请涉及定位导航技术领域，更具体的说，是涉及地图构建方法及装置。

背景技术

SLAM(simultaneous localization and mapping，同步定位与地图创建)技术的原理是：利用激光雷达向被测对象发射光线并接收由被测对象反射的光线，计算该束光线的飞行距离，以得到被测对象与激光雷达的距离。激光雷达包括多个激光传感器，若利用多个激光传感器发射光线，则可以得到多个点，每一点的采集信息包括：该点对应的激光传感器位于激光雷达中的位置，该点对应的激光传感器发射的光线的次序以及该点对应的距离，将激光雷达中各个激光传感器扫描一圈后得到的多个点的称为一帧点云数据。通过对不同时刻两帧点云数据进行匹配与比对，计算出激光雷达在这两个时刻之间的相对位姿。若以第一帧的位姿为初始位姿，那么后续的每一帧点云数据都可以基于相对位姿，将本帧的点云数据变换到第一帧点云数据所在坐标系上，从而构建出点云地图；基于点云地图构建被测对象的三维图像。

在将两帧点云数据进行匹配与比对的过程中，由于采集激光雷达的位姿的位姿采集模块的采集频率与激光雷达采集点云数据的频率不同，导致位姿采集模块采集得到的位姿的数目与激光雷达得到的点云数据的帧数不同，所以需要基于各帧点云数据的时间戳与各个位姿的时间戳，将各帧点云数据与位姿建立关联。

目前，基于各帧点云数据的时间戳与各个位姿的时间戳，将各帧点云数据与位姿建立关联的方法不准确，使得计算得到的激光雷达在这两个时刻之间的相对位姿不准确，导致得到的点云地图不准确，最终导致基于点云地图构建被测对象的三维图像不准确。

发明内容

有鉴于此，本申请提供了一种地图构建方法及装置。

为实现上述目的，本申请提供如下技术方案：

根据本公开实施例的第一方面，提供一种地图构建方法，包括：

获取被测对象对应的多帧点云数据以及所述多帧点云数据分别对应的时间戳；

针对所述多帧点云数据中任一帧点云数据，获取在采集所述点云数据的过程中，位姿采集模块采集的激光雷达的多个位姿以及所述多个位姿分别对应的时间戳；

获取在采集所述点云数据的过程中所述激光雷达的目标位姿变化信息，其中，所述目标位姿变化信息是基于所述位姿采集模块采集得到的时间戳与该帧点云数据的时间戳最近的位姿变化信息得到的；

基于所述多个位姿、所述多个位姿分别对应的时间戳、所述目标位姿变化信息以及所述点云数据的时间戳，确定所述点云数据关联的位姿，以得到所述多帧点云数据分别关联的位姿；

针对所述多帧点云数据中任一帧点云数据，基于所述点云数据关联的位姿与所述点云数据的前一帧点云数据关联的位姿，确定两帧点云数据之间的相对位姿，以得到所述多帧点云数据中两两相邻两帧点云数据之间的相对位姿；

基于所述多帧点云数据中两两相邻两帧点云数据之间的相对位姿以及所述多帧点云数据，构建所述被测对象的三维图像。

结合第一方面，在第一种可能的实现方式中，所述获取在采集所述点云数据的过程中所述激光雷达的目标位姿变化信息包括：

基于所述多个位姿分别对应的时间戳以及所述多个位姿，确定所述激光雷达的第一位姿变化信息；