本发明专利技术涉及一种基于子图更新和反光板优化的动态激光SLAM方法，包括如下步骤：实时获取激光数据，进行前端扫描匹配，将激光数据插入子图；根据激光数据的强度信息和初步估计位姿，解析并匹配反光板；根据建立好的约束构建后端优化目标，优化轨迹和地图；根据建图或定位的需求，动态更新或覆盖地图。本发明专利技术基于子图更新的方式对地图进行动态更新，可有效应对环境的动态变化，提高了激光匹配的鲁棒性，提高了定位的精准性，并将反光板约束条件加入SLAM后端优化的过程，使得优化过程更加快速且准确，获得了更加精准的状态估计结果。获得了更加精准的状态估计结果。获得了更加精准的状态估计结果。
【技术实现步骤摘要】
一种基于子图更新和反光板优化的动态激光SLAM方法
[0001]本专利技术属于移动机器人自主建图与定位领域，具体涉及一种基于子图更新和反光板优化的动态激光SLAM方法。
技术介绍
[0002]移动机器人的SLAM问题是机器人在未知或已知环境中稳定工作的基石。静态场景的SLAM工作研究已经相对成熟，而动态场景多由于其不确定性，对算法的鲁棒性要求非常高，目前尚没有稳定成熟的工业界解决方案。环境的动态变化可能导致很多问题，比如激光难以初始化、依赖于固定特征的算法不稳定等。货物搬运工厂的动态环境给现有的SLAM算法带来了很大的挑战，变化的环境可能会造成错误的激光匹配，从而导致错误的定位。工厂环境里的AGV在面临工厂结构变化或人员走动等环境的动态变化时，容易发生定位丢失。
[0003]移动机器人采用的静态地图与粒子滤波融合的定位方案往往无法应对环境动态变化问题，而当前尚未存在稳定开源的动态SLAM算法，只在一些对动态SLAM的理论研究，比如对时间尺度的并列融合方式可以使得机器人通过建立双地图的方案来动态定位，对动态物体的检测算法可以使得机器人对位姿图节点进行删除和更新，而这些算法大多需要很大的内存消耗和大量计算，且位置难以从错误中恢复。
技术实现思路
[0004]本专利技术的目的是提供一种基于子图更新和反光板优化的动态激光SLAM方法。
[0005]为达到上述目的，本专利技术采用的技术方案是：
[0006]一种基于子图更新和反光板优化的动态激光SLAM方法，包括如下步骤：
[0007]S1：实时获取激光数据，进行前端扫描匹配，将激光数据插入子图；
[0008]S2：根据激光数据的强度信息和初步估计位姿，解析并匹配反光板；
[0009]S3：根据建立好的约束构建后端优化目标，优化轨迹和地图；
[0010]S4：根据建图或定位的需求，动态更新或覆盖地图。
[0011]优选地，在S1中：所述的前端扫描匹配包括如下步骤：
[0012](1)进行粗细粒度的扫描匹配，
[0013](2)进行基于Ceres优化的扫描匹配，
[0014](3)得到激光帧插入位姿。
[0015]优选地，所述的粗细粒度的扫描匹配的搜索式为所述的基于Ceres优化的扫描匹配的搜索式为
[0016]式中：
[0017]T
ξ
为扫描点到地图坐标系的变换，
[0018]h
k
为激光束的扫描点集。
[0019]优选地，在S1中：所述的插入子图包括如下步骤：
[0020](1)将当前帧的点云分别插入相邻的两个子图，
[0021](2)对已生成的子图进行激光帧
‑
子图的扫描匹配，若响应达到指定的阈值，则视为找到回环，
[0022](3)将激光帧与子图的约束加入后端，进行周期性的全局优化。
[0023]优选地，在S2中：所述的解析并匹配反光板包括如下步骤：
[0024](1)对每一个激光帧设定激光强度阈值，在超过阈值的区域进行局部极大值检测，获得反光柱圆心到激光雷达的位置，并获取其相对于激光雷达的直线距离和偏转角度信息，定义激光坐标系下的反光板位置为R
n
＝{d
′
,θ
′
}，机器人坐标系下的反光板位置为R
′
n
＝{d,θ}，对激光坐标系和机器人坐标系下的相对位姿变换，
[0025](2)根据当前机器人的位姿对检测到的反光板进行初步判断，根据反光板安装时的位置并按照距离最近原则的匹配标准进行匹配，获取反光板的唯一标识，将反光板位姿转R
′
n
换为旋转矩阵形式的位姿ξ
jk
并加入后端约束。
[0026]优选地，所述的激光坐标系和机器人坐标系下的相对位姿变换为：
[0027][0028][0029]式中：
[0030]Δx和Δy为机器人坐标系和激光坐标系之间的偏移量，
[0031]所述的旋转矩阵形式的位姿ξ
jk
为：
[0032][0033]式中：
[0034][0035]优选地，在S3中：所述的后端优化包括如下步骤：
[0036](1)建立激光帧节点位姿和子图位姿间的约束、激光帧位姿和反光板节点位姿间的约束，
[0037](2)融合两项约束，按照动态SLAM的后端全局优化目标进行优化，
[0038](3)基于SPA算法迭代求解优化目标，得到优化后的子图集合Ξ
m
，激光点云集合Ξ
s
，反光板位姿集合Ξ
r
。
[0039]优选地，所述的动态SLAM的后端全局优化目标为
[0040][0041]其中：
[0042][0043][0044][0045][0046][0047]为某一个子图的位姿，为某一帧激光点云的位姿，为某一个反光板的位姿。
[0048]优选地，所述的子图集合Ξ
m
、激光点云集合Ξ
s
、反光板位姿集合Ξ
r
分别为：
[0049][0050][0051][0052]优选地，在S4中：所述的动态更新或覆盖地图包括如下步骤：
[0053](1)建立覆盖工作环境的地图，并将轨迹和子图保存，
[0054](2)在下次作业开始时，对原先存储的地图和轨迹进行加载，机器人在场景内建立一条新的轨迹，并产生新的子图，
[0055](3)定位过程中保留新建立的三个子图，并将其以滑动窗口的形式更新原来重叠的子图部分，
[0056](4)在产生新的轨迹后，对整个地图进行更新，使系统中保存的地图始终是经最新动态探索而得到的地图m。
[0057]由于上述技术方案运用，本专利技术与现有技术相比具有下列优点：
[0058]1.本专利技术基于子图更新的方式对地图进行动态更新，可有效应对环境的动态变化，提高了激光匹配的鲁棒性，提高了定位的精准性。
[0059]2.本专利技术将反光板约束条件加入SLAM后端优化的过程，使得优化过程更加快速且准确，并获得了更加精准的状态估计结果。
附图说明
[0060]附图1为本专利技术的动态激光SLAM方法流程图；
[0061]附图2为本专利技术的前端扫描匹配过程示意图；
[0062]附图3为本专利技术的插入子图过程示意图；
[0063]附图4为本专利技术的后端优化过程示意图；
[0064]附图5为本专利技术的动态地图更新过程示意图。
具体实施方式
[0065]下面将结合附图对本专利技术的技术方案进行清楚、完整地描述，显然，所描述的实施例是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。
[0066]一种基于子图更新和反光板优化本文档来自技高网...
【技术保护点】
【技术特征摘要】
1.一种基于子图更新和反光板优化的动态激光SLAM方法，其特征在于：包括如下步骤：S1：实时获取激光数据，进行前端扫描匹配，将激光数据插入子图；S2：根据激光数据的强度信息和初步估计位姿，解析并匹配反光板；S3：根据建立好的约束构建后端优化目标，优化轨迹和地图；S4：根据建图或定位的需求，动态更新或覆盖地图。2.根据权利要求1所述的基于子图更新和反光板优化的动态激光SLAM方法，其特征在于：在S1中：所述的前端扫描匹配包括如下步骤：(1)进行粗细粒度的扫描匹配，(2)进行基于Ceres优化的扫描匹配，(3)得到激光帧插入位姿。3.根据权利要求2所述的基于子图更新和反光板优化的动态激光SLAM方法，其特征在于：所述的粗细粒度的扫描匹配的搜索式为所述的基于Ceres优化的扫描匹配的搜索式为式中：T
ξ
为扫描点到地图坐标系的变换，h
k
为激光束的扫描点集。4.根据权利要求1所述的基于子图更新和反光板优化的动态激光SLAM方法，其特征在于：在S1中：所述的插入子图包括如下步骤：(1)将当前帧的点云分别插入相邻的两个子图，(2)对已生成的子图进行激光帧
‑
子图的扫描匹配，若响应达到指定的阈值，则视为找到回环，(3)将激光帧与子图的约束加入后端，进行周期性的全局优化。5.根据权利要求1所述的基于子图更新和反光板优化的动态激光SLAM方法，其特征在于：在S2中：所述的解析并匹配反光板包括如下步骤：(1)对每一个激光帧设定激光强度阈值，在超过阈值的区域进行局部极大值检测，获得反光柱圆心到激光雷达的位置，并获取其相对于激光雷达的直线距离和偏转角度信息，定义激光坐标系下的反光板位置为R
n
＝{d
′
,θ
′
}，机器人坐标系下的反光板位置为R
′
n
＝{d,θ}，对激光坐标系和机器人坐标系下的相对位姿变换，(2)根据当前机器人的位姿对检测到的反光板进行初步判断，根据反光板安装时的位置并按照距离最近原则的匹配标准进行匹配，获取反光板的唯一标识，将反光板位姿...
【专利技术属性】
技术研发人员：陈浩，邓若愚，
申请(专利权)人：同济人工智能研究院苏州有限公司，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。