[发明专利]基于多传感器移动机器人的建图方法

说明书

本发明提供了一种基于多传感器移动机器人的建图方法，其包括以下步骤：为机器人安装多种不同传感器并获取对应传感器的测量数据；将惯性测量单元数据和编码器数据通过运算获得机器人姿态信息和行走路线；将双目相机数据、激光雷达数据、超声波数据转换成角度和距离构成的数值对格式，分别构建环境的二维点云图；通过对传感器预设阈值，去除失真的点云信息和冗余的点云信息，完成点云图的优化；将优化后的点云图转化为栅格地图，完成地图的创建。本发明结合多种不同的传感器，弥补了单一传感器的局限性，并提出机器人构建地图和优化地图分开进行，降低了建图过程中的运算量，并且进一步提高了建图的准确性和建图质量。

技术领域

本发明涉及建图领域，具体涉及一种基于多传感器移动机器人的建图方法。

背景技术

现阶段机器人的移动大多依靠人工路径规划，机器人的自主导航能力依赖于即时定位与建图技术，其核心任务是当机器人进入未知工作环境时，利用传感器信息，对周围环境进行高效率且准确地构建，同时得到设备在空间中的位置与姿态，除了可以应用在机器人领域外，为了实现智能移动设备的自主导航及定位，需要实现对于智能移动设备所处环境的环境建图。

大多数现有产品通常通过两种方式实现环境建图，第一种为直接利用二维测距传感器进行环境建图，但是这无法得到环境的三维信息；第二种为用三维激光雷达或者图像的方法进行环境建图，但是这种方法一般都是先提取三维(或者图像)特征，进行特征匹配，再估算变换矩阵，运算量巨大，无法保证建图的实时性。综上所述，现有技术中提供的环境三维建图的技术方案存在运算量大，无法保证建图实时性的问题。随着计算机技术和人工智能的发展，智能自主移动机器人成为机器人领域的一个重要研究方向和研究热点。

因此，有必要设计一种基于多传感器移动机器人的建图方法，以解决上述问题。

发明内容

本发明的目的在于提供一种基于多传感器移动机器人的建图方法，利用多传感器优势，并且将创建地图和优化地图分开进行，降低了建图的运算量，同时提高了建图的实时性，并且多传感器进一步提高了建图的准确性，提高了建图质量。

为实现上述目的，本发明提供了一种基于多传感器移动机器人的建图方法，其包括以下步骤：

步骤S1：为机器人安装多种不同的传感器，所述传感器包括惯性测量单元、编码器、双目相机、激光雷达及超声波，每个传感器均与机器人的处理芯片连接；

步骤S2：获取双目相机、惯性测量单元、激光雷达、超声波及编码器的测量数据；

步骤S3：将同一时刻的惯性测量单元数据和编码器数据进行扩展卡尔曼滤波处理，通过运算获得机器人姿态信息和行走路线；

步骤S4：操作机器人在未知环境下移动，将双目相机数据、激光雷达数据、超声波数据转换成由角度和距离构成的数值对格式，并分别构建环境的二维点云图，以得到三张点云图；

步骤S5：将三张点云图融合成一张点云图，并对不同传感器获取的点云信息进行标注；

步骤S6:将同一位置的三种不同点云信息的差值与预设阈值进行对比，去除失真的点云信息和冗余的点云信息，以完成点云图的优化；

步骤S7：将步骤S6中优化后的点云图转化为栅格地图，完成地图的创建。

作为本发明进一步改进的技术方案，所述双目相机、激光雷达及超声波的扫描频率一致。

作为本发明进一步改进的技术方案，步骤S3具体包括以下步骤：

步骤S31：获取同一时刻下的惯性测量单元数据和编码器数据；

步骤S32：以惯性测量单元数据格式为标准，通过运动学解耦和航向推算将编码器数据格式转化为惯性测量单元数据格式；