基于支持向量机的激光SLAM帧间匹配自适应切换方法技术

本发明专利技术公开了一种基于支持向量机的激光SLAM帧间匹配自适应切换方法。本发明专利技术首先手动控制AGV在工作环境中进行移动，利用激光SLAM算法对所处环境构建二维栅格地图；其次输入AGV目标点的位姿信息，利用导航算法中的路径规划算法规划出一条最优的运行路线；最后同步采集惯性测量单元和激光雷达的数据，将采集的环境特征点数目、周围环境与AGV之间的距离代入支持向量机模型进行判断，根据输出的值来判断AGV在该时刻所处的环境状态，从而来适应性切换为ICP算法或CSM算法。本发明专利技术克服了仓库环境表征数据非线性的、低维的难点，能够较大程度保留特征的信息，易于操作，可以满足大部分应用环境的需求。应用环境的需求。应用环境的需求。

【技术实现步骤摘要】
基于支持向量机的激光SLAM帧间匹配自适应切换方法


[0001]本专利技术涉及机器人定位
，尤其涉及一种基于支持向量机的激光SLAM帧间匹配自适应切换方法。

技术介绍

[0002]在仓库环境中，传统的GPS、二维码、磁带和超宽带等定位方式虽然精度较高，但这些定位方式容易受到应用环境等因素的影响，定位灵活性差。SLAM(Simultaneous Localization and Mapping)技术主要解决在未知环境下只通过本体搭载的传感器就能实现定位与建图的问题，因其具有定位精度高、定位方式灵活等特点，被广泛地应用在AGV定位领域。
[0003]在基于SLAM的定位技术中，激光SLAM是较为成熟的一种，该技术首先对里程计和IMU的测量数据进行计算获得估计位姿，然后通过帧间匹配方法对激光雷达相邻帧的点云数据进行计算来校正估计位姿，从而获得精确的位姿信息。因此，帧间匹配方法是影响定位精度的关键因素之一。
[0004]现有的2D激光SLAM帧间匹配方法存在一定的缺陷，在复杂环境中无法提供准确、稳定的匹配信息。近年来，自适应切换定位技术被广泛的应用在定位导航领域，该技术通过切换方法在不同的定位方式之间切换，从而提高在复杂环境中的定位精度。因此，在仓库环境中使用相同的技术对激光SLAM帧间匹配方法进行切换，可以解决激光SLAM算法在复杂环境中匹配效果差的问题，但现有的切换定位技术大多在GPS和WiFi定位方式之间进行切换，在仓库环境中存在信号差、设备安装困难等问题，无法满足对激光SLAM帧间匹配方法自适应切换的要求。

技术实现思路

[0005]针对上述问题，本专利技术目的在于提供一种基于支持向量机的激光SLAM帧间匹配自适应切换方法，即首先利用2D激光雷达建立工作环境的栅格地图，然后在已经建立好的地图上采用自适应切换的方法在ICP算法和CSM算法之间进行切换。
[0006]本专利技术包括以下步骤：
[0007]步骤1，在远程监控终端上，手动控制AGV在工作环境中进行移动，利用激光SLAM算法对所处环境构建二维栅格地图；
[0008]步骤2，输入AGV目标点的位姿信息，利用导航算法中的路径规划算法规划出一条最优的运行路线；
[0009]步骤3，当AGV启动运行时，同步采集惯性测量单元和激光雷达的数据，其中环境特征点数目η和周围环境与AGV之间的距离λ，都是通过激光雷达扫描周围环境经过处理后获得；
[0010]将η和λ的值代入支持向量机模型进行判断，根据输出的值来判断AGV在该时刻所处的环境状态，从而来适应性切换为ICP算法或CSM算法。
[0011]本专利技术的有益效果：该自适应切换方法克服了仓库环境表征数据非线性的、低维的难点，能够较大程度保留特征的信息，易于操作，可以满足大部分应用环境的需求。
附图说明
[0012]图1为本专利技术切换方法框图。
具体实施方式
[0013]以下结合附图并通过具体实施方式来进一步说明本专利技术的技术方案。
[0014]如图1所示，本专利技术提供了一种基于支持向量机的激光SLAM帧间匹配自适应切换方法，步骤如下：
[0015]步骤1，在远程监控终端上，手动控制AGV在工作环境中进行移动，利用激光SLAM算法对所处环境构建二维栅格地图。
[0016]步骤2，在远程监控终端上输入AGV目标点的位姿信息，利用导航算法中的路径规划算法规划出一条最优的运行路线。
[0017]步骤3，建立了一种能够把低维空间中无法线性分类的数据样本转化为高维空间中线性可分的非线性模型，模型表示如下：
[0018]f(x)＝W
T
φ(x)+b
ꢀꢀꢀꢀꢀ
公式(1)
[0019]公式(1)中，φ(x)表示为x映射后的特征向量，W,b为待求解的参数；
[0020]得到最小化函数：
[0021][0022]s.t.y
i
(W
T
φ(x)+b)
‑
1≥0
[0023]最小化函数的对偶问题为：
[0024][0025][0026]α
i
≥0
[0027]公式(3)中，样本x
i
和x
j
映射到到特征空间的时候，如果此时的特征变量非常多，那么在高维空间中计算内积φ(x
i
)
T
φ(x
i
)的运算量巨大，于是采用函数κ(x
i
,x
j
)来解决这个问题把内积的值转变成由函数κ(x
i
,x
j
)得到的值，于是对偶问题便可转化为
[0028][0029][0030]α
i
≥0
[0031]最后求解可以得到：
[0032][0033]公式(5)中，函数κ(x
i
,x
j
)就是核函数。核函数定义：假设输入空间为χ，特征空间为H，若存在从χ到H的映射φ(x):χ
→
H，使得对于所有的x
i
,x
j
∈χ，函数κ(x
i
,x
j
)满足条件κ(x
i
,x
j
)＝φ(x
i
)φ(x
j
)，那么就可以得到内积为φ(x
i
)*φ(x
j
)，κ(x
i
,x
j
)为核函数，φ(x)映射函数。本专利技术采用的核函数为高斯核函数。
[0034]在线性支持向量机学习的对偶问题中，用核函数κ(x
i
,x
j
)替代内积，求解得到的就是非线性支持向量机。
[0035]在仓库的开阔环境与狭窄环境中，根据环境的不同选择不同的匹配算法可以提高算法的匹配精度与AGV的定位精度。这个切换算法问题本质上是一个二分类问题，目前主流的分类方法有神经网络与SVM方法，但是神经网络方法需要大量的训练样本，而SVM方法不需要过多的数据样本，就能够达到相同的二分类效果，得出SVM方法具有更强的泛化能力。因此，本专利技术确定采用SVM方法。
[0036]步骤4，当AGV启动运行时，同步采集惯性测量单元和激光雷达的数据，其中环境特征点数目η和周围环境与AGV之间的距离λ，都是通过激光雷达扫描周围环境经过处理后获得的。将η和λ的值代入模型即公式(1)中进行判断，根据输出的值来判断AGV在该时刻所处的环境状态。
[0037]步骤5，根据输入的η值与λ值的大小来判断AGV此时所处的环境，并且根据输出的标识值来判断此时采用的算法。例如输入的η值小、λ值大，输出的标识值为0，说明此时AGV处于宽阔的环境中，四周障碍物少，采用CSM算法，该方法适用于大场景的环境，如AGV工业生产中的上下料区、物流仓库中的货物中转区。
[0038]进一步地本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.基于支持向量机的激光SLAM帧间匹配自适应切换方法，其特征在于该方法包括以下步骤：步骤1，在远程监控终端上，手动控制AGV在工作环境中进行移动，利用激光SLAM算法对所处环境构建二维栅格地图；步骤2，输入AGV目标点的位姿信息，利用导航算法中的路径规划算法规划出一条最优的运行路线；步骤3，当AGV启动运行时，同步采集惯性测量单元和激光雷达的数据，其中环境特征点数目η和周围环境与AGV之间的距离λ，都是通过激光雷达扫描周围环境经过处理后获得；将η和λ的值代入支持向量机模型进行判断，根据输出的值来判断AGV在该时刻所处的环境状态，从而来适应性切换为ICP算法或CSM算法。2.根据权利要求1所述的基于支持向量机的激光SLAM帧间匹配自适应切换方法，其特征在于：所述环境特征点数目η由特征点提取算法确定，使用特征提取算法对断点、角点进行提取；所述断点为货物与货物之间呈现出由物体边缘形成的一系列断点，所述角点为货架与地面接触的位置。3.根据权利要求1所述的基于支持向量机的激光SLAM帧间匹配自适应切换方法，其特征在于：所述周围环境与AG...

【专利技术属性】
技术研发人员：陈迪剑，钟昊，向韬，谢楚良，陈凝期，
申请(专利权)人：中国计量大学，
类型：发明
国别省市：