CN111912431B - 一种移动机器人导航系统定位精度测试方法 - Google Patents
一种移动机器人导航系统定位精度测试方法 Download PDFInfo
- Publication number
- CN111912431B CN111912431B CN202010946373.3A CN202010946373A CN111912431B CN 111912431 B CN111912431 B CN 111912431B CN 202010946373 A CN202010946373 A CN 202010946373A CN 111912431 B CN111912431 B CN 111912431B
- Authority
- CN
- China
- Prior art keywords
- positioning
- mobile robot
- laser range
- wall surface
- navigation system
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种移动机器人导航系统定位精度测试方案，包括以下步骤：测试环境选取、SLAM定位建图、移动机器人定位参考点选取、激光测距仪测量真实位移、传感器定位数据采集计算测量位移、高斯分布拟合、定位精度计算。相比于已有技术，本发明成本低、高效、测量方便、精度高、适用场景多、可靠性高、覆盖区域广、隐私入侵度低等优点。
Description
技术领域
本发明涉及移动机器人技术领域，具体为一种移动机器人导航系统定位精度测试方法。
背景技术
随着科技的发展，机器人已经在全世界范围内得到了广泛的应用。机器人关键技术的研究已经成为各国科技和产业的热点话题，机器人的发展也已经成为衡量国家科技水平、工业化先进水平的一个重要指标。
而移动机器人的重复定位精度是最重要、最基本的性能指标，唯有实现精准的位置定位，才可以拓展机器人的其他功能。对于不同的场景，机器人的定位精度要求就不同。室内是移动机器人使用最多的场景，现如今室内服务机器人已经开始走进了百姓的视野，在家庭中应用广泛的扫地机器人，银行、酒店等公共场所配备的迎宾机器人。对于室内的移动机器人定位精度通常在±3cm即可满足导航系统的要求。但对于物流搬运的工业移动仓储机器人，所需的定位精度则更高，通常在±1cm以内，为此我们提出一种移动机器人导航系统定位精度测试方法用于解决上述问题。
发明内容
本发明的目的在于提供一种移动机器人导航系统定位精度测试方法，以解决上述背景技术中提出的问题。
为实现上述目的，本发明提供如下技术方案：一种移动机器人导航系统定位精度测试方法，其特征在于，包括以下步骤：
S1、选择固定室内环境的测试场景；
S2、通过同步定位与实时建图(SLAM)技术，建立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。
优选的一种实施案例，步骤S1中，测试环境选取选择特征点丰富的环境、干扰因素少的室内固定环境且不存在动态的物体。
优选的一种实施案例，步骤S3中，判断移动机器人与墙面平行的方法通过俯视车体侧面边界与地面和墙面的交线是否重合，来初步判断平行，并移动车体到适当的角度，通过直尺测量左边两个轮子正中心分别到墙面距离是否完全相等，再测量右边两个轮子正中心分别到墙面距离是否完全相等。
优选的一种实施案例，步骤S3中，所述激光测距仪经测试得到误差小于1mm，激光测距仪可以测算出激光测距仪的后端到墙面的距离，测量时，保持车辆静止不动，取10-20次读数的平均值进行记录。
优选的一种实施案例，步骤S4和S5中，定位数据应将5分钟内计算的位姿全部记录下来。
优选的一种实施案例，步骤S6中，两点真实位移由激光测距仪得到数据计算得到，对于测量位移，将数据拟合成一个高斯分布，得到均值和方差，由高斯分布积分可得，有0.95的概率满足精度时候，得到定位误差±N。
与现有技术相比，本发明的有益效果是：本发明成本低、高效、测量方便、精度高、适用场景多、可靠性高、覆盖区域广、隐私入侵度低等优点。
附图说明
图1为本发明总体框架；
图2为本发明中时定位与建图SLAM；
图3为本发明图中定位高斯分布图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
请参阅图1-3，本发明提供一种技术方案：一种移动机器人导航系统定位精度测试方法，其特征在于，包括以下步骤：
S1、选择固定室内环境的测试场景；
S2、通过同步定位与实时建图(SLAM)技术，建立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。
进一步的，步骤S1中，测试环境选取选择特征点丰富的环境、干扰因素少的室内固定环境且不存在动态的物体。
进一步的，步骤S3中，判断移动机器人与墙面平行的方法通过俯视车体侧面边界与地面和墙面的交线是否重合，来初步判断平行，并移动车体到适当的角度，通过直尺测量左边两个轮子正中心分别到墙面距离是否完全相等，再测量右边两个轮子正中心分别到墙面距离是否完全相等。
进一步的，步骤S3中，在车上固定两个激光测距仪，两个激光测距仪垂直摆放，其中一个激光测距仪保持与车体平行，激光测距仪经测试得到误差小于1mm，激光测距仪可以测算出激光测距仪的后端到墙面的距离，激光测距仪的读数可能在0-1mm内跳变，激光测距仪可以测算出激光测距仪的后端到墙面的距离，测量时，保持车辆静止不动，取10-20次读数的平均值进行记录，测量前，已保证车体与墙面平行或垂直，所以激光测距仪测得数据为激光垂直到达墙面的距离，激光垂直打到两个墙面，得到分别到达两个墙面的垂直距离。
进一步的，步骤S4和S5中，小车在静止的时候，也会实时执行匹配算法，输出定位数据，由于实时计算得到的位姿收敛值不完全相同以及受环境噪声的干扰，定位数据可能产生3-5mm的跳变，定位数据应将5分钟内计算的位姿全部记录下来。
进一步的，步骤S6中，两点真实位移由激光测距仪得到数据计算得到，对于测量位移，由于每一组定位数据都不同，计算得到的值也不同，假设测量值di′服从高斯分布N(μ，σ)，将数据拟合成一个高斯分布，得到均值和方差，将数据拟合成一个高斯分布，得到均值和方差，由高斯分布积分可得，有0.95的概率满足精度时候，得到定位误差±N。
尽管已经示出和描述了本发明的实施例，对于本领域的普通技术人员而言，可以理解在不脱离本发明的原理和精神的情况下可以对这些实施例进行多种变化、修改、替换和变型，本发明的范围由所附权利要求及其等同物限定。
Claims (6)
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。
Applications Claiming Priority (2)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN2020101967239 | 2020-03-19 | ||
| CN202010196723 | 2020-03-19 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111912431A CN111912431A (zh) | 2020-11-10 |
| CN111912431B true CN111912431B (zh) | 2021-05-11 |
Family
ID=73266910
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202010946373.3A Active CN111912431B (zh) | 2020-03-19 | 2020-09-10 | 一种移动机器人导航系统定位精度测试方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111912431B (zh) |
Families Citing this family (2)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN113804218A (zh) * | 2021-08-26 | 2021-12-17 | 中国科学院沈阳自动化研究所 | 一种电缆隧道检测机器人定位导航能力测试方法 |
| CN115179327A (zh) * | 2022-09-05 | 2022-10-14 | 成都睿芯行科技有限公司 | 一种移动机器人定位精度测试方法 |
Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
Family Cites Families (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103940335A (zh) * | 2014-04-25 | 2014-07-23 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人重复定位精度测量装置 |
| CN104613872A (zh) * | 2015-03-05 | 2015-05-13 | 安徽埃夫特智能装备有限公司 | 一种用于测量工业机器人重复定位精度的测试系统 |
| JP6680614B2 (ja) * | 2016-05-25 | 2020-04-15 | 三菱重工業株式会社 | 測量装置、移動体、測量方法及びプログラム |
| CN107301654B (zh) * | 2017-06-12 | 2020-04-03 | 西北工业大学 | 一种多传感器的高精度即时定位与建图方法 |
| CN110488838B (zh) * | 2019-08-29 | 2022-08-02 | 四川阿泰因机器人智能装备有限公司 | 一种室内自主导航机器人精确重复定位方法 |
-
2020
- 2020-09-10 CN CN202010946373.3A patent/CN111912431B/zh active Active
Patent Citations (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111912431A (zh) | 2020-11-10 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111496848B (zh) | 一种基于欧氏距离的移动机器人重复定位精度测试方法 | |
| CN107991683B (zh) | 一种基于激光雷达的机器人自主定位方法 | |
| CN105547305B (zh) | 一种基于无线定位和激光地图匹配的位姿解算方法 | |
| Minguez et al. | Metric-based iterative closest point scan matching for sensor displacement estimation | |
| CN111912431B (zh) | 一种移动机器人导航系统定位精度测试方法 | |
| CN107782240B (zh) | 一种二维激光扫描仪标定方法、系统及装置 | |
| CN106885576B (zh) | 一种基于多点地形匹配定位的auv航迹偏差估计方法 | |
| CN111982532B (zh) | 一种自动泊车性能测试方法 | |
| CN110553652A (zh) | 机器人多传感器融合定位方法及其应用 | |
| CN105469388A (zh) | 基于降维的建筑物点云配准算法 | |
| CN111595238B (zh) | 一种基于多站法的激光跟踪仪精度现场评价系统 | |
| CN111796258B (zh) | 雷达参数标定场的构建方法、构建装置及可读存储介质 | |
| KR101957750B1 (ko) | 3차원 자기장 지도에 기초하여 생성된 입자 필터를 이용하여 위치를 추정하는 이동 단말 및 그 장치를 이용한 방법 | |
| CN111605547B (zh) | 一种自动泊车性能评价方法 | |
| CN107504974A (zh) | 地形分块与地形测点加权的地形匹配定位方法 | |
| Shu et al. | 3d point cloud-based indoor mobile robot in 6-dof pose localization using a wi-fi-aided localization system | |
| CN104965191A (zh) | 一种双站时差定位方法 | |
| CN103796303A (zh) | 一种终端定位方法及相关设备、系统 | |
| Monnier et al. | Registration of terrestrial mobile laser data on 2D or 3D geographic database by use of a non-rigid ICP approach. | |
| Kawai et al. | Reconstruction of 3D objects by integration of multiple range data | |
| Fu | Active RFID for positioning using trilateration and location fingerprinting based on RSSI | |
| CN117948952B (zh) | 一种点云扫描方法及系统 | |
| CN113766423B (zh) | 一种无线传感器未知节点线性三边定位方法及系统 | |
| CN115201779B (zh) | 获取雷达的成像原点空间位置和基线水平方位角的方法 | |
| CN109115196B (zh) | 全球卫星定位系统基站移动后测绘数据变更的方法 |
Legal Events
| Date | Code | Title | Description |
|---|---|---|---|
| PB01 | Publication | ||
| PB01 | Publication | ||
| SE01 | Entry into force of request for substantive examination | ||
| SE01 | Entry into force of request for substantive examination | ||
| GR01 | Patent grant | ||
| GR01 | Patent grant |