CN108363386A - 基于二维码和激光的室内机器人定位方法、装置及系统 - Google Patents
基于二维码和激光的室内机器人定位方法、装置及系统 Download PDFInfo
- Publication number
- CN108363386A CN108363386A CN201711492946.4A CN201711492946A CN108363386A CN 108363386 A CN108363386 A CN 108363386A CN 201711492946 A CN201711492946 A CN 201711492946A CN 108363386 A CN108363386 A CN 108363386A
- Authority
- CN
- China
- Prior art keywords
- pose
- robot
- quick response
- response code
- global
- 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.)
- Pending
Links
- 230000004044 response Effects 0.000 title claims abstract description 245
- 238000000034 method Methods 0.000 title claims abstract description 48
- 239000011159 matrix material Substances 0.000 claims description 8
- 238000005457 optimization Methods 0.000 claims description 7
- 230000007613 environmental effect Effects 0.000 abstract description 14
- 230000004807 localization Effects 0.000 abstract description 11
- 230000008569 process Effects 0.000 abstract description 11
- 238000010586 diagram Methods 0.000 description 4
- 230000007812 deficiency Effects 0.000 description 3
- 238000009826 distribution Methods 0.000 description 3
- 238000003860 storage Methods 0.000 description 3
- 238000004364 calculation method Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 2
- 238000005516 engineering process Methods 0.000 description 2
- 238000010191 image analysis Methods 0.000 description 2
- 238000013507 mapping Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000013459 approach Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000005540 biological transmission Effects 0.000 description 1
- 238000010276 construction Methods 0.000 description 1
- 230000001419 dependent effect Effects 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000000605 extraction Methods 0.000 description 1
- 238000011835 investigation Methods 0.000 description 1
- 238000007726 management method Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000001737 promoting effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0231—Control of position or course in two dimensions specially adapted to land vehicles using optical position detecting means
Landscapes
- Physics & Mathematics (AREA)
- Engineering & Computer Science (AREA)
- Electromagnetism (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明公开了基于二维码和激光的室内机器人定位方法、装置及系统,利用激光先得到环境地图以及机器人的全局位姿,通过摄像头得到二维码与机器人的相对位姿,结合机器人的全局位姿得到二维码的全局位姿,建立二维码坐标系;在机器人移动过程中,通过摄像头拍摄任意二维码,获取机器人与二维码坐标系的相对位姿,结合二维码的全局位姿得到机器人的全局位姿。本发明通过先验机器人的全局位姿来得到二维码地图,消除了机器人后期定位的累积误差,从而可以在任意场景任意时刻快速地进行机器人定位,具备高效、高精度、全方位识读的优点。
Description
技术领域
本发明涉及机器人行驶控制的技术领域,尤其涉及基于二维码和激光的室内机器人定位方法、装置及系统。
背景技术
为了在自动化生产和仓储管理中应用移动机器人,要求室内移动机器人必须精确识别当前位置,只有精确识别当前位置,才能精确传输和搬运产品。目前,室内移动机器人定位方法一般有几种:测距法、视觉定位方法、推算定位与RFID相结合方法、条形码定位方法。
测距法也称推算法,通过两个轮子加装的编码器测出微小距离,计算出移动机器人位置和姿态的变化量,通过累加,实现移动机器人的自动定位。但是,一旦车轮行进过程中出现打滑空转现象,由于编码器的输出不能修正这一误差,所以随着时间的推移,误差将会累计,导致定位精度的降低,因此,测距法只适用于短距离的定位。
视觉定位方法通过安装在移动机器人上的摄像头获取室内环境的图像信息,利用图像分析、对比技术判定机器人的位置,实现定位。该方法存在的问题是:1、由于是两套图像进行对比,需要将其中一套图像预先保存起来,这就需要一个大容量的存储介质存储图像,当需要时随时提取并和当前图像信息进行对比,从而获取当前位置在整个室内环境中的实际位置;2、图像分析需要强大的数据运算能力,远非一般嵌入式系统所能胜任,以上都说明采用视觉定位大大增加了成本。
识别移动机器人位置与方向的另外一种方法是射频标识卡和一种RFID阅读器的方法。在这种方法中每一个射频标签对应唯一号码,并根据唯一号码,在射频标签映射表中对应的其实际地理位置,从而定位移动机器人的实际位置。但是使用这种方法必须高密度地敷设射频标签,才能满足机器人定位的需要,而随之带来的问题是,RFID如果分布密度过高,从RFID卡输出的信号之间将产生干扰,可能会出现一次读取多个卡号而导致无法定位。针对上述问题,可以采用推算定位与RFID的分布密度,一方面用推算法在保证定位精度的前提下,减少了RFID的分布密度,一方面用RFID定位信息修正了航位推算的累积误差,但由于RFID阅读器的有效读取范围在几个至几十个厘米内,具体取决于射频的发射功率、读取角度、位置以及杂散电磁波的干扰等诸多不确定因素的影响,因此,其定位精度很难达到厘米级,不能满足定位精度要求很高的场合。
条形码移动机器人定位方法针对以上不足进行了改进。发明专利20041005968.1公布了一种基于一维条形码的室内移动机器人定位系统和方法,该方法是在每个条形码标签上印制若干个条形码,每个条形码数据由两部分组成:绝对地址码和位置偏移码。绝对地址码用于定位该标签在室内环境中的实际地理位置,位置偏移码用于确定该标签上各个条形码之间的偏移量,每个标签上各个条形码上的绝对地址码是相同的,代表整个标签在室内的地理位置,各个条形码之间的相对位置用各自的偏移量表示。为了保证条码扫描枪每次扫描得到一个完整的条码,规定条码扫描宽度不小于两个完整条码的长度,当扫描范围出现空白区时,通过对第一个空白区左右两侧的数据信息进行拼接而获得一个完整的条码数据。当用以上方法定位移动机器人位置时,是将标签的位置(绝对位置)、条码的位置(相对位置)、条码扫描枪的位置(相对位置)这三个数据叠加,最终得到移动机器人在室内实际的地理位置。以上方法的有点在于通过条形码符号的巧妙布局,能够准确计算移动机器人室内位置并且在实施过程中做到占用资源少而降低成本,但是该方法仍然存在以下不足:1、条形码识别速度低,不适合高效率的移动机器人领域。2、条形码布局结构难以实现全方位识读。3、容错能力差,对环境要求高、成本高,不利于推广使用。
发明内容
为了克服现有技术的不足,本发明的目的在于提供基于二维码和激光的室内机器人定位方法、装置及系统,旨在解决现有技术的机器人定位过程由于误差累计或电磁波干扰所导致的精度低、成本高、效率低、对环境要求高的问题。
本发明的目的采用以下技术方案实现:
一种室内机器人定位方法,包括:
机器人全局位姿获取步骤,根据工作区域的激光环境地图获取机器人的全局位姿;
二维码相对位姿获取步骤,获取工作区域内二维码的图像,并获取二维码在机器人坐标系下的位姿;
二维码全局位姿获取步骤,识别二维码ID,根据二维码在机器人坐标系下的位姿和机器人的全局位姿,计算并记录与二维码ID对应的二维码的全局位姿;
机器人相对位姿获取步骤,在机器人当前位姿处获取工作区域内任意二维码的图像,并获取机器人在二维码坐标系下的位姿;
二维码全局位姿查询步骤,识别二维码ID,查询与二维码ID相应的二维码的全局位姿;
机器人当前位姿获取步骤,根据机器人在二维码坐标系下的位姿和二维码的全局位姿,计算获得机器人的当前全局位姿。
在上述实施例的基础上,优选的:
所述机器人全局位姿获取步骤中,根据激光环境地图建立全局坐标系,机器人的全局位姿P0=(x0,y0,θ0)T;
所述二维码相对位姿获取步骤中,二维码在机器人坐标系下的位姿P(a)d=(x(a)d,y(a)d,θ(a)d)T;
所述二维码全局位姿获取步骤中,识别的二维码ID为Da,二维码Da对应的全局位姿:
在上述任意实施例的基础上,优选的,所述机器人相对位姿获取步骤中,获取机器人在二维码坐标系下的位姿的步骤,具体为:
获取二维码在机器人坐标系下的位姿,根据二维码在机器人坐标系下的位姿获取机器人在二维码坐标系下的位姿。
在上述实施例的基础上,优选的:
二维码在机器人坐标系下的位姿为P(b)d=(x(b)d,y(b)d,θ(b)d)T,机器人在二维码坐标系下的位姿为P(b)r′:
所述二维码全局位姿查询步骤中,识别的任意二维码图像中二维码的ID为Db,查询到的二维码Db的全局位姿为P(b)dm=(x(b)dm,y(b)dm,θ(b)dm)T;
所述机器人全局位姿获取步骤中,机器人的全局位姿为P′:
在上述任意实施例的基础上,优选的,当机器人相对位姿获取步骤中获取任意二维码的图像包括多个二维码时,还包括第一优化步骤:
获取所述多个二维码在机器人坐标系下的位姿;
识别所述多个二维码ID,查询与所述多个二维码ID对应的二维码的全局位姿;
获取与多个二维码在机器人坐标系下的位姿以及查询到的二维码ID对应的全局位姿相关的第一误差函数;
计算第一误差函数的最优化解得到机器人的当前全局位姿。
在上述实施例的基础上,优选的,所述第一误差函数定义为:
机器人的当前全局位姿为:
其中,Db1,Db2,...,Dbk为所述的多个二维码,二维码Dbi在机器人坐标系下的位姿为P(bi)d,查询到Dbi的全局位姿为P(bi)dm,P为机器人的全局位姿,e(P,P(bi)dm,P(bi)d)为与二维码Dbi相关的误差函数,Ωbi为二维码Dbi位姿观测的信息矩阵。
在上述任意实施例的基础上,优选的,还包括第二优化步骤:
获取机器人当前激光定位位姿;
获取与所述当前激光定位位姿、第一误差函数相关的第二误差函数;
计算第二误差函数的最优化解得到机器人的当前全局位姿。
在上述实施例的基础上,优选的,所述第二误差函数定义为:
其中,PL为机器人当前激光定位位姿,ΩL为机器人激光位姿观测的信息矩阵;
所述第一误差函数定义为:
机器人的当前全局位姿为:
其中,Db1,Db2,...,Dbk为所述的多个二维码,二维码Dbi在机器人坐标系下的位姿为P(bi)d,查询到Dbi的全局位姿为P(bi)dm,P为机器人的全局位姿,e(P,P(bi)dm,P(bi)d)为与二维码Dbi相关的误差函数,Ωbi为二维码Dbi位姿观测的信息矩阵。
一种室内机器人定位装置,包括:
机器人全局位姿获取模块,用于根据工作区域的激光环境地图获取机器人的全局位姿;
二维码相对位姿获取模块,用于获取工作区域内二维码的图像,并获取二维码在机器人坐标系下的位姿;
二维码全局位姿获取模块,用于识别二维码ID,根据二维码在机器人坐标系下的位姿和机器人的全局位姿,计算并记录与二维码ID对应的二维码的全局位姿;
机器人相对位姿获取模块,用于在机器人当前位姿处获取工作区域内任意二维码的图像,并获取机器人在二维码坐标系下的位姿;
二维码全局位姿查询模块,用于识别二维码ID,查询与二维码ID相应的二维码的全局位姿;
机器人当前位姿获取模块,用于根据机器人在二维码坐标系下的位姿和二维码的全局位姿,计算获得机器人的当前全局位姿。
在上述实施例的基础上,优选的,
所述机器人相对位姿获取模块用于获取任意二维码的图像;任意二维码的图像中包括多个二维码;
所述机器人相对位姿获取模块用于获取多个二维码在机器人坐标系下的位姿;
所述二维码全局位姿查询模块用于识别所述多个二维码ID,查询与所述多个二维码ID对应的二维码的全局位姿;
所述机器人当前位姿获取模块用于获取与多个二维码在机器人坐标系下的位姿以及查询到的二维码ID对应的全局位姿相关的第一误差函数,计算第一误差函数的最优化解得到机器人的当前全局位姿。
在上述实施例的基础上,优选的,还包括:
机器人激光定位位姿获取模块,用于获取机器人当前激光定位位姿;
所述机器人当前位姿获取模块,用于获取与所述当前激光定位位姿、第一误差函数相关的第二误差函数;计算第二误差函数的最优化解得到机器人的当前全局位姿。
一种室内机器人定位系统,包括:
上述任一项实施例中的室内机器人定位装置;
激光设备,用于扫描工作区域以获得激光环境地图并发送到所述装置;
摄像头,用于拍摄获得工作区域内的二维码的图像并发送到所述装置,以及拍摄获得工作区域内的任意二维码的图像并发送到所述装置。
相比现有技术,本发明的有益效果在于:
本发明公开了基于二维码和激光的室内机器人定位方法、装置及系统,利用激光先得到环境地图以及机器人的全局位姿,通过摄像头得到二维码与机器人的相对位姿,结合机器人的全局位姿得到二维码的全局位姿,建立二维码坐标系;在机器人移动过程中,通过摄像头拍摄任意二维码,获取机器人与二维码坐标系的相对位姿,结合二维码的全局位姿得到机器人的全局位姿。本发明通过先验机器人的全局位姿来得到二维码地图,消除了机器人后期定位的累积误差,从而可以在任意场景任意时刻快速地进行机器人定位,具备高效、高精度、全方位识读的优点。
附图说明
下面结合附图和实施例对本发明进一步说明。
图1示出了本发明实施例提供的一种基于二维码和激光的室内机器人定位方法的流程示意图;
图1a示出了本发明实施例提供的一种基于二维码和激光的室内机器人定位方法的工作原理示意图;
图2示出了本发明实施例提供的一种基于二维码和激光的室内机器人定位装置的结构示意图;
图3示出了本发明实施例提供的一种基于二维码和激光的室内机器人定位系统的结构示意图。
具体实施方式
机器人地图制作,是指通过各类传感器采集环境信息,并通过技术手段将传感器数据有序融合;地图主要用于机器人定位和导航。
传感器可以设置在机器人上,获取各个时刻的观测帧,利用各观测帧确定机器人的位姿,机器人的位姿是指某个时刻机器人的位置和朝向。本发明中所指的机器人也可以是其他依赖地图导航定位的运动设备,例如智能玩具、可运动的智能家居、测绘车等。
下面,结合附图以及具体实施方式,对本发明做进一步描述,需要说明的是,在不相冲突的前提下,以下描述的各实施例之间或各技术特征之间可以任意组合形成新的实施例。
具体实施例一
如图1所示,本发明实施例提供了一种基于二维码和激光的室内机器人定位方法,包括:机器人全局位姿获取步骤S101,根据工作区域的激光环境地图获取机器人的全局位姿P0,P0=(x0,y0,θ0)T;通过激光设备扫描工作区域获得的数据构建工作区域相关的环境地图,机器人的全局位姿指的是机器人在环境地图中的位置和朝向,将某一时刻搭载在机器人上的激光扫描设备获得的观测帧与环境地图信息进行比较确定机器人该时刻的位姿,也可以融合里程计等其他信息计算获得机器人该时刻的位姿。根据环境地图建立全局坐标系,如图1a所示的XtOYt坐标系,在全局坐标系下机器人某一时刻的全局位姿表示为P0=(x0,y0,θ0)T;
二维码相对位姿获取步骤S102,获取工作区域内二维码的图像,并获取二维码在机器人坐标系下的位姿;机器人的工作区域内设置有二维码,所述二维码ID为二维码的身份标识,具有唯一性,可通过现有识别技术获得。建立机器人坐标系,如图1a所示的XRMYR坐标系,通过搭载在机器人上的摄像头拍摄获得二维码的图像以获得某一时刻机器人位姿与二维码的相对位置关系。具体的,二维码的个数为n,二维码ID分别记为D1~Dn,n为正整数;某一时刻机器人位姿与二维码Da的相对位置关系表示为二维码Da在机器人坐标系下的位姿P(a)d,P(a)d=(x(a)d,y(a)d,θ(a)d)T,a为正整数,a<n;
二维码全局位姿获取步骤S103,识别二维码ID,根据二维码在机器人坐标系下的位姿和机器人的全局位姿,计算并记录与二维码ID对应的二维码的全局位姿。
根据步骤S101、步骤S102获得的某一时刻机器人的全局位姿P0,以及该时刻获得的二维码Da与机器人的相对位置关系计算出二维码Da的全局位姿为P(a)dm:
二维码的全局位姿指的是二维码在环境地图中的位置和朝向;重复上述步骤以获得工作区域内所有二维码D1~Dn的全局位姿,将环境地图、二维码ID以及ID对应的二维码全局位姿作为先验信息存储在一服务器中,在定位过程中可直接查询获得以提高定位精度以及效率。
机器人相对位姿获取步骤S104,在机器人当前位姿处获取工作区域内任意二维码的图像,并获取机器人在二维码坐标系下的位姿。在移动过程中,机器人在当前位姿处拍摄摄像头视野范围内的任意二维码以获取当前时刻机器人与该二维码的相对位置关系。具体的,识别出所拍摄的二维码记为Db,并根据该二维码建立二维码坐标系,b为正整数,b<n,二维码Db在机器人坐标系下的位姿P(b)d,P(b)d=(x(b)d,y(b)d,θ(b)d)T,机器人当前位姿与拍摄的二维码的相对位置关系表示为机器人在二维码坐标系下的位姿为P(b)r′:
二维码全局位姿查询步骤S105,识别二维码ID,查询与二维码ID相应的二维码的全局位姿P(b)dm=(x(b)dm,y(b)dm,θ(b)dm)T;在定位过程中,通过查询存储的先验信息即可获得与步骤S104中所拍摄的二维码ID对应的二维码的全局位姿。
机器人全局位姿获取步骤S106,根据机器人在二维码坐标系下的位姿和二维码的全局位姿,计算获得机器人的当前全局位姿P′:
优选的,本发明实施例还可以包括第一优化步骤:
当检测到多个二维码时,机器人的全局位姿的计算方式为:
假设机器人检测到k个二维码,即二维码Db1,Db2,...,Dbk,其中,检测到二维码Dbi在机器人坐标系下的位姿为P(bi)d,查询到Dbi的全局位姿为P(bi)dm,则可定义其误差函数为:
其中,P为机器人的全局位姿;和定义如下:
P1=(x1,y1,θ1)T,P2=(x2,y2,θ2)T;
normalize()函数将角度值归一化到(-π,π];
第一误差函数为:
其中Ωbi为二维码观测bi的信息矩阵,反映了该观测的可靠性;可以根据二维码成像质量、相机视野等因素确定;
机器人的全局位姿为:
优选的,本发明实施例还可以包括第二优化步骤:
当检测到多个二维码,同时获得激光定位位姿时,机器人的全局位姿的计算方式为:
假设机器人检测到个k个二维码,即二维码Db1,Db2,...,Dbk;其中,检测到二维码Dbi在机器人坐标系下的位姿为P(bi)d,查询到其全局位姿为P(bi)dm,则可定义其误差函数为:
假设机器人同时获得激光定位位姿为PL,则其误差函数为:
第二误差函数为:
其中ΩL为激光位姿观测的信息矩阵,反映了该观测的可靠性;
机器人的全局位姿为:
本发明实施例利用激光先得到环境地图以及机器人的全局位姿,通过摄像头得到二维码与机器人的相对位姿,结合机器人的全局位姿得到二维码的全局位姿,建立二维码坐标系;在机器人移动过程中,通过摄像头拍摄任意二维码,获取机器人与二维码坐标系的相对位姿,结合二维码的全局位姿得到机器人的全局位姿。本发明实施例通过先验机器人的全局位姿来得到二维码地图,消除了机器人后期定位的累积误差,从而可以在任意场景任意时刻尤其是环境变化较大不利于激光定位的情况下,快速地进行机器人定位,具备高效、高精度、全方位识读的优点。
在上述的具体实施例一中,提供了基于二维码和激光的室内机器人定位方法,与之相对应的,本申请还提供基于二维码和激光的室内机器人定位装置。由于装置实施例基本相似于方法实施例,所以描述得比较简单,相关之处参见方法实施例的部分说明即可。下述描述的装置实施例仅仅是示意性的。
具体实施例二
如图2所示,本发明实施例提供了一种基于二维码和激光的室内机器人定位装置,包括:
机器人全局位姿获取模块201,用于根据工作区域的激光环境地图获取机器人的全局位姿;
二维码相对位姿获取模块202,用于获取工作区域内二维码的图像,并获取二维码在机器人坐标系下的位姿;
二维码全局位姿获取模块203,用于识别二维码ID,根据二维码在机器人坐标系下的位姿和机器人的全局位姿,计算并记录与二维码ID对应的二维码的全局位姿;
机器人相对位姿获取模块204,用于在机器人当前位姿处获取工作区域内任意二维码的图像,并获取机器人在二维码坐标系下的位姿;
二维码全局位姿查询模块205,用于识别二维码ID,查询与二维码ID相应的二维码的全局位姿;
机器人当前位姿获取模块206,用于根据机器人在二维码坐标系下的位姿和二维码的全局位姿,计算获得机器人的当前全局位姿。
优选的,本发明实施例中,所述机器人相对位姿获取模块204用于获取任意二维码的图像;任意二维码的图像中包括多个二维码;所述机器人相对位姿获取模块204用于获取多个二维码在机器人坐标系下的位姿;所述二维码全局位姿查询模块205用于识别所述多个二维码ID,查询与所述多个二维码ID对应的二维码的全局位姿;所述机器人当前位姿获取模块206用于获取与多个二维码在机器人坐标系下的位姿以及查询到的二维码ID对应的全局位姿相关的第一误差函数,计算第一误差函数的最优化解得到机器人的当前全局位姿。
优选的,本发明实施例还可以包括:机器人激光定位位姿获取模块,用于获取机器人当前激光定位位姿;所述机器人当前位姿获取模块,用于获取与所述当前激光定位位姿、第一误差函数相关的第二误差函数;计算第二误差函数的最优化解得到机器人的当前全局位姿。
本发明实施例利用激光先得到环境地图以及机器人的全局位姿,通过摄像头得到二维码与机器人的相对位姿,结合机器人的全局位姿得到二维码的全局位姿,建立二维码坐标系;在机器人移动过程中,通过摄像头拍摄任意二维码,获取机器人与二维码坐标系的相对位姿,结合二维码的全局位姿得到机器人的全局位姿。本发明实施例通过先验机器人的全局位姿来得到二维码地图,消除了机器人后期定位的累积误差,从而可以在任意场景任意时刻快速地进行机器人定位,具备高效、高精度、全方位识读的优点。
具体实施例三
如图3所示,本发明实施例提供了一种基于二维码和激光的室内机器人定位系统,包括:
具体实施例二中的基于二维码和激光的室内机器人定位装置301;
激光设备302,用于扫描工作区域以获得激光环境地图并发送到所述装置301;
摄像头303,用于拍摄获得工作区域内的二维码的图像并发送到所述装置301,以及拍摄获得工作区域内的任意二维码的图像并发送到所述装置301。
本发明实施例利用激光先得到环境地图以及机器人的全局位姿,通过摄像头得到二维码与机器人的相对位姿,结合机器人的全局位姿得到二维码的全局位姿,建立二维码坐标系;在机器人移动过程中,通过摄像头拍摄任意二维码,获取机器人与二维码坐标系的相对位姿,结合二维码的全局位姿得到机器人的全局位姿。本发明实施例通过先验机器人的全局位姿来得到二维码地图,消除了机器人后期定位的累积误差,从而可以在任意场景任意时刻快速地进行机器人定位,具备高效、高精度、全方位识读的优点。
本发明从使用目的上,效能上,进步及新颖性等观点进行阐述,其具有的实用进步性,己符合专利法所强调的功能增进及使用要件,本发明以上的说明及附图,仅为本发明的较佳实施例而己,并非以此局限本发明,因此,凡一切与本发明构造,装置,待征等近似、雷同的,即凡依本发明专利申请范围所作的等同替换或修饰等,皆应属本发明的专利申请保护的范围之内。
需要说明的是,在不冲突的情况下,本发明中的实施例及实施例中的特征可以相互组合。尽管本发明已进行了一定程度的描述,明显地,在不脱离本发明的精神和范围的条件下,可进行各个条件的适当变化。可以理解,本发明不限于所述实施方案,而归于权利要求的范围,其包括所述每个因素的等同替换。对本领域的技术人员来说,可根据以上描述的技术方案以及构思,做出其它各种相应的改变以及形变,而所有的这些改变以及形变都应该属于本发明权利要求的保护范围之内。
Claims (12)
1.一种室内机器人定位方法,其特征在于,包括:
机器人全局位姿获取步骤,根据工作区域的激光环境地图获取机器人的全局位姿;
二维码相对位姿获取步骤,获取工作区域内二维码的图像,并获取二维码在机器人坐标系下的位姿;
二维码全局位姿获取步骤,识别二维码ID,根据二维码在机器人坐标系下的位姿和机器人的全局位姿,计算并记录与二维码ID对应的二维码的全局位姿;
机器人相对位姿获取步骤,在机器人当前位姿处获取工作区域内任意二维码的图像,并获取机器人在二维码坐标系下的位姿;
二维码全局位姿查询步骤,识别二维码ID,查询与二维码ID相应的二维码的全局位姿;
机器人当前位姿获取步骤,根据机器人在二维码坐标系下的位姿和二维码的全局位姿,计算获得机器人的当前全局位姿。
2.根据权利要求1所述的室内机器人定位方法,其特征在于:
所述机器人全局位姿获取步骤中,根据激光环境地图建立全局坐标系,机器人的全局位姿P0=(x0,y0,θ0)T;
所述二维码相对位姿获取步骤中,二维码在机器人坐标系下的位姿P(a)d=(x(a)d,y(a)d,θ(a)d)T;
所述二维码全局位姿获取步骤中,识别的二维码ID为Da,二维码Da对应的全局位姿:
3.根据权利要求1或2所述的室内机器人定位方法,其特征在于,所述机器人相对位姿获取步骤中,获取机器人在二维码坐标系下的位姿的步骤,具体为:
获取二维码在机器人坐标系下的位姿,根据二维码在机器人坐标系下的位姿获取机器人在二维码坐标系下的位姿。
4.根据权利要求3所述的室内机器人定位方法,其特征在于:
二维码在机器人坐标系下的位姿为P(b)d=(x(b)d,y(b)d,θ(b)d)T,机器人在二维码坐标系下的位姿为P(b)r′:
所述二维码全局位姿查询步骤中,识别的任意二维码图像中二维码的ID为Db,查询到的二维码Db的全局位姿为P(b)dm=(x(b)dm,y(b)dm,θ(b)dm)T;
所述机器人全局位姿获取步骤中,机器人的全局位姿为P′:
5.根据权利要求1所述的室内机器人定位方法,其特征在于,当机器人相对位姿获取步骤中获取任意二维码的图像包括多个二维码时,还包括第一优化步骤:
获取所述多个二维码在机器人坐标系下的位姿;
识别所述多个二维码ID,查询与所述多个二维码ID对应的二维码的全局位姿;
获取与多个二维码在机器人坐标系下的位姿以及查询到的二维码ID对应的全局位姿相关的第一误差函数;
计算第一误差函数的最优化解得到机器人的当前全局位姿。
6.根据权利要求5所述的室内机器人定位方法,其特征在于,所述第一误差函数定义为:
机器人的当前全局位姿为:
其中,Db1,Db2,...,Dbk为所述的多个二维码,二维码Dbi在机器人坐标系下的位姿为P(bi)d,查询到Dbi的全局位姿为P(bi)dm,P为机器人的全局位姿,e(P,P(bi)dm,P(bi)d)为与二维码Dbi相关的误差函数,Ωbi为二维码Dbi位姿观测的信息矩阵。
7.根据权利要求5所述的室内机器人定位方法,其特征在于,还包括第二优化步骤:
获取机器人当前激光定位位姿;
获取与所述当前激光定位位姿、第一误差函数相关的第二误差函数;
计算第二误差函数的最优化解得到机器人的当前全局位姿。
8.根据权利要求7所述的室内机器人定位方法,其特征在于,所述第二误差函数定义为:
其中,PL为机器人当前激光定位位姿,ΩL为机器人激光位姿观测的信息矩阵;
所述第一误差函数定义为:
机器人的当前全局位姿为:
其中,Db1,Db2,...,Dbk为所述的多个二维码,二维码Dbi在机器人坐标系下的位姿为P(bi)d,查询到Dbi的全局位姿为P(bi)dm,P为机器人的全局位姿,e(P,P(bi)dm,P(bi)d)为与二维码Dbi相关的误差函数,Ωbi为二维码Dbi位姿观测的信息矩阵。
9.一种室内机器人定位装置,其特征在于,包括:
机器人全局位姿获取模块,用于根据工作区域的激光环境地图获取机器人的全局位姿;
二维码相对位姿获取模块,用于获取工作区域内二维码的图像,并获取二维码在机器人坐标系下的位姿;
二维码全局位姿获取模块,用于识别二维码ID,根据二维码在机器人坐标系下的位姿和机器人的全局位姿,计算并记录与二维码ID对应的二维码的全局位姿;
机器人相对位姿获取模块,用于在机器人当前位姿处获取工作区域内任意二维码的图像,并获取机器人在二维码坐标系下的位姿;
二维码全局位姿查询模块,用于识别二维码ID,查询与二维码ID相应的二维码的全局位姿;
机器人当前位姿获取模块,用于根据机器人在二维码坐标系下的位姿和二维码的全局位姿,计算获得机器人的当前全局位姿。
10.根据权利要求9所述的室内机器人定位装置,其特征在于,
所述机器人相对位姿获取模块用于获取任意二维码的图像;任意二维码的图像中包括多个二维码;
所述机器人相对位姿获取模块用于获取多个二维码在机器人坐标系下的位姿;
所述二维码全局位姿查询模块用于识别所述多个二维码ID,查询与所述多个二维码ID对应的二维码的全局位姿;
所述机器人当前位姿获取模块用于获取与多个二维码在机器人坐标系下的位姿以及查询到的二维码ID对应的全局位姿相关的第一误差函数,计算第一误差函数的最优化解得到机器人的当前全局位姿。
11.根据权利要求10所述的室内机器人定位装置,其特征在于,还包括:
机器人激光定位位姿获取模块,用于获取机器人当前激光定位位姿;
所述机器人当前位姿获取模块,用于获取与所述当前激光定位位姿、第一误差函数相关的第二误差函数;计算第二误差函数的最优化解得到机器人的当前全局位姿。
12.一种室内机器人定位系统,其特征在于,包括:
权利要求9-11任一项所述的室内机器人定位装置;
激光设备,用于扫描工作区域以获得激光环境地图并发送到所述装置;
摄像头,用于拍摄获得工作区域内的二维码的图像并发送到所述装置,以及拍摄获得工作区域内的任意二维码的图像并发送到所述装置。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711492946.4A CN108363386A (zh) | 2017-12-30 | 2017-12-30 | 基于二维码和激光的室内机器人定位方法、装置及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711492946.4A CN108363386A (zh) | 2017-12-30 | 2017-12-30 | 基于二维码和激光的室内机器人定位方法、装置及系统 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN108363386A true CN108363386A (zh) | 2018-08-03 |
Family
ID=63010813
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711492946.4A Pending CN108363386A (zh) | 2017-12-30 | 2017-12-30 | 基于二维码和激光的室内机器人定位方法、装置及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108363386A (zh) |
Cited By (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109357676A (zh) * | 2018-10-19 | 2019-02-19 | 北京三快在线科技有限公司 | 一种移动设备的定位方法及装置和移动设备 |
CN109460029A (zh) * | 2018-11-29 | 2019-03-12 | 华南农业大学 | 畜禽养殖场所巡检移动平台及其控制方法 |
CN109543489A (zh) * | 2019-01-04 | 2019-03-29 | 广州广电研究院有限公司 | 基于二维码的定位方法、装置和存储介质 |
CN109556616A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种基于视觉标记的自动建图机器人建图修整方法 |
CN109573439A (zh) * | 2018-12-27 | 2019-04-05 | 北京艾瑞思机器人技术有限公司 | 搬运机器人、货架、仓储系统以及搬运货架的方法 |
CN109579843A (zh) * | 2018-11-29 | 2019-04-05 | 浙江工业大学 | 一种空地多视角下的多机器人协同定位及融合建图方法 |
CN110163025A (zh) * | 2019-04-29 | 2019-08-23 | 达泊(东莞)智能科技有限公司 | 二维码定位方法及装置 |
CN111157012A (zh) * | 2019-12-31 | 2020-05-15 | 深圳市优必选科技股份有限公司 | 一种机器人导航方法、装置、可读存储介质及机器人 |
CN111443713A (zh) * | 2020-04-14 | 2020-07-24 | 三一机器人科技有限公司 | 融合定位导航系统和方法 |
WO2020211564A1 (zh) * | 2019-04-14 | 2020-10-22 | 炬星科技(深圳)有限公司 | 仓储地图快速确定方法、设备、存储介质及机器人 |
CN112700495A (zh) * | 2020-11-25 | 2021-04-23 | 北京旷视机器人技术有限公司 | 位姿确定方法、装置、机器人、电子设备及存储介质 |
CN113675923A (zh) * | 2021-08-23 | 2021-11-19 | 追觅创新科技(苏州)有限公司 | 充电方法、充电装置及机器人 |
CN115191213A (zh) * | 2022-07-20 | 2022-10-18 | 松灵机器人(成都)有限公司 | 机器人定位方法、装置、割草机器人以及存储介质 |
CN117830604A (zh) * | 2024-03-06 | 2024-04-05 | 成都睿芯行科技有限公司 | 一种定位用二维码异常检测方法及介质 |
CN117824666A (zh) * | 2024-03-06 | 2024-04-05 | 成都睿芯行科技有限公司 | 融合定位用二维码对、二维码标定方法及融合定位方法 |
CN117990082A (zh) * | 2023-12-29 | 2024-05-07 | 无锡优奇智能科技有限公司 | 包含激光slam与二维码融合的定位方法、机器人及存储介质 |
Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103294059A (zh) * | 2013-05-21 | 2013-09-11 | 无锡普智联科高新技术有限公司 | 基于混合导航带的移动机器人定位系统及其方法 |
CN103345247A (zh) * | 2013-06-20 | 2013-10-09 | 无锡普智联科高新技术有限公司 | 用于校正贴码误差的移动机器人定位方法 |
CN104142683A (zh) * | 2013-11-15 | 2014-11-12 | 上海快仓智能科技有限公司 | 基于二维码定位的自动引导车导航方法 |
GR20140100259A (el) * | 2014-05-06 | 2016-02-01 | Επιτροπη Ερευνων Πανεπιστημιου Ιωαννινων (Ε.Λ.Κ.Ε.) | Συστημα εντοπισμου θεσης, καθοδηγησης και πληροφορησης αυτονομων μηχανων μεσω προεπεξεργασμενων σηματων |
CN105929820A (zh) * | 2016-04-19 | 2016-09-07 | 天津市道本致远科技有限公司 | 一种智能机器人定位方法 |
CN105953798A (zh) * | 2016-04-19 | 2016-09-21 | 深圳市神州云海智能科技有限公司 | 移动机器人的位姿确定方法和设备 |
CN106091924A (zh) * | 2016-05-30 | 2016-11-09 | 深圳普智联科机器人技术有限公司 | 一种使用激光校正贴码误差的系统和方法 |
CN106338991A (zh) * | 2016-08-26 | 2017-01-18 | 南京理工大学 | 一种基于惯性导航和二维码的机器人及定位导航方法 |
JP2017117012A (ja) * | 2015-12-21 | 2017-06-29 | 株式会社デンソー | 無人搬送車及び無人搬送システム |
CN106989746A (zh) * | 2017-03-27 | 2017-07-28 | 远形时空科技(北京)有限公司 | 导航方法及导航装置 |
CN106990780A (zh) * | 2017-03-28 | 2017-07-28 | 奇瑞汽车股份有限公司 | 一种用于无人驾驶电动汽车的自动充电机导航系统及导航方法 |
CN107328420A (zh) * | 2017-08-18 | 2017-11-07 | 上海木爷机器人技术有限公司 | 定位方法和装置 |
CN107463173A (zh) * | 2017-07-31 | 2017-12-12 | 广州维绅科技有限公司 | 仓储agv导航方法及装置、计算机设备及存储介质 |
CN107515891A (zh) * | 2017-07-06 | 2017-12-26 | 杭州南江机器人股份有限公司 | 一种机器人地图制作方法、装置和存储介质 |
-
2017
- 2017-12-30 CN CN201711492946.4A patent/CN108363386A/zh active Pending
Patent Citations (14)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103294059A (zh) * | 2013-05-21 | 2013-09-11 | 无锡普智联科高新技术有限公司 | 基于混合导航带的移动机器人定位系统及其方法 |
CN103345247A (zh) * | 2013-06-20 | 2013-10-09 | 无锡普智联科高新技术有限公司 | 用于校正贴码误差的移动机器人定位方法 |
CN104142683A (zh) * | 2013-11-15 | 2014-11-12 | 上海快仓智能科技有限公司 | 基于二维码定位的自动引导车导航方法 |
GR20140100259A (el) * | 2014-05-06 | 2016-02-01 | Επιτροπη Ερευνων Πανεπιστημιου Ιωαννινων (Ε.Λ.Κ.Ε.) | Συστημα εντοπισμου θεσης, καθοδηγησης και πληροφορησης αυτονομων μηχανων μεσω προεπεξεργασμενων σηματων |
JP2017117012A (ja) * | 2015-12-21 | 2017-06-29 | 株式会社デンソー | 無人搬送車及び無人搬送システム |
CN105929820A (zh) * | 2016-04-19 | 2016-09-07 | 天津市道本致远科技有限公司 | 一种智能机器人定位方法 |
CN105953798A (zh) * | 2016-04-19 | 2016-09-21 | 深圳市神州云海智能科技有限公司 | 移动机器人的位姿确定方法和设备 |
CN106091924A (zh) * | 2016-05-30 | 2016-11-09 | 深圳普智联科机器人技术有限公司 | 一种使用激光校正贴码误差的系统和方法 |
CN106338991A (zh) * | 2016-08-26 | 2017-01-18 | 南京理工大学 | 一种基于惯性导航和二维码的机器人及定位导航方法 |
CN106989746A (zh) * | 2017-03-27 | 2017-07-28 | 远形时空科技(北京)有限公司 | 导航方法及导航装置 |
CN106990780A (zh) * | 2017-03-28 | 2017-07-28 | 奇瑞汽车股份有限公司 | 一种用于无人驾驶电动汽车的自动充电机导航系统及导航方法 |
CN107515891A (zh) * | 2017-07-06 | 2017-12-26 | 杭州南江机器人股份有限公司 | 一种机器人地图制作方法、装置和存储介质 |
CN107463173A (zh) * | 2017-07-31 | 2017-12-12 | 广州维绅科技有限公司 | 仓储agv导航方法及装置、计算机设备及存储介质 |
CN107328420A (zh) * | 2017-08-18 | 2017-11-07 | 上海木爷机器人技术有限公司 | 定位方法和装置 |
Non-Patent Citations (4)
Title |
---|
GRIGORI GORONZY: "Indoor positioning system for self-balancing robots based on QR codes", 《2016 INTERNATIONAL CONFERENCE ON INDOOR POSITIONING AND INDOOR NAVIGATION 》 * |
QIAN ZOU: "A robot navigation method based on laser and 2D code", 《2016 IEEE INTERNATIONAL CONFERENCE ON INFORMATION AND AUTOMATION (ICIA)》 * |
尚明超: "二维码修正EKF-SLAM定位的室内无人驾驶小车", 《单片机与嵌入式系统应用》 * |
曹琳: "一种应用于室内移动机器人的快速二维码定位技术", 《企业科技与发展》 * |
Cited By (24)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109357676A (zh) * | 2018-10-19 | 2019-02-19 | 北京三快在线科技有限公司 | 一种移动设备的定位方法及装置和移动设备 |
CN109556616A (zh) * | 2018-11-09 | 2019-04-02 | 同济大学 | 一种基于视觉标记的自动建图机器人建图修整方法 |
CN109579843B (zh) * | 2018-11-29 | 2020-10-27 | 浙江工业大学 | 一种空地多视角下的多机器人协同定位及融合建图方法 |
CN109460029A (zh) * | 2018-11-29 | 2019-03-12 | 华南农业大学 | 畜禽养殖场所巡检移动平台及其控制方法 |
CN109579843A (zh) * | 2018-11-29 | 2019-04-05 | 浙江工业大学 | 一种空地多视角下的多机器人协同定位及融合建图方法 |
CN109573439A (zh) * | 2018-12-27 | 2019-04-05 | 北京艾瑞思机器人技术有限公司 | 搬运机器人、货架、仓储系统以及搬运货架的方法 |
CN109573439B (zh) * | 2018-12-27 | 2021-07-09 | 北京旷视机器人技术有限公司 | 搬运机器人、货架、仓储系统以及搬运货架的方法 |
CN109543489A (zh) * | 2019-01-04 | 2019-03-29 | 广州广电研究院有限公司 | 基于二维码的定位方法、装置和存储介质 |
US11376735B2 (en) | 2019-04-14 | 2022-07-05 | Syrius Robotics Co., Ltd. | Method for rapidly determining warehousing map, device, storage medium and robot |
WO2020211564A1 (zh) * | 2019-04-14 | 2020-10-22 | 炬星科技(深圳)有限公司 | 仓储地图快速确定方法、设备、存储介质及机器人 |
CN110163025A (zh) * | 2019-04-29 | 2019-08-23 | 达泊(东莞)智能科技有限公司 | 二维码定位方法及装置 |
CN111157012B (zh) * | 2019-12-31 | 2021-12-17 | 深圳市优必选科技股份有限公司 | 一种机器人导航方法、装置、可读存储介质及机器人 |
CN111157012A (zh) * | 2019-12-31 | 2020-05-15 | 深圳市优必选科技股份有限公司 | 一种机器人导航方法、装置、可读存储介质及机器人 |
CN111443713B (zh) * | 2020-04-14 | 2023-07-18 | 三一机器人科技有限公司 | 融合定位导航系统和方法 |
CN111443713A (zh) * | 2020-04-14 | 2020-07-24 | 三一机器人科技有限公司 | 融合定位导航系统和方法 |
CN112700495A (zh) * | 2020-11-25 | 2021-04-23 | 北京旷视机器人技术有限公司 | 位姿确定方法、装置、机器人、电子设备及存储介质 |
CN113675923A (zh) * | 2021-08-23 | 2021-11-19 | 追觅创新科技(苏州)有限公司 | 充电方法、充电装置及机器人 |
CN113675923B (zh) * | 2021-08-23 | 2023-08-08 | 追觅创新科技(苏州)有限公司 | 充电方法、充电装置及机器人 |
CN115191213A (zh) * | 2022-07-20 | 2022-10-18 | 松灵机器人(成都)有限公司 | 机器人定位方法、装置、割草机器人以及存储介质 |
CN117990082A (zh) * | 2023-12-29 | 2024-05-07 | 无锡优奇智能科技有限公司 | 包含激光slam与二维码融合的定位方法、机器人及存储介质 |
CN117830604A (zh) * | 2024-03-06 | 2024-04-05 | 成都睿芯行科技有限公司 | 一种定位用二维码异常检测方法及介质 |
CN117824666A (zh) * | 2024-03-06 | 2024-04-05 | 成都睿芯行科技有限公司 | 融合定位用二维码对、二维码标定方法及融合定位方法 |
CN117830604B (zh) * | 2024-03-06 | 2024-05-10 | 成都睿芯行科技有限公司 | 一种定位用二维码异常检测方法及介质 |
CN117824666B (zh) * | 2024-03-06 | 2024-05-10 | 成都睿芯行科技有限公司 | 融合定位用二维码对、二维码标定方法及融合定位方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108363386A (zh) | 基于二维码和激光的室内机器人定位方法、装置及系统 | |
CN102735235B (zh) | 基于二维码的室内移动机器人定位系统 | |
CN103064417B (zh) | 一种基于多传感器的全局定位导引系统及方法 | |
CN107218927B (zh) | 一种基于tof相机的货物托盘检测系统和方法 | |
CN109671119A (zh) | 一种基于slam的室内定位方法及装置 | |
CN106291517A (zh) | 基于位置与视觉信息优化的室内云机器人角度定位方法 | |
CN109556616A (zh) | 一种基于视觉标记的自动建图机器人建图修整方法 | |
CN108180912B (zh) | 基于混合导航带的移动机器人定位系统及方法 | |
US20230236280A1 (en) | Method and system for positioning indoor autonomous mobile robot | |
CN105865419A (zh) | 基于地面特征的移动机器人的自主精确定位系统及方法 | |
CN101957447A (zh) | 基于有源rfid的室内移动机器人定位系统和方法 | |
CN105865438A (zh) | 基于机器视觉的移动机器人的自主精确定位系统 | |
CN111667216A (zh) | 一种无人机室内仓储自主盘点系统及方法 | |
CN108762251A (zh) | 一种图书馆机器人定位导航方法 | |
CN105865437A (zh) | 基于射频识别的移动机器人的自主精确定位系统及方法 | |
CN104766309A (zh) | 一种平面特征点导航定位方法与装置 | |
CN110108269A (zh) | 基于多传感器数据融合的agv定位方法 | |
CN109041207A (zh) | 基于bim技术可用于虚拟现实和增强现实的精确定位系统 | |
CN105116886A (zh) | 一种机器人自主行走的方法 | |
CN106446746B (zh) | 一种基于rfid的空间寻物导航系统 | |
CN107886018A (zh) | 判断标签移动方向的方法和装置 | |
CN108550278A (zh) | 停车泊位占用状态检测设备及移动式停车泊位占用状态检测设备 | |
CN107895129A (zh) | 通过调整读卡距离来获得不同的读卡范围的方法 | |
CN117824666B (zh) | 融合定位用二维码对、二维码标定方法及融合定位方法 | |
CN115661240A (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 | ||
AD01 | Patent right deemed abandoned | ||
AD01 | Patent right deemed abandoned |
Effective date of abandoning: 20220624 |