基于多传感器移动机器人的建图方法技术

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

Drawing method based on multi-sensor mobile robot

【技术实现步骤摘要】
基于多传感器移动机器人的建图方法
本专利技术涉及建图领域，具体涉及一种基于多传感器移动机器人的建图方法。
技术介绍
现阶段机器人的移动大多依靠人工路径规划，机器人的自主导航能力依赖于即时定位与建图技术，其核心任务是当机器人进入未知工作环境时，利用传感器信息，对周围环境进行高效率且准确地构建，同时得到设备在空间中的位置与姿态，除了可以应用在机器人领域外，为了实现智能移动设备的自主导航及定位，需要实现对于智能移动设备所处环境的环境建图。大多数现有产品通常通过两种方式实现环境建图，第一种为直接利用二维测距传感器进行环境建图，但是这无法得到环境的三维信息；第二种为用三维激光雷达或者图像的方法进行环境建图，但是这种方法一般都是先提取三维(或者图像)特征，进行特征匹配，再估算变换矩阵，运算量巨大，无法保证建图的实时性。综上所述，现有技术中提供的环境三维建图的技术方案存在运算量大，无法保证建图实时性的问题。随着计算机技术和人工智能的发展，智能自主移动机器人成为机器人领域的一个重要研究方向和研究热点。因此，有必要设计一种基于多传感器移动机器人的建图方法，以解决上述问题。
技术实现思路
本专利技术的目的在于提供一种基于多传感器移动机器人的建图方法，利用多传感器优势，并且将创建地图和优化地图分开进行，降低了建图的运算量，同时提高了建图的实时性，并且多传感器进一步提高了建图的准确性，提高了建图质量。为实现上述目的，本专利技术提供了一种基于多传感器移动机器人的建图方法，其包括以下步骤：步骤S1：为机器人安装多种不同的传感器，所述传感器包括惯性测量单元、编码器、双目相机、激光雷达及超声波，每个传感器均与机器人的处理芯片连接；步骤S2：获取双目相机、惯性测量单元、激光雷达、超声波及编码器的测量数据；步骤S3：将同一时刻的惯性测量单元数据和编码器数据进行扩展卡尔曼滤波处理，通过运算获得机器人姿态信息和行走路线；步骤S4：操作机器人在未知环境下移动，将双目相机数据、激光雷达数据、超声波数据转换成由角度和距离构成的数值对格式，并分别构建环境的二维点云图，以得到三张点云图；步骤S5：将三张点云图融合成一张点云图，并对不同传感器获取的点云信息进行标注；步骤S6:将同一位置的三种不同点云信息的差值与预设阈值进行对比，去除失真的点云信息和冗余的点云信息，以完成点云图的优化；步骤S7：将步骤S6中优化后的点云图转化为栅格地图，完成地图的创建。作为本专利技术进一步改进的技术方案，所述双目相机、激光雷达及超声波的扫描频率一致。作为本专利技术进一步改进的技术方案，步骤S3具体包括以下步骤：步骤S31：获取同一时刻下的惯性测量单元数据和编码器数据；步骤S32：以惯性测量单元数据格式为标准，通过运动学解耦和航向推算将编码器数据格式转化为惯性测量单元数据格式；步骤S33：构建扩展卡尔曼滤波器，获取编码器数据作为观测量及观测协方差矩阵，进行状态更新，得到更新后的系统状态及系统协方差矩阵；获取惯性测量单元数据作为观测量及观测协方差矩阵，进行状态更新，得到更新后的系统状态及系统协方差矩阵；发布更新后的状态量及协方差矩阵作为融合后的数据，获取机器人的姿态信息和行走路线。作为本专利技术进一步改进的技术方案，步骤S4中对双目相机数据进行格式转化的具体步骤包括：步骤S41：根据三角形相似原理，计算出障碍物和机器人的距离信息；步骤S42：利用步骤S3中获取的机器人姿态信息，提取出偏航角；步骤S43：将同一时刻的距离信息和偏航角组成数值对，完成对双目相机数据格式的转化。作为本专利技术进一步改进的技术方案，步骤S5中通过不同颜色对不同传感器获取的点云信息进行标注。作为本专利技术进一步改进的技术方案，步骤S6具体为:在融合后的点云图上，将同一位置的三种不同点云信息差值与预设阈值进行对比，若大于预设阈值，则挑选出最大优先级类型的点云信息作为最终的点云信息；若等于预设阈值，则挑选出任意传感器生成的点云信息作为最终的点云信息；若小于预设阈值，则采用卡尔曼滤波融合三种不同点云信息。作为本专利技术进一步改进的技术方案，所述激光雷达为2D激光雷达。作为本专利技术进一步改进的技术方案，所述机器人的底盘为差分轮结构，并包括底盘及设于底盘上的左轮和右轮。本专利技术的基于多传感器移动机器人的建图方法利用惯性测量单元和编码器数据融合，有效避免了机器人建图过程中由于打滑、震动带来的编码器累计误差，进一步提高了建图的准确性；利用激光雷达、双目相机、超声波分别创建点云图，丰富了传感器的环境感知信息。另外，本专利技术将创建地图和优化地图分开进行，降低了建图的运算量，提高了建图的实时性；同时利用多传感器进一步提高了建图的准确性和建图质量。附图说明图1是本专利技术基于多传感器移动机器人的建图方法的流程图。图2是本专利技术中机器人的底盘的移动示意图。具体实施方式为了使本专利技术的目的、技术方案和优点更加清楚，下面结合附图和具体实施例对本专利技术进行详细描述。显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其它实施例，都属于本专利技术保护的范围。请参图1所示的基于多传感器移动机器人的建图方法，其包括以下步骤：步骤S1：为机器人安装多种不同的传感器，传感器包括惯性测量单元(IMU)、编码器、双目相机、激光雷达及超声波，每个传感器均与机器人的处理芯片连接；步骤S2：同时获取双目相机、惯性测量单元、激光雷达、超声波、编码器的测量数据；步骤S3：将同一时刻的惯性测量单元数据和编码器数据进行扩展卡尔曼滤波处理，通过运算获得机器人姿态信息和行走路线；步骤S3具体包括以下步骤：步骤S31：获取同一时刻下的惯性测量单元数据和编码器数据，惯性测量单元数据格式为[pitchrollyaw]，编码器数据格式为[vL，vR]；步骤S32：以惯性测量单元数据格式为标准，通过运动学解耦和航向推算将编码器数据格式转化为惯性测量单元数据格式；具体的，如图2所示，机器人的底盘为差分轮结构，并包括底盘及设于底盘上的左轮和右轮。由左轮角速度wL和右轮角速度wR相等可得：其中v,w为底盘中心的线速度和角速度，vL，vR为左右两轮的速度，d为轮子距底盘中心的距离，r为底盘的中心圆弧运动的半径。将(2)代入角速度公式计算出底盘的角速度：将(3)代入线速度公式计算出底盘的线速度：将(3)，(4)代入航迹推算公式(5)，将编码器数据格式[vL，vR]转化为[x,y,θ]：步骤33：构建扩展卡尔曼滤波器，获取编码器数据作为观测量及观测协方差矩阵，进行状态更新，得到更新后的系统状态及系统协方差矩阵；获取惯性测量单元数据作为观测量及观测协方差矩阵，进行状态更新，得到更新后的系统状态及本文档来自技高网...

【技术保护点】
1.一种基于多传感器移动机器人的建图方法，其特征在于，包括以下步骤：/n步骤S1：为机器人安装多种不同的传感器，所述传感器包括惯性测量单元、编码器、双目相机、激光雷达及超声波，每个传感器均与机器人的处理芯片连接；/n步骤S2：获取双目相机、惯性测量单元、激光雷达、超声波及编码器的测量数据；/n步骤S3：将同一时刻的惯性测量单元数据和编码器数据进行扩展卡尔曼滤波处理，通过运算获得机器人姿态信息和行走路线；/n步骤S4：操作机器人在未知环境下移动，将双目相机数据、激光雷达数据、超声波数据转换成由角度和距离构成的数值对格式，并分别构建环境的二维点云图，以得到三张点云图；/n步骤S5：将三张点云图融合成一张点云图，并对不同传感器获取的点云信息进行标注；/n步骤S6:将同一位置的三种不同点云信息的差值与预设阈值进行对比，去除失真的点云信息和冗余的点云信息，以完成点云图的优化；/n步骤S7：将步骤S6中优化后的点云图转化为栅格地图，完成地图的创建。/n

【技术特征摘要】
1.一种基于多传感器移动机器人的建图方法，其特征在于，包括以下步骤：
步骤S1：为机器人安装多种不同的传感器，所述传感器包括惯性测量单元、编码器、双目相机、激光雷达及超声波，每个传感器均与机器人的处理芯片连接；
步骤S2：获取双目相机、惯性测量单元、激光雷达、超声波及编码器的测量数据；
步骤S3：将同一时刻的惯性测量单元数据和编码器数据进行扩展卡尔曼滤波处理，通过运算获得机器人姿态信息和行走路线；
步骤S4：操作机器人在未知环境下移动，将双目相机数据、激光雷达数据、超声波数据转换成由角度和距离构成的数值对格式，并分别构建环境的二维点云图，以得到三张点云图；
步骤S5：将三张点云图融合成一张点云图，并对不同传感器获取的点云信息进行标注；
步骤S6:将同一位置的三种不同点云信息的差值与预设阈值进行对比，去除失真的点云信息和冗余的点云信息，以完成点云图的优化；
步骤S7：将步骤S6中优化后的点云图转化为栅格地图，完成地图的创建。


2.根据权利要求1所述的基于多传感器移动机器人的建图方法，其特征在于，所述双目相机、激光雷达及超声波的扫描频率一致。


3.根据权利要求1所述的基于多传感器移动机器人的建图方法，其特征在于，步骤S3具体包括以下步骤：
步骤S31：获取同一时刻下的惯性测量单元数据和编码器数据；
步骤S32：以惯性测量单元数据格式为标准，通过运动学解耦和航向推算将编码器数据格式转化为惯性测量单元数据格式；
步骤S33：构建扩展卡尔曼滤波器，获取编码器数据作为观测量及观测协方差矩阵，进行状态...

【专利技术属性】
技术研发人员：李晓飞，周建伟，李茂如，
申请(专利权)人：南京邮电大学，
类型：发明
国别省市：江苏;32