一种基于欧氏距离的移动机器人重复定位精度测试制造技术

本发明专利技术公开了一种基于欧氏距离的移动机器人重复定位精度测试，包括以下步骤：测试环境选取、SLAM定位建图、激光测距仪测量真实位移、传感器定位数据采集、高斯分布拟合、定位精度计算。定位精度即系统输出的定位值和真实值的误差，定位数据即车体的Pose，包含二维平面坐标和航向角，相比于已有技术，本发明专利技术成本低、高效、测量方便、精度高、适用场景多、可靠性高、覆盖区域广、隐私入侵度低等优点。

【技术实现步骤摘要】
一种基于欧氏距离的移动机器人重复定位精度测试
本专利技术涉及移动机器人
，具体为一种基于欧氏距离的移动机器人重复定位精度测试。
技术介绍
随着科技的发展，机器人已经在全世界范围内得到了广泛的应用。机器人关键技术的研究已经成为各国科技和产业的热点话题，机器人的发展也已经成为衡量国家科技水平、工业化先进水平的一个重要指标。而移动机器人的重复定位精度是最重要、最基本的性能指标，唯有实现精准的位置定位，才可以拓展机器人的其他功能。对于不同的场景，机器人的定位精度要求就不同。室内是移动机器人使用最多的场景，现如今室内服务机器人已经开始走进了百姓的视野，在家庭中应用广泛的扫地机器人，银行、酒店等公共场所配备的迎宾机器人。对于室内的移动机器人定位精度通常在±3cm，即可满足导航系统的要求。但对于物流搬运的工业移动仓储机器人，所需的定位精度则更高，通常在±1cm以内。对于工业机器人常见的重复定位精度的测量，一般采用CCD和图像处理技术。当然有条件的话，可以使用激光干涉仪，精度高达0.001毫米，可价格非常昂贵(高达50000美元)，为此我们提出一种基于欧氏距离的移动机器人重复定位精度测试用于解决上述问题。
技术实现思路
本专利技术的目的在于提供一种基于欧氏距离的移动机器人重复定位精度测试，以解决上述
技术介绍
中提出的问题。为实现上述目的，本专利技术提供如下技术方案：一种基于欧氏距离的移动机器人重复定位精度测试，包括以下步骤：S1、选取固定室内为测试环境；S2、在S1选取的环境中，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人base_link的XOY的坐标系仅存在平移关系，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和右边测距Dright_top、Dright_bottom，调整小车，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面平行，使用激光测距仪获取移动机器人参考点P到参考坐标系的两个墙面的距离(m0,n0)，通过同步定位与实时建图(SLAM)技术，得到该环境下的概率栅格图，然后开启定位，得到小车的定位信息S3、在起点附近开启定位，按步骤S2再次调整移动机器人与参考坐标系平行，并读取参考点P传感器的定位数据(x0,y0,θ0)；S4、从S2所得参考点出发，移动任意路径返回至参考点附近。通过激光测距仪得到到达两个墙面的距离(mi,ni)，并读取参考点传感器的定位数据(xi,yi,θi)；S5、计算真实相对位姿T0i＝(mi-m0，ni-n0，Θ0i),系统读数得到位姿T′0i＝(mi-m0，ni-n0，Θ′0i)，则定位误差中的平移误差部分定义为角度误差定义为errorrot＝Θ0i-Θ′0i；S6、重复S4和S5，得到多组数据，若多组数据的平移定位误差满足±N，角度误差达到了±angle，则说明定位精度达到了±N和±angle。优选的一种实施案例，步骤S1中，测试环境选取选择特征点丰富的环境、干扰因素少的室内固定环境且不存在动态的物体。优选的一种实施案例，步骤S2中，判断机器人小车与墙面平行的方法通过俯视车体侧面边界与地面和墙面的交线是否重合，来初步判断平行，并移动车体到适当的角度，通过直尺测量左边两个轮子正中心分别到墙面距离是否完全相等，再测量右边两个轮子正中心分别到墙面距离是否完全相等。优选的一种实施案例，步骤S2中，开始建图时，将小车调整至与参考平面的完全平行，保证定位数据的坐标系与参考坐标系在角度上一致。优选的一种实施案例，步骤S2中，激光测距仪经测试得到误差小于1mm，激光测距仪可以测算出激光测距仪的后端到墙面的距离，测量时，保持车辆静止不动，取10-20次读数的平均值进行记录。优选的一种实施案例，步骤S3和步骤S4中，定位数据应将5分钟内计算的位姿全部记录下来。优选的一种实施案例，步骤S5中，两点真实位移由激光测距仪得到数据计算得到，对于测量位移，将数据拟合成一个高斯分布，得到均值和方差，由高斯分布积分可得，有0.95的概率满足精度时候，则定位精度达到了±N。同理，对于errorrot也使用高斯分布去拟合分析，由高斯分布积分，当0.95概率满足精度，则定位精度达到了±angle。与现有技术相比，本专利技术的有益效果是：本专利技术成本低、高效、测量方便、精度高、适用场景多、可靠性高、覆盖区域广、隐私入侵度低等优点。附图说明图1为本专利技术总体框架；图2为本专利技术中参考坐标系与机器人车体坐标系；图3为本专利技术定位与建图SLAM；图4为本专利技术定位高斯分布图。具体实施方式下面将结合本专利技术实施例中的附图，对本专利技术实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本专利技术一部分实施例，而不是全部的实施例。基于本专利技术中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本专利技术保护的范围。请参阅图1-4，本专利技术提供一种技术方案：一种基于欧氏距离的移动机器人重复定位精度测试，包括以下步骤：S1、选取固定室内为测试环境；S2、在S1选取的环境中，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人base_link的XOY的坐标系仅存在平移关系，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和右边测距Dright_top、Dright_bottom，调整小车，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面平行，使用激光测距仪获取移动机器人参考点P到参考坐标系的两个墙面的距离(m0,n0)，通过同步定位与实时建图(SLAM)技术，得到该环境下的概率栅格图，然后开启定位，得到小车的定位信息S3、在起点附近开启定位，按步骤S2再次调整移动机器人与参考坐标系平行，并读取参考点P传感器的定位数据(x0,y0,θ0)；S4、从S2所得参考点出发，移动任意路径返回至参考点附近。通过激光测距仪得到到达两个墙面的距离(mi,ni)，并读取参考点传感器的定位数据(xi,yi,θi)；S5、计算真实相对位姿T0i＝(mi-m0，ni-n0，Θ0i),系统读数得到位姿T′0i＝(mi-m0，ni-n0，Θ′0i)，则定位误差中的平移误差部分定义为角度误差定义为errorrot＝Θ0i-Θ′0i；S6、重复S4和S5，得到多组数据，若多组数据的平移定位误差满足±N，角度误差达到了±angle，则说明定位精度达到了±N和±angle。进一步的，步骤S1中，测试环境选取选择特征点丰富的环境、干扰因素少的室内固定环境且不存在动态的物体。进一步的，步骤S2中，判断机器人小车与墙面平行的方法通过俯视车体侧面边界与本文档来自技高网...

【技术保护点】
1.一种基于欧氏距离的移动机器人重复定位精度测试，其特征在于，包括以下步骤：/nS1、选取固定室内为测试环境；/nS2、在S1选取的环境中，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人base_link的XOY的坐标系仅存在平移关系，搬动机器人，使用另一个激光测距仪分别在车体左边测距D

【技术特征摘要】
20200319 CN 20201019672811.一种基于欧氏距离的移动机器人重复定位精度测试，其特征在于，包括以下步骤：
S1、选取固定室内为测试环境；
S2、在S1选取的环境中，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人base_link的XOY的坐标系仅存在平移关系，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和右边测距Dright_top、Dright_bottom，调整小车，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面平行，使用激光测距仪获取移动机器人参考点P到参考坐标系的两个墙面的距离(m0,n0)，通过同步定位与实时建图(SLAM)技术，得到该环境下的概率栅格图，然后开启定位，得到小车的定位信息
S3、在起点附近开启定位，按步骤S2再次调整移动机器人与参考坐标系平行，并读取参考点P传感器的定位数据(x0,y0,θ0)；
S4、从S2所得参考点出发，移动任意路径返回至参考点附近。通过激光测距仪得到到达两个墙面的距离(mi,ni)，并读取参考点传感器的定位数据(xi,yi,θi)；
S5、计算真实相对位姿T0i＝(mi-m0，ni-n0，Θ0i),系统读数得到位姿T0i＝(mi-m0，ni-n0，Θ′0i)，则定位误差中的平移误差部分定义为角度误差定义为errorrot＝Θ0i-Θ′0i；
S6、重复S4和S5，得到多组数据，若多组数据的平移定位误差满足±N，角度误差达到了±angle，则说明定位精度达到了±N和±angle。


2.根据权利要求1所述的...

【专利技术属性】
技术研发人员：单云霄，徐韩悦，陈龙，
申请(专利权)人：中山大学，
类型：发明
国别省市：广东;44