一种移动机器人导航系统定位精度测试方法

摘要

本发明公开了一种移动机器人导航系统定位精度测试方案，包括以下步骤：测试环境选取、SLAM定位建图、移动机器人定位参考点选取、激光测距仪测量真实位移、传感器定位数据采集计算测量位移、高斯分布拟合、定位精度计算。相比于已有技术，本发明成本低、高效、测量方便、精度高、适用场景多、可靠性高、覆盖区域广、隐私入侵度低等优点。

权利要求

1.一种移动机器人导航系统定位精度测试方法，其特征在于，包括以下步骤：S1、选择固定室内环境的测试场景；

S2、通过同步定位与实时建图技术，建立S1中测试场景下的栅格图，然后开启定位，得到移动机器人的定位信息；

S3、在起点开启定位，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人的XOY的坐标系仅存在平移关系，将车开到某一个点P作为参考点，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和右边测距Dright_top、Dright_bottom，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面平行，参考点选取成功；

S4、通过激光测距仪得到原点到达两个墙面的距离(m0,n0)，并读取参考点传感器的定位数据(x0,y0)；

S5、以任意路径行驶后返回原点附近，得到新的位置Q，根据S3的方法重新使车体与墙面平行，读取传感器的定位数据(xi,yi)和激光测距仪得到两个墙面的距离(mi,ni)；

S6 、计算 真实 位移 ,测量位 移则定位误差为errori＝di‑di′；

S7、重复S5和S6，得到多组数据，若多组数据的定位误差满足±N，则说明定位误差达到了±N。

2.根据权利要求1所述的一种移动机器人导航系统定位精度测试方法，其特征在于：步骤S1中，测试环境选取选择特征点丰富的环境、干扰因素少的室内固定环境且不存在动态的物体。

3.根据权利要求1所述的一种移动机器人导航系统定位精度测试方法，其特征在于：步骤S3中，判断移动机器人与墙面平行的方法通过俯视车体侧面边界与地面和墙面的交线是否重合，来初步判断平行，并移动车体到适当的角度，通过直尺测量左边两个轮子正中心分别到墙面距离是否完全相等，再测量右边两个轮子正中心分别到墙面距离是否完全相等。

4.根据权利要求1所述的一种移动机器人导航系统定位精度测试方法，其特征在于：步骤S3中，所述激光测距仪经测试得到误差小于1mm，激光测距仪可以测算出激光测距仪的后端到墙面的距离，测量时，保持车辆静止不动，取10‑20次读数的平均值进行记录。

5.根据权利要求1所述的一种移动机器人导航系统定位精度测试方法，其特征在于：步骤S4和S5中，定位数据应将5分钟内计算的位姿全部记录下来。

6.根据权利要求1所述的一种移动机器人导航系统定位精度测试方法，其特征在于：步骤S6中，两点真实位移由激光测距仪得到数据计算得到，对于测量位移，将数据拟合成一个高斯分布，得到均值和方差，由高斯分布积分可得，有0.95的概率满足精度时候，得到定位误差±N。

说明书

一种移动机器人导航系统定位精度测试方法

技术领域

[0001] 本发明涉及移动机器人技术领域，具体为一种移动机器人导航系统定位精度测试方法。

背景技术

[0002] 随着科技的发展，机器人已经在全世界范围内得到了广泛的应用。机器人关键技术的研究已经成为各国科技和产业的热点话题，机器人的发展也已经成为衡量国家科技水
平、工业化先进水平的一个重要指标。

[0003] 而移动机器人的重复定位精度是最重要、最基本的性能指标，唯有实现精准的位置定位，才可以拓展机器人的其他功能。对于不同的场景，机器人的定位精度要求就不同。
室内是移动机器人使用最多的场景，现如今室内服务机器人已经开始走进了百姓的视野，
在家庭中应用广泛的扫地机器人，银行、酒店等公共场所配备的迎宾机器人。对于室内的移
动机器人定位精度通常在±3cm即可满足导航系统的要求。但对于物流搬运的工业移动仓
储机器人，所需的定位精度则更高，通常在±1cm以内，为此我们提出一种移动机器人导航
系统定位精度测试方法用于解决上述问题。

发明内容

[0004] 本发明的目的在于提供一种移动机器人导航系统定位精度测试方法，以解决上述背景技术中提出的问题。

[0005] 为实现上述目的，本发明提供如下技术方案：一种移动机器人导航系统定位精度测试方法，其特征在于，包括以下步骤：

[0006] S1、选择固定室内环境的测试场景；

[0007] S2、通过同步定位与实时建图(SLAM)技术，建立S1中测试场景下的栅格图，然后开启定位，得到移动机器人的定位信息；

[0008] S3、在起点开启定位，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人的XOY的坐标系仅存在平移关系，将车开到某一个点P作
为参考点，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和
右边测距Dright_top、Dright_bottom，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面
平行，参考点选取成功；

[0009] S4、通过激光测距仪得到原点到达两个墙面的距离(m0,n0)，并读取参考点传感器的定位数据(x0,y0)；

[0010] S5、以任意路径行驶后返回原点附近，得到新的位置Q，根据S3的方法重新使车体与墙面平行，读取传感器的定位数据(xi,yi)和激光测距仪得到两个墙面的距离(mi,ni)；

[0011] S6、计算真实位移 测量位移则定位误差为errori＝di‑di′；

[0012] S7、重复S5和S6，得到多组数据，若多组数据的定位误差满足±N，则说明定位误差达到了±N。

[0013] 优选的一种实施案例，步骤S1中，测试环境选取选择特征点丰富的环境、干扰因素少的室内固定环境且不存在动态的物体。

[0014] 优选的一种实施案例，步骤S3中，判断移动机器人与墙面平行的方法通过俯视车体侧面边界与地面和墙面的交线是否重合，来初步判断平行，并移动车体到适当的角度，通
过直尺测量左边两个轮子正中心分别到墙面距离是否完全相等，再测量右边两个轮子正中
心分别到墙面距离是否完全相等。

[0015] 优选的一种实施案例，步骤S3中，所述激光测距仪经测试得到误差小于1mm，激光测距仪可以测算出激光测距仪的后端到墙面的距离，测量时，保持车辆静止不动，取10‑20
次读数的平均值进行记录。

[0016] 优选的一种实施案例，步骤S4和S5中，定位数据应将5分钟内计算的位姿全部记录下来。

[0017] 优选的一种实施案例，步骤S6中，两点真实位移由激光测距仪得到数据计算得到，对于测量位移，将数据拟合成一个高斯分布，得到均值和方差，由高斯分布积分可得，有
0.95的概率满足精度时候，得到定位误差±N。

[0018] 与现有技术相比，本发明的有益效果是：本发明成本低、高效、测量方便、精度高、适用场景多、可靠性高、覆盖区域广、隐私入侵度低等优点。

附图说明

[0019] 图1为本发明总体框架；

[0020] 图2为本发明中时定位与建图SLAM；

[0021] 图3为本发明图中定位高斯分布图。

具体实施方式

[0022] 下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于
本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他
实施例，都属于本发明保护的范围。

[0023] 请参阅图1‑3，本发明提供一种技术方案：一种移动机器人导航系统定位精度测试方法，其特征在于，包括以下步骤：

[0024] S1、选择固定室内环境的测试场景；

[0025] S2、通过同步定位与实时建图(SLAM)技术，建立S1中测试场景下的栅格图，然后开启定位，得到移动机器人的定位信息；

[0026] S3、在起点开启定位，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人的XOY的坐标系仅存在平移关系，将车开到某一个点P作
为参考点，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和
右边测距Dright_top、Dright_bottom，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面
平行，参考点选取成功；

[0027] S4、通过激光测距仪得到原点到达两个墙面的距离(m0,n0)，并读取参考点传感器的定位数据(x0,y0)；

[0028] S5、以任意路径行驶后返回原点附近，得到新的位置Q，根据S3的方法重新使车体与墙面平行，读取传感器的定位数据(xi,yi)和激光测距仪得到两个墙面的距离(mi,ni)；

[0029] S6、计算真实位移 测量位移则定位误差为errori＝di‑di′；

[0030] S7、重复S5和S6，得到多组数据，若多组数据的定位误差满足±N，则说明定位误差达到了±N。

[0031] 进一步的，步骤S1中，测试环境选取选择特征点丰富的环境、干扰因素少的室内固定环境且不存在动态的物体。

[0032] 进一步的，步骤S3中，判断移动机器人与墙面平行的方法通过俯视车体侧面边界与地面和墙面的交线是否重合，来初步判断平行，并移动车体到适当的角度，通过直尺测量
左边两个轮子正中心分别到墙面距离是否完全相等，再测量右边两个轮子正中心分别到墙
面距离是否完全相等。

[0033] 进一步的，步骤S3中，在车上固定两个激光测距仪，两个激光测距仪垂直摆放，其中一个激光测距仪保持与车体平行，激光测距仪经测试得到误差小于1mm，激光测距仪可以
测算出激光测距仪的后端到墙面的距离，激光测距仪的读数可能在0‑1mm内跳变，激光测距
仪可以测算出激光测距仪的后端到墙面的距离，测量时，保持车辆静止不动，取10‑20次读
数的平均值进行记录，测量前，已保证车体与墙面平行或垂直，所以激光测距仪测得数据为
激光垂直到达墙面的距离，激光垂直打到两个墙面，得到分别到达两个墙面的垂直距离。

[0034] 进一步的，步骤S4和S5中，小车在静止的时候，也会实时执行匹配算法，输出定位数据，由于实时计算得到的位姿收敛值不完全相同以及受环境噪声的干扰，定位数据可能
产生3‑5mm的跳变，定位数据应将5分钟内计算的位姿全部记录下来。

[0035] 进一步的，步骤S6中，两点真实位移由激光测距仪得到数据计算得到，对于测量位移，由于每一组定位数据都不同，计算得到的值也不同，假设测量值di′服从高斯分布N(μ，
σ)，将数据拟合成一个高斯分布，得到均值和方差，将数据拟合成一个高斯分布，得到均值
和方差，由高斯分布积分可得，有0.95的概率满足精度时候，得到定位误差±N。

[0036] 尽管已经示出和描述了本发明的实施例，对于本领域的普通技术人员而言，可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换
和变型，本发明的范围由所附权利要求及其等同物限定。