带障碍物记忆功能的多激光雷达数据融合方法技术

本发明专利技术提供一种带障碍物记忆功能的多激光雷达数据融合方法。包括步骤：设定主、辅激光雷达；若障碍物仅辅激光雷达可见时，将辅激光雷达测量障碍物的点云数据坐标转化为全局地图坐标；判断全局数据链表中是否存在该点对应的全局地图坐标？否则保存至全局数据链表，并为该点创造生命周期；是则将该点对应的全局地图坐标权重加一；辅激光雷达每循环扫描一周，该点对应的全局地图坐标权重减少，对应生命周期也减少；检测全局数据链表中存储的全局地图坐标的权重、生命周期以及该点距机器人的距离，选择仅保存该点数据或删除该点或转化为融合激光数据。本发明专利技术提供的所述方法带有障碍物记忆功能，能实时有效的融合多激光雷达数据，同时有效过滤噪点。

【技术实现步骤摘要】
带障碍物记忆功能的多激光雷达数据融合方法
本专利技术涉及激光雷达
，具体涉及一种带障碍物记忆功能的多激光雷达数据融合方法。
技术介绍
激光作为当前机器人导航重要器件，相当于机器人的眼睛，在机器人避障时，激光数据的实时性和准确性决定了机器人能否安全避障。由于结构遮挡以及机器人安装高度等问题，现有激光雷达设备性能不佳、单一激光覆盖范围有限，因此，需要多激光雷达协调作业。多激光雷达协调作业最重要的问题是多激光雷达数据的融合。激光雷达高速扫描，以10hz、2000点数据激光为例，激光每0.1秒需要处理2000个数据点，每个数据点都有特定的角度、时间，且点和点的时间差仅为1/20000s，在如此短的时间内，不同的设备很难做到时间同步，且不同设备性能不一，这就会导致当机器人或者障碍物运动时，不同激光探测到的障碍物信息不同，如果直接对不同激光数据进行融合，会产生大量噪点，且障碍物相对雷达运动速度越快，误差越大。现有技术中存在两种数据融合方法：一是自适应消息同步方法：这种方法相当于时间同步器，从多个激光接收不同的消息后，当且仅当多个激光雷达具有相同时间戳的消息时才输出各自的点云数据。因此会由于本文档来自技高网...

【技术保护点】
1.一种带障碍物记忆功能的多激光雷达数据融合方法，其特征在于：具体包括如下步骤：步骤S1：设定主激光雷达和辅激光雷达；步骤S2：若障碍物对于主激光雷达不可见而辅激光雷达可见时，将辅激光雷达测量的障碍物的点云数据坐标(x′，y′)转化为全局地图坐标(x，y)；步骤S3：判断全局数据链表中是否存在该点云数据坐标(x′，y′)对应的全局地图坐标(x，y)？若否，则保存至全局数据链表，并为该点创造生命周期T；若是，则将该点云数据坐标(x′，y′)对应的全局地图坐标(x，y)权重加一；步骤S4：辅激光雷达每循环扫描一周，该点云数据坐标(x′，y′)对应的全局地图坐标(x，y)权重减少一定量μ，其生命周期...

【技术特征摘要】
1.一种带障碍物记忆功能的多激光雷达数据融合方法，其特征在于：具体包括如下步骤：步骤S1：设定主激光雷达和辅激光雷达；步骤S2：若障碍物对于主激光雷达不可见而辅激光雷达可见时，将辅激光雷达测量的障碍物的点云数据坐标(x′，y′)转化为全局地图坐标(x，y)；步骤S3：判断全局数据链表中是否存在该点云数据坐标(x′，y′)对应的全局地图坐标(x，y)？若否，则保存至全局数据链表，并为该点创造生命周期T；若是，则将该点云数据坐标(x′，y′)对应的全局地图坐标(x，y)权重加一；步骤S4：辅激光雷达每循环扫描一周，该点云数据坐标(x′，y′)对应的全局地图坐标(x，y)权重减少一定量μ，其生命周期T对应减少一定量ν；步骤S5：检测全局数据链表中存储的点云数据坐标(x′，y′)对应的全局地图坐标(x，y)的权重、生命周期T以及该点距机器人的距离；当权重＜2，仅保存该点数据并不转化为融合激光数据；当生命周...

【专利技术属性】
技术研发人员：肖湘江，
申请(专利权)人：肖湘江，
类型：发明
国别省市：湖南,43