一种移动机器人的走廊识别方法及装置制造方法及图纸

本发明专利技术实施例公开了一种移动机器人的走廊识别方法及装置。其中，该方法包括：依据里程计检测结果预测移动机器人的第一位姿信息；基于迭代就近点法ICP算法将所述移动机器人采集的激光数据与已有地图进行匹配，得到所述移动机器人的第二位姿信息；计算所述第一位姿信息与所述第二位姿信息的差值；若预先更新的期望位姿模型收敛，则依据所述期望位姿模型以及所述差值从所述第一位姿信息和所述第二位姿信息中选择当前位姿信息；依据选择的当前位姿信息以及采集的激光数据更新地图。本发明专利技术实施例提供的技术方案，解决了移动机器人基于激光雷达进行定位建图中的走廊问题，从而使得所建地图更加准确。

【技术实现步骤摘要】
一种移动机器人的走廊识别方法及装置
本专利技术涉及智能移动机器人
，尤其涉及一种移动机器人的走廊识别方法及装置。
技术介绍
在信息时代，随着智能移动机器人的发展和普及，基于激光雷达进行定位建图的技术由于其较高的精度且无需对环境进行任何修改也得到广泛的应用。目前，智能移动机器人基于激光雷达在一条长廊中移动采用的ICP(迭代就近点法，IterativeClosestPoint)算法进行定位建图，由于采集的走廊图像具有相似性，使得ICP法在判断机器人是否发生移动时容易出现误判现象，即ICP法判断机器人没有移动，但实际上机器人可能发生了移动。
技术实现思路
本专利技术实施例提供一种移动机器人的走廊识别方法及装置，根据预先更新的期望位姿模型来判断是采用ICP算法的输出结果还是里程计输出的结果来更新地图，解决了移动机器人基于激光雷达进行定位建图中的走廊问题，从而使得所建地图更加准确。第一方面，本专利技术实施例提供了一种移动机器人的走廊识别方法，该方法包括：依据里程计检测结果预测移动机器人的第一位姿信息；基于迭代就近点法ICP算法将所述移动机器人采集的激光数据与已有地图进行匹配，得到所述移动机器人的第二位姿信息；计算所述第一位姿信息与所述第二位姿信息的差值；若预先更新的期望位姿模型收敛，则依据所述期望位姿模型以及所述差值从所述第一位姿信息和所述第二位姿信息中选择当前位姿信息；依据选择的当前位姿信息以及采集的激光数据更新地图。第二方面，本专利技术实施例还提供了一种移动机器人的走廊识别装置，该装置包括：第一位姿预测模块，用于依据里程计检测结果预测移动机器人的第一位姿信息；第二位姿获取模块，用于基于迭代就近点法ICP算法将所述移动机器人采集的激光数据与已有地图进行匹配，得到所述移动机器人的第二位姿信息；差值计算模块，用于计算所述第一位姿信息与所述第二位姿信息的差值；当前位姿获取模块，用于若预先更新的期望位姿模型收敛，则依据所述期望位姿模型以及所述差值从所述第一位姿信息和所述第二位姿信息中选择当前位姿信息；地图更新模块，用于依据选择的当前位姿信息以及采集的激光数据更新地图。本专利技术实施例提供的移动机器人的走廊识别方法及装置，将由里程计预测移动机器人得到的第一位姿信息与ICP算法输出的机器人的第二位姿信息的做差得到差值，依据预先更新的期望位姿模型的收敛性以及该差值选择当前的位姿信息即根据预先更新的期望位姿模型来判断是采用ICP算法的输出结果还是里程计输出的结果来更新地图，解决了移动机器人基于激光雷达进行定位建图中的走廊问题，从而使得所建地图更加准确。附图说明通过阅读参照以下附图所作的对非限制性实施例所作的详细描述，本专利技术的其它特征、目的和优点将会变得更明显：图1是本专利技术实施例一中提供的一种移动机器人的走廊识别方法的流程图；图2是本专利技术实施例二中提供的一种移动机器人的走廊识别方法的流程图；图3是本专利技术实施例三中提供的一种移动机器人的走廊识别方法的流程图；图4是本专利技术实施例四中提供的一种移动机器人的走廊识别装置的结构框图。具体实施方式下面结合附图和实施例对本专利技术作进一步的详细说明。可以理解的是，此处所描述的具体实施例仅用于解释本专利技术，而非对本专利技术的限定。另外还需要说明的是，为了便于描述，附图中仅示出了与本专利技术相关的部分而非全部内容。实施例一图1为本专利技术实施例一提供的一种移动机器人的走廊识别方法的流程图，本实施例可适用于智能移动机器人在基于激光雷达在走廊中进行定位建地图的情况。该方法可以由本专利技术实施例提供的移动机器人的走廊识别装置来执行，该装置可采用软件和/或硬件的方式实现。参见图1，该方法具体包括：S110，依据里程计检测结果预测移动机器人的第一位姿信息。其中，位姿信息指移动机器人的位置和姿态，位置表示移动机器人相对世界坐标的位置(平移)，一般用坐标(x，y)表示，姿态表示移动机器人的偏航角即机器人实际前进方向与期望前进方向之间的偏差角度，可选用Φ表示。由此，位姿信息对应的即为三维空间信息可用(x，y，Φ)表示。对应的第一位姿信息可用n1＝(x1，y1，Φ1)表示。里程计是一种用于测量行程及速度的装置，移动机器人中设置有里程计，可用于估测移动机器人的位姿信息即第一位姿信息。S120，基于迭代就近点法ICP算法将移动机器人采集的激光数据与已有地图进行匹配，得到移动机器人的第二位姿信息。其中，迭代就近点法ICP算法用于寻求点集之间的匹配关系，求解的结果是两点集之间的平移及旋转量。激光数据即由位于移动机器人上的激光雷达采集的经过平滑滤波过滤掉噪点后的数据。具体的，将移动机器人采集的激光数据作为第一点集，已有地图中对应的数据作为第二点集，将三维空间中第一点集中各点经过三维空间变换后与第二点集中点一一对应，求解得到的两点之间的平移及旋转量即为移动机器人的第二位姿信息。相应的，第二位姿信息可以用n2＝(x2，y2，Φ2)。S130，计算第一位姿信息与第二位姿信息的差值。将里程计获得的移动机器人的第一位姿信息n1减去ICP算法得到的移动机器人的第一位姿信息n2即可得到差值n3，n3＝(x3，y3，Φ3)。S140，若预先更新的期望位姿模型收敛，则依据期望位姿模型以及差值从第一位姿信息和第二位姿信息中选择当前位姿信息。其中，期望位姿模型是基于第一位姿信息与第二位姿信息的差值建立的三维高斯模型，模型中的元素有三维均值向量和三维均值向量的协方差矩阵；三维均值向量即为第一位姿信息与第二位姿信息的差值的均值对应的向量；协方差矩阵为3ⅹ3矩阵。判断三维高斯模型收敛的条件即为协方差矩阵的迹值是否足够小，协方差的迹值是指所有主对角线上的元素之和。初始化条件下期望位姿模型中的元素值均为0，对应的预先更新的期望位姿模型是将第一位姿信息与第二位姿信息的差值输入后得到的。当预先更新的期望位姿模型中协方差矩阵的迹值小于预先设定的阈值如小于10-6时，则可确定预先更新的期望位姿模型收敛，此时，可依据一定的规则从第一位姿信息和第二位姿信息中选择一个位姿信息作为当前位姿信息。如可以根据期望位姿模型以及差值确定里程计和ICP算法哪个精度更高，从而确定将第一位姿信息还是第二位姿信息作为当前位姿信息。示例性的，还可以包括：若预先更新的期望位姿模型不收敛，则将第二位姿信息选作当前位姿信息。需要说明的是，一般情况下，里程计累计误差大，如移动机器人的轮子打滑时，ICP算法输出的数据的精度相对较高。因此，当预先更新的期望位姿模型不收敛，可将第二位姿信息即ICP算法输出的移动机器人的位姿信息选作当前位姿信息，同时更新里程预测值。S150，依据选择的当前位姿信息以及采集的激光数据更新地图。具体的，根据得到的移动机器人的当前位姿信息，将激光雷达采集的激光数据插入到已有地图中相应的位置并更新该地图。本专利技术实施例提供的移动机器人的走廊识别方法，将由里程计预测移动机器人得到的第一位姿信息与ICP算法输出的机器人的第二位姿信息的做差得到差值，依据预先更新的期望位姿模型的收敛性以及该差值选择当前的位姿信息即根据预先更新的期望位姿模型来判断是采用ICP算法的输出结果还是里程计输出的结果来更新地图，解决了移动机器人基于激光雷达进行定位建图中的走廊问题，从而使得所建地图更加准确。实施例二图2为本专利技术实施例二提供本文档来自技高网...

【技术保护点】
1.一种移动机器人的走廊识别方法，其特征在于，包括：依据里程计检测结果预测移动机器人的第一位姿信息；基于迭代就近点法ICP算法将所述移动机器人采集的激光数据与已有地图进行匹配，得到所述移动机器人的第二位姿信息；计算所述第一位姿信息与所述第二位姿信息的差值；若预先更新的期望位姿模型收敛，则依据所述期望位姿模型以及所述差值从所述第一位姿信息和所述第二位姿信息中选择当前位姿信息；依据选择的当前位姿信息以及采集的激光数据更新地图。

【技术特征摘要】
1.一种移动机器人的走廊识别方法，其特征在于，包括：依据里程计检测结果预测移动机器人的第一位姿信息；基于迭代就近点法ICP算法将所述移动机器人采集的激光数据与已有地图进行匹配，得到所述移动机器人的第二位姿信息；计算所述第一位姿信息与所述第二位姿信息的差值；若预先更新的期望位姿模型收敛，则依据所述期望位姿模型以及所述差值从所述第一位姿信息和所述第二位姿信息中选择当前位姿信息；依据选择的当前位姿信息以及采集的激光数据更新地图。2.根据权利要求1所述的方法，其特征在于，依据所述期望位姿模型以及所述差值从所述第一位姿信息和所述第二位姿信息中选择当前位姿信息，包括：计算所述差值与所述期望位姿模型中的均值向量之间的马氏距离；若所述马氏距离大于距离阈值，则将所述第一位姿信息选作当前位姿信息；否则，将所述第二位姿信息选作当前位姿信息。3.根据权利要求1所述的方法，其特征在于，还包括：若预先更新的期望位姿模型不收敛，则将所述第二位姿信息选作当前位姿信息。4.根据权利要求2所述的方法，其特征在于，从所述第一位姿信息和所述第二位姿信息中选择当前位姿信息之后，还包括：依据得到的差值更新所述期望位姿模型。5.根据权利要求4所述的方法，其特征在于，依据得到的差值更新所述期望位姿模型，包括：依据得到的差值更新差值均值，并依据更新的差值均值更新所述期望位姿模型中的均值向量；依据更新的均值向量更新所述期望位姿模型中的协方差矩阵。6.一种移动机器人的走廊识别装...

【专利技术属性】
技术研发人员：洪东升，白静，李宇翔，
申请(专利权)人：上海思岚科技有限公司，
类型：发明
国别省市：上海,31