一种基于二阶矩保持传播算法的拓扑地图融合方法及系统技术方案

本发明专利技术提供一种基于二阶矩保持传播算法的拓扑地图融合方法及系统。所述方法包括：S1，基于概率性广义Voronoi图方法对不同地图进行融合；S2，通过二阶矩保持传播方法消除地图融合的非线性不确定度。本发明专利技术首先在保留地图显著性信息的情况下，对地图进行骨架的提取，这样可以简化地图中的信息，使运算更加简便；考虑到了使用PGVD时占用栅格地图中的不确定度，利用线性化来解决转换过程中的不确定度问题。比起其他算法，它是快速且鲁棒的，能够对相似度更大的区域进行优先匹配。

Topological map fusion method and system based on two order moment preserving propagation algorithm

The invention provides a topological map fusion method and system based on a two order moment preserving propagation algorithm. The method comprises the following steps: S1, fusing different maps based on probabilistic generalized Voronoi chart; S2, eliminating nonlinear uncertainty of map fusion by means of two order moment preserving propagation method. The invention firstly retains significant map information, for the skeleton extraction on the map, this can simplify the map information, make the operation more convenient; taking into account when using PGVD occupancy grid map in uncertainty, converted to solve the uncertainty problem in the process of using linearization. Compared with other algorithms, it is fast and robust, and it can match the regions with greater similarity.

【技术实现步骤摘要】
一种基于二阶矩保持传播算法的拓扑地图融合方法及系统
本专利技术涉及拓扑地图融合领域，更具体地，涉及一种基于二阶矩保持传播算法的拓扑地图融合方法及系统。
技术介绍
目前，SLAM(simultaneouslocalizationandmapping，即时定位与地图构建，或并发建图与定位)是探索未知环境并融合传感器数据，并生成一个全局地图的过程，可以检测机器人的位姿并建立环境地图。移动机器人能够在环境中进行自主探索和自身定位，针对单机器人的SLAM来说已经有大量的文献，但是多机器人对未知环境的探索却没有受到同样的关注，它相对单机器人有以下几项显著优点：探索和地图构建都可以进行得更迅速；构建的分布式系统的鲁棒性更强；由于数据的冗余，结果往往更准确。多机器人SLAM在带来诸多好处的同时，也在实现当中带来了新的挑战，其中有两个主要的问题需要克服：首先是在不知道全局地图基础坐标时的地图融合，其次是在地图融合过程中产生的不确定性。对于高水平的推演和信息共享来说，首先需要将地图抽象成几何结构是基础。当使用多个机器人对未知环境进行探索并合作建立地图时，需要提供一个基础的逻辑结构，让机器人得以储存它们各自的局部空间结构，并能在该结构下使用共享信息。如果地图中的显著性信息得以提取并在机器人之间共享的话，计算速度和共有地图的准确度都会增加，而且在沟通过程中也不会有大量未处理数据占据空间。拓扑地图是一种使用连通路径和交叉节点的抽象表示方法。人类和昆虫经常使用拓扑地图来进行导航，计算路径和位置，以及避免障碍。例如，鸽子已经被证实在飞行长距离时，使用高速公路和它们的交叉点来作为拓扑地图。合作性SLAM可以根据是共享原始传感器数据还是共享处理后的地图分为两种。共享原始传感器数据可以获得更大的灵活性，但是需要机器人之间的通信更可靠，并且需要更宽的带宽和更高的处理能力。共享地图有助于减少带宽并且减少对原始数据的处理，但是，性能主要依赖于地图质量。此外，多机器人的SLAM也可以根据测量数据的方法来进行分类。在基于特征的SLAM中，一般是使用照相机来进行数据采集，并从测量之中提取独特性物体作为特征或地标，以用于定位。特征的空间分布可以作为全局环境的一个表现方式。另一种方法叫做基于视图的SLAM[，这种方法主要采用的是激光扫描的方法获取数据。Thrun提出了一种概率的多机器人SLAM算法。这种方法是鲁棒的，但是在进行具体的任务之前，我们需要得知机器人的近似初始位置。基于视图的多机器人SLAM是由Howard提出的，它假定，多个机器人需要在环境中相遇来确定相对位姿，这种算法的计算速度一般，但是需要比较高的计算能力，因为它是基于粒子滤波。对于多机器人SLAM来说，有一类有效且快速的方法是基于地图融合的概念提出的。Howard提出了一种基于占用地图融合的算法。这种算法使用地图中的距离作为相似参数，并通过一种随机游走算法来找到两幅地图中的相似模式。这种方法的缺点是，当两幅地图中的相似模式比较少时容易失败。而且由于这种方法比较耗时，所以对于室内环境中的大范围地图很有可能会效率低下。之后还提出了一个相似的方法，它使用模拟退火的方法进行地图融合，但是当两幅图像的重叠较少时，该方法也会变得效率很低。总结来看，虽然针对多机器人SLAM提出过多样的拓扑方法，但是这些方法有的效率低下，有的准确度较低，并且并没有之前的算法针对非线性转换过程中存在的不确定度提出切实有效的方法进行解决。
技术实现思路
本专利技术提供一种克服上述问题或者至少部分地解决上述问题的基于二阶矩保持传播算法的拓扑地图融合方法及系统。根据本专利技术的一个方面，提供一种基于二阶矩保持传播算法的拓扑地图融合方法，包括：S1，基于概率性广义Voronoi图方法对不同地图进行融合；S2，通过二阶矩保持传播方法消除地图融合的非线性不确定度。S1进一步包括：S1.1，利用Radon变换方法获取两幅地图之间的相对旋转角度；S1.2，利用概率性广义Voronoi图方法提取两幅地图的拓扑骨架，获取两幅地图之间的平移矩阵；S1.3，根据所述相对旋转角度和所述平移矩阵对两幅地图进行融合处理。S2进一步包括：S2.1，根据融合之后的地图的显著点进行撒点采样，获取采样点集；S2.2，通过非线性变换传递所述采样点的不确定度，获得新采样点集；S2.3，获取新采样点集的均值和方差，消除地图融合的非线性不确定度。根据本专利技术的另一个方面，提供一种基于二阶矩保持传播算法的拓扑地图融合系统，包括地图融合模块和非线性消除模块，所述地图融合模块，用于基于概率性广义Voronoi图方法对不同地图进行融合；所述非线性消除模块，用于通过二阶矩保持传播方法消除地图融合的非线性不确定度本申请提出的基于二阶矩保持传播算法的拓扑地图融合方法及系统，考虑到使用PGVD时占用栅格地图中的不确定度，利用线性化来解决转换过程中的不确定度问题。比起其他算法，它是快速且鲁棒的，能够对相似度更大的区域进行优先匹配。附图说明图1为本专利技术基于二阶矩保持传播算法的拓扑地图融合方法流程图；图2为本专利技术第一实施例对规则地图的融合示意图；图3为本专利技术第二实施例对不规则地图的融合示意图；图4为本专利技术基于二阶矩保持传播算法的拓扑地图融合系统示意图。具体实施方式下面结合附图和实施例，对本专利技术的具体实施方式作进一步详细描述。以下实施例用于说明本专利技术，但不用来限制本专利技术的范围。本专利技术应用于多机器人的环境探索和地图融合领域，合作性SLAM共享处理后的地图进行地图融合，并采样激光扫描的方法获取地图数据作为本专利技术算法的输入数据。如图1所示，一种基于二阶矩保持传播算法的拓扑地图融合方法，包括：S1，基于概率性广义Voronoi图方法对不同地图进行融合；S2，通过二阶矩保持传播方法消除地图融合的非线性不确定度。S1包括S1.1、S1.2和S1.3：S1.1，利用Radon变换方法获取两幅地图之间的相对旋转角度。具体实现为：Radon变换是沿着一个特定角度的径向线，进行在该角度上的线积分。针对二维图像f(x,y)来说，垂直方向的线积分是f(x,y)投影到x轴，水平方向的线积分是f(x,y)投影到y轴。沿不同角度的线积分可用下面的公式进行计算：Radon变换的峰值对应的是图像中的直线部分。分别对两副地图进行Radon变换，分别获取两幅图像中的峰值，确定两幅图像中对应峰值之间对应的角度差，就可以得到两幅图像之间的相对旋转角度。S1.2，利用概率性广义Voronoi图方法提取两幅地图的拓扑骨架，获取两幅地图之间的平移矩阵。在进行S1.2的具体实现之前需要先确定如下问题：A.联络点。一个区域的联络点指的是距离区域点最近且与其他某个区域距离相同的所有被占用区域点的集合。占用栅格地图中联络点的概率特性会被用来建立概率性广义Voronoi图。B.概率性广义Voronoi图。广义Voronoi图中的每一个区域都可以用一个二维随机变量来表示它的占用联络点超过2个的概率，这也是基于占用栅格地图的占用概率。具体实现为：1.在二维占用栅格地图中通过数学上的形态学操作提取地图的广义Voronoi图。所述广义Voronoi图和原始地图拥有相同的大小，是对于原始地图中显著性信息的提取；通过提取广义Voronoi图，可以在保留地图重要本文档来自技高网...

【技术保护点】
一种基于二阶矩保持传播算法的拓扑地图融合方法，其特征在于，包括：S1，基于概率性广义Voronoi图方法对不同地图进行融合；S2，通过二阶矩保持传播算法消除地图融合的非线性不确定度。

【技术特征摘要】
1.一种基于二阶矩保持传播算法的拓扑地图融合方法，其特征在于，包括：S1，基于概率性广义Voronoi图方法对不同地图进行融合；S2，通过二阶矩保持传播算法消除地图融合的非线性不确定度。2.如权利要求1所述的方法，其特征在于，S1进一步包括：S1.1，利用Radon变换方法获取两幅地图之间的相对旋转角度；S1.2，利用概率性广义Voronoi图方法提取两幅地图的拓扑骨架，获取两幅地图之间的平移矩阵；S1.3，根据所述相对旋转角度和所述平移矩阵对两幅地图进行融合处理。3.如权利要求1所述的方法，其特征在于，S2进一步包括：S2.1，根据融合之后的地图的显著点进行撒点采样，获取采样点集；S2.2，通过非线性变换传递所述采样点的不确定度，获得新采样点集；S2.3，获取新采样点集的均值和方差，消除地图融合的非线性不确定度。4.如权利要求2所述的方法，其特征在于，S1.1.1进一步包括：S1.1.1，分别获取两幅地图沿不同角度二维图像的投影；S1.1.2，通过投影变换后的两幅地图的峰值获取相对旋转角度差。5.如权利要求2所述的方法，其特征在于，S1.2进一步包括：S1.2.1，基于二维占用栅格地图，通过数学上的形态学操作分别提取每幅地图的广义Voronoi图；S1.2.2，基于二维占用栅格地图的实际概率分别计算每幅地图的广义Voronoi图中每个区域的相应概率，获取每幅地图的概率性广义Voronoi图；S1.2.3，计算两幅概率性广义Voronoi图的相似度获取平移矩阵。6.如权利要求3所述的方法，其特征在于，S2.1中所述采样点集满足：

【专利技术属性】
技术研发人员：姜竹青，张光华，陈曦，曲芮，张北航，门爱东，杨波，
申请(专利权)人：北京邮电大学，
类型：发明
国别省市：北京,11