CN111912431A - 一种移动机器人导航系统定位精度测试方案 - Google Patents
一种移动机器人导航系统定位精度测试方案 Download PDFInfo
- Publication number
- CN111912431A CN111912431A CN202010946373.3A CN202010946373A CN111912431A CN 111912431 A CN111912431 A CN 111912431A CN 202010946373 A CN202010946373 A CN 202010946373A CN 111912431 A CN111912431 A CN 111912431A
- Authority
- CN
- China
- Prior art keywords
- positioning
- mobile robot
- laser range
- navigation system
- wall surface
- 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.)
- Granted
Links
- 238000012360 testing method Methods 0.000 title claims abstract description 25
- 238000006073 displacement reaction Methods 0.000 claims abstract description 14
- 238000000034 method Methods 0.000 claims abstract description 7
- 238000005259 measurement Methods 0.000 claims abstract description 6
- 238000005516 engineering process Methods 0.000 claims description 8
- 238000013507 mapping Methods 0.000 claims description 4
- 230000001360 synchronised effect Effects 0.000 claims description 3
- 238000013519 translation Methods 0.000 claims description 3
- 230000010354 integration Effects 0.000 claims description 2
- 230000009545 invasion Effects 0.000 abstract description 2
- 238000011161 development Methods 0.000 description 2
- 230000004075 alteration Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000007613 environmental effect Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000010408 sweeping Methods 0.000 description 1
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坐标系和移动机器人base_link的XOY的坐标系仅存在平移关系，将车开到某一个点P作为参考点，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和右边测距Dright_top、Dright_bottom，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面平行，参考点选取成功；
S4、通过激光测距仪得到原点到达两个墙面的距离(m0,n0)，并读取参考点传感器的定位数据(X0,Y0)；
S5、以任意路径行驶后返回原点附近，得到新的位置P，根据S3的方法重新使车体与墙面平行，读取Pi传感器的定位数据(Xi,Yi)和激光测距仪得到两个墙面的距离(mi,ni)；
S6、计算真实位移
测量位移
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坐标系和移动机器人base_link的XOY的坐标系仅存在平移关系，将车开到某一个点P作为参考点，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和右边测距Dright_top、Dright_bottom，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面平行，参考点选取成功；
S4、通过激光测距仪得到原点到达两个墙面的距离(m0,n0)，并读取参考点传感器的定位数据(X0,Y0)；
S5、以任意路径行驶后返回原点附近，得到新的位置P，根据S3的方法重新使车体与墙面平行，读取Pi传感器的定位数据(Xi,Yi)和激光测距仪得到两个墙面的距离(mi,ni)；
S6、计算真实位移
测量位移
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、通过同步定位与实时建图(SLAM)技术，建立S1中测试场景下的栅格图，然后开启定位，得到机器人小车的定位信息；
S3、在起点开启定位，将一对相互垂直的激光测距仪固定在移动机器人上，使激光测距仪的XOY坐标系和移动机器人base_link的XOY的坐标系仅存在平移关系，将车开到某一个点P作为参考点，搬动机器人，使用另一个激光测距仪分别在车体左边测距Dleft_top、Dleft_bottom和右边测距Dright_top、Dright_bottom，若Dleft_top＝Dleft_bottom、Dright_top＝Dright_bottom，则车体与墙面平行，参考点选取成功；
S4、通过激光测距仪得到原点到达两个墙面的距离(m0,n0)，并读取参考点传感器的定位数据(X0,Y0)；
S5、以任意路径行驶后返回原点附近，得到新的位置P，根据S3的方法重新使车体与墙面平行，读取Pi传感器的定位数据(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 true CN111912431A (zh) | 2020-11-10 |
| CN111912431B 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) |
Cited By (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 (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103940335A (zh) * | 2014-04-25 | 2014-07-23 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人重复定位精度测量装置 |
| CN104613872A (zh) * | 2015-03-05 | 2015-05-13 | 安徽埃夫特智能装备有限公司 | 一种用于测量工业机器人重复定位精度的测试系统 |
| CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
| CN107301654A (zh) * | 2017-06-12 | 2017-10-27 | 西北工业大学 | 一种多传感器的高精度即时定位与建图方法 |
| JP2017211265A (ja) * | 2016-05-25 | 2017-11-30 | 三菱重工業株式会社 | 測量装置、移動体、測量方法及びプログラム |
| CN110488838A (zh) * | 2019-08-29 | 2019-11-22 | 四川阿泰因机器人智能装备有限公司 | 一种室内自主导航机器人精确重复定位方法 |
-
2020
- 2020-09-10 CN CN202010946373.3A patent/CN111912431B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN103940335A (zh) * | 2014-04-25 | 2014-07-23 | 南京埃斯顿机器人工程有限公司 | 一种工业机器人重复定位精度测量装置 |
| CN104613872A (zh) * | 2015-03-05 | 2015-05-13 | 安徽埃夫特智能装备有限公司 | 一种用于测量工业机器人重复定位精度的测试系统 |
| JP2017211265A (ja) * | 2016-05-25 | 2017-11-30 | 三菱重工業株式会社 | 測量装置、移動体、測量方法及びプログラム |
| CN107301654A (zh) * | 2017-06-12 | 2017-10-27 | 西北工业大学 | 一种多传感器的高精度即时定位与建图方法 |
| CN107239076A (zh) * | 2017-06-28 | 2017-10-10 | 仲训昱 | 基于虚拟扫描与测距匹配的agv激光slam方法 |
| CN110488838A (zh) * | 2019-08-29 | 2019-11-22 | 四川阿泰因机器人智能装备有限公司 | 一种室内自主导航机器人精确重复定位方法 |
Non-Patent Citations (1)
| Title |
|---|
| 苏渊博等: "机器人重复定位精度测试设备研制", 《智能机器人》 * |
Cited By (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 | 成都睿芯行科技有限公司 | 一种移动机器人定位精度测试方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111912431B (zh) | 2021-05-11 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111496848B (zh) | 一种基于欧氏距离的移动机器人重复定位精度测试方法 | |
| CN105547305B (zh) | 一种基于无线定位和激光地图匹配的位姿解算方法 | |
| CN106997049B (zh) | 一种基于激光点云数据的检测障碍物的方法和装置 | |
| CN107782240B (zh) | 一种二维激光扫描仪标定方法、系统及装置 | |
| CN111912431B (zh) | 一种移动机器人导航系统定位精度测试方法 | |
| Minguez et al. | Metric-based iterative closest point scan matching for sensor displacement estimation | |
| CN105115497B (zh) | 一种可靠的室内移动机器人精确导航定位系统及方法 | |
| CN111982532B (zh) | 一种自动泊车性能测试方法 | |
| CN106885576B (zh) | 一种基于多点地形匹配定位的auv航迹偏差估计方法 | |
| CN104080165B (zh) | 一种基于tdoa的室内无线传感器网络定位方法 | |
| CN111595238B (zh) | 一种基于多站法的激光跟踪仪精度现场评价系统 | |
| CN110553652A (zh) | 机器人多传感器融合定位方法及其应用 | |
| KR101957750B1 (ko) | 3차원 자기장 지도에 기초하여 생성된 입자 필터를 이용하여 위치를 추정하는 이동 단말 및 그 장치를 이용한 방법 | |
| CN111532260B (zh) | 一种车位检测性能评价方法及电子设备 | |
| CN109448417A (zh) | 一种基于扫码定位技术的停车场反向寻车导航系统及方法 | |
| CN110657763A (zh) | 一种双曲面赛道混凝土面的平整度检测及控制方法 | |
| CN111605547B (zh) | 一种自动泊车性能评价方法 | |
| CN104965191A (zh) | 一种双站时差定位方法 | |
| CN103796303A (zh) | 一种终端定位方法及相关设备、系统 | |
| CN115205397A (zh) | 一种基于计算机视觉和位姿估计的车辆时空信息识别方法 | |
| CN112731431A (zh) | 一种厢式货车定位检测装置及方法 | |
| Chengbo et al. | Research on wheeled mobile robot positioning based on ekf multi-sensor data fusion | |
| Li et al. | Study on the method of high-precision vehicle-borne lidar point clouds data acquisition in existing railway survey | |
| CN117948952B (zh) | 一种点云扫描方法及系统 | |
| CN111239772B (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 |