CN108489486B - 二维码以及用于机器人的视觉-惯性组合导航系统及方法 - Google Patents
二维码以及用于机器人的视觉-惯性组合导航系统及方法 Download PDFInfo
- Publication number
- CN108489486B CN108489486B CN201810229929.XA CN201810229929A CN108489486B CN 108489486 B CN108489486 B CN 108489486B CN 201810229929 A CN201810229929 A CN 201810229929A CN 108489486 B CN108489486 B CN 108489486B
- Authority
- CN
- China
- Prior art keywords
- dimensional code
- robot
- relative
- direction angle
- absolute
- 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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
Abstract
本发明实施例提供了一种二维码以及用于机器人的视觉‑惯性组合导航系统及方法。二维码的外围带有封闭的辅助边框,该辅助边框和二维码均用于视觉导航。用于机器人的视觉‑惯性组合导航系统采用前述二维码。用于机器人的视觉‑惯性组合导航方法包括:在地面上铺设多个外围带有封闭的辅助边框的二维码;在机器人行进过程中,成像设备拍摄图像;获取成像设备的绝对位置和绝对方向角,获得二维码的绝对坐标,成像设备的绝对位置和绝对方向角;确定机器人相对其当前起始点的相对位置和相对其当前起始方向角的相对方向角;得到机器人的绝对位置,利用该绝对位置作为下一起始点;得到机器人的绝对方向角,利用该绝对方向角作为下一起始方向角。
Description
相关申请的交叉引用
本申请为2015年6月1日提交的中国专利申请号为“201510293436.9”的分案申请,其全部内容作为整体并入本申请中。
技术领域
本发明涉及导航领域,具体而言涉及一种二维码以及用于机器人的视觉-惯性组合导航系统及方法。
背景技术
视觉-惯性组合导航凭借其良好的互补性和自主性逐渐成为导航领域的重要发展方向和极具发展前景的导航技术。惯性导航是一种不依赖外界信息的自主式导航系统,具有实时性好、抗干扰性强等优点,但其精度误差会造成累积漂移误差,在较长时间内难以达到定位的要求。因此,在视觉/惯性组合导航中,视觉导航用以辅助定位修正惯性导航的漂移,从而提供一种高精度的组合定位方式。从工程应用角度看,视觉导航的精确性、鲁棒性和实时性是影响视觉/惯性组合导航性能的重要因素。
发明内容
鉴于背景技术中存在的问题,本发明的目的在于提供一种二维码以及用于机器人的视觉-惯性组合导航系统及方法,其能有效加快二维码区域的筛选效率、成像设备的绝对位置和绝对方向角的计算效率,实时地修正惯性导航的漂移,以更可靠地以视觉/惯性组合的方式实现机器人的高精度实时导航。
为了实现上述目的,在第一方面,本发明实施例提供了一种二维码,其中所述二维码的外围带有封闭的辅助边框,该辅助边框和所述二维码均用于视觉导航。
为了实现上述目的,在第二方面,本发明实施例提供了一种用于机器人的视觉-惯性组合导航方法,包括:
控制设置在机器人上的成像设备拍摄机器人在行进路线上经过铺设在地面上的外围带有辅助边框的二维码,以获得二维码的图像;
针对拍摄的二维码的图像进行边缘提取,以获得边缘图像;
针对边缘图像进行筛选,以获得封闭的轮廓曲线;
针对封闭的轮廓曲线进行多边形拟合,并将辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框;
基于辅助边框确定辅助边框内的区域为二维码区域;
基于确定的辅助边框和确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角;
利用二维码扫描程序对二维码的图像在二维码区域内进行扫描,以扫描二维码,并基于二维码编码规则对扫描后的二维码进行解码和校验,以获得二维码的绝对坐标;
基于计算出的成像设备的相对位置和相对方向角以及获得的二维码的绝对坐标,经坐标系转换,获得成像设备的绝对位置和绝对方向角,作为惯性导航中修正机器人位置的视觉导航数据;
获得机器人相对机器人的当前起始点的相对位置以及机器人相对机器人的当前起始方向角的相对方向角;机器人的相对位置和相对方向角是由设置在机器人上的编码器和惯性导航系统确定的;
对成像设备的绝对位置和机器人的相对位置进行计算,以得到机器人的绝对位置,并利用得到的机器人的绝对位置作为惯性导航中确定机器人的下一起始位置,以及,对成像设备的绝对方向角和机器人的相对方向角进行估计,以得到机器人的绝对方向角,并利用得到的机器人的绝对方向角作为惯性导航中确定机器人的下一起始方向角。
为了实现上述目的,在第三方面,本发明实施例提供了一种用于视觉-惯性组合导航的二维码区域筛选方法,所述视觉-惯性组合导航运用在机器人上,该方法包括:
控制设置在机器人上的成像设备拍摄机器人在行进路线上经过铺设在地面上的外围带有辅助边框的二维码,以获得二维码的图像;
针对拍摄的二维码的图像进行边缘提取,以获得边缘图像;
针对边缘图像进行筛选,以获得封闭的轮廓曲线;
针对封闭的轮廓曲线进行多边形拟合,并将辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框;
基于辅助边框确定辅助边框内的区域为二维码区域。
为了实现上述目的,在第六方面,本发明实施例提供了一种用于机器人的视觉-惯性组合导航系统,包括本发明实施例的第一方面所述的二维码以及机器人,或者包括本发明实施例的第一方面所述的二维码以及机器人;多个所述二维码铺设在地面上。
本发明实施例的有益效果如下:
在本发明的二维码以及用于机器人的视觉-惯性组合导航系统及方法中,采用外围带有封闭的辅助边框的二维码,能有效加快二维码区域的筛选效率、成像设备的绝对位置和绝对方向角的计算效率;由于在地面上铺设多个外围带有封闭的辅助边框的二维码,在机器人行进过程中,通过设置在机器人上的成像设备拍摄机器人在其行进路线上经过的铺设在地面上的外围带有辅助边框的二维码的图像,之后经过计算得到机器人的绝对位置和绝对方向角,并利用得到机器人的该绝对位置和绝对方向角作为惯性导航系统确定机器人的下一起始点和下一起始方向角,从而可以在机器人行进过程中每拍摄到经过的外围带有辅助边框的二维码的图像,就进行如此处理,实时地修正惯性导航的漂移,以更可靠地以视觉/惯性组合的方式实现机器人的高精度实时导航。
附图说明
图1示出根据本发明的二维码;
图2示出在地面上铺设多个外围带有封闭的辅助边框的二维码的示意图;
图3为在根据本发明的用于机器人的视觉-惯性组合导航方法中的步骤S4中确定机器人的当前起始点的相对位置的计算示意图。
具体实施方式
下面参照附图来说明本发明的二维码以及用于机器人的视觉-惯性组合导航系统及方法。
首先说明根据本发明第一方面的二维码。
图1示出根据本发明第一方面的二维码,如图1所示,所述二维码的外围带有封闭的辅助边框,该辅助边框和所述二维码均用于视觉导航。在图1中,黑色最外的边框为辅助边框,辅助边框的色彩无限制,只要与二维码的背景色足以区分即可。此外,该辅助边框和所述二维码均用于视觉导航,本发明的辅助边框不起修饰作用。
在根据本发明第一方面所述的二维码中,辅助边框可为方形。由于目前的二维码的轮廓都是方形,采用方形的辅助边框,包络二维码的轮廓的辅助边框最小,从而在识别时容易且最快。但是如果采用其他形状,例如三角形,包络线非常大,也不容易判断。当然不限于此,如果二维码的轮廓变化,也可采用与二维码的轮廓几何相似的辅助边框。
在根据本发明第一方面所述的二维码中,二维码可为QR码。但不限于此,可以选用任何合适的二维码。
其次说明根据本发明第二方面的用于机器人的视觉-惯性组合导航系统。
根据本发明第二方面的用于机器人的视觉-惯性组合导航系统采用本发明第一方面所述的二维码,且在地面上铺设多个外围带有封闭的辅助边框的二维码(如图2所示)。图2示出在地面上铺设多个外围带有封闭的辅助边框的二维码的示意图,其只是一个示意,多个外围带有封闭的辅助边框的二维码在地面上的铺设可以视实际情况来布置。
最后说明根据本发明第三方面的用于机器人的视觉-惯性组合导航方法。
根据本发明第三方面的用于机器人的视觉-惯性组合导航方法包括步骤:步骤S1,在地面上铺设多个外围带有封闭的辅助边框的二维码;步骤S2,在机器人行进过程中,通过设置在机器人上的成像设备拍摄机器人在其行进路线上经过的铺设在地面上的外围带有辅助边框的二维码的图像;步骤S3,当拍摄到一个铺设在地面上的外围带有辅助边框的二维码的图像时,基于拍摄的该一个图像获取成像设备的绝对位置和绝对方向角;步骤S4,利用设置在机器人上的编码器和惯性导航系统确定机器人相对机器人的当前起始点的相对位置和机器人相对机器人的当前起始方向角的相对方向角;步骤S5,对成像设备的绝对位置和机器人的相对位置进行计算,以得到机器人的绝对位置,并利用得到机器人的该绝对位置作为惯性导航系统确定机器人的下一起始点;以及步骤S6,对成像设备的绝对方向角和机器人的相对方向角进行估计,以得到机器人的绝对方向角,并利用得到机器人的该绝对方向角作为惯性导航系统确定机器人的下一起始方向角。其中,步骤S3包括子步骤:子步骤S31,针对拍摄的图像进行边缘提取,以获得边缘图像;子步骤S32,针对边缘图像进行筛选,以获得封闭的轮廓曲线;子步骤S33,对封闭的轮廓曲线进行多边形拟合,并将与辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框;子步骤S34,基于辅助边框确定辅助边框内的区域为二维码区域;子步骤S35,基于确定的辅助边框以及确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角;子步骤S36,利用二维码扫描程序对拍摄的图像在二维码区域内进行扫描,以扫描二维码,并基于二维码编码规则对扫描后的二维码进行解码和校验,以获得二维码的绝对坐标;以及子步骤S37,基于子步骤S35计算出的成像设备的相对位置和相对方向角和子步骤S36获得的二维码的绝对坐标,经坐标系转换,获得成像设备的绝对位置和绝对方向角,作为修正机器人位置的视觉导航数据。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在步骤S1中,辅助边框可为方形。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在步骤S2中,成像设备可为摄像机,当然不限于此,可以采用任何具有拍摄功能的设备。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在步骤S2中,成像设备设置在机器人的底部且镜头的轴线垂直于地面,以使成像设备正对铺设在地面上的外围带有辅助边框的二维码进行拍摄,从而获得垂直拍摄的图像。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在子步骤S31中,使用canny算子对图像进行卷积得到边缘灰度图(其中,canny算子参见:http:// baike.baidu.com/link?url=UEQx23cOWV2HEMdSxRF8Ndzns98piUlmawtPCVECgpm2VfcdNX ipCdfg_3_UyMCtZGlm8g7cxcJES3e41erbRq),再根据规定的阈值对边缘灰度图进行二值化,从而得到二值化的边缘图像;在子步骤S32中,针对二值化的边缘图像,进行轮廓提取,得到封闭的轮廓,并将得到的封闭轮廓存储;在子步骤S33中,使用Ramer–Douglas–Peucker算法对轮廓曲线进行多边形拟合,以确定辅助边框;在子步骤S35中,辅助边框的内周或外周的顶点的图像坐标,计算出成像设备的光心相对于二维码区域的中心的相对位置和相对方位角,以作为成像设备的相对位置和相对方位角,计算过程为:根据辅助边框的内周或外周的顶点的图像坐标计算得到辅助边框中心的图像像素坐标,该图像像素坐标乘以比例因子即为成像设备的光心相对于二维码区域的中心的相对位置,其中比例因子为k=行长度/行像素个数;由辅助边框中心点与图像中心点组成一条直线,计算该直线与竖直方向的夹角,即为成像设备的光心相对于二维码区域的中心的相对方位角。
其中,轮廓提取参见文献参见:铃木智,基于边界跟踪的二值化图像的拓扑结构分析,《计算机视觉、图形与图像处理》,30(1),1985,32-46(Suzuki,Satoshi."Topologicalstructural analysis of digitized binary images by border following."ComputerVision,Graphics,and Image Processing 30,no.1(1985):32-46);Ramer–Douglas–Peucker算法,参见:http://en.wikipedia.org/wiki/Ramer%E2%80%93Douglas%E2% 80%93Peucker_algorithm。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在子步骤S37中,坐标系转换为:设二维码的绝对位置为(x1,y1),绝对方向角为θ,设成像设备的相对位置数据(x1’,y1’),绝对方向角为θ’,则成像设备的绝对位置为(x1+x1’,y1+y1’),绝对方向角为θ+θ’。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在步骤S1中,辅助边框为方形;在步骤S1中,二维码为QR码,QR码包含有三个小正方形,所述三个小正方形为QR本身的位置探测图形;在子步骤S34中,还利用二维码本身的位置探测图形进行二维码区域的校验:在子步骤S34中,基于辅助边框确定辅助边框内的区域为二维码区域后,再利用子步骤S33中获得封闭的轮廓曲线,当存在有三个封闭的轮廓曲线与三个小正方形的轮廓在尺寸和形状上均相同时,校验该二维码区域的确定正确。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在子步骤S35和子步骤S36之间还可包括子步骤:基于确定的二维码区域并通过透视变换获得正的二维码图像。在一实施例中,透视变换为:将包含二维码区域的辅助边框的顶点对应到一个正多边形区域得到单应性矩阵,之后再根据这个单应性矩阵进行透视变换得到正的二维码图像,从而采用透视变换将二维码的图像转换成正的形状。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在一实施例中,在步骤S4中,利用设置在机器人上的编码器提供的编码器信息和惯性导航系统的陀螺仪提供的陀螺仪信息,确定机器人相对机器人的当前起始点的相对位置和相对机器人的当前起始方向角的相对方向角,机器人的相对方向角用θd表示:
1)从编码器估计机器人方向角
用θe(k)和θe(k-1)分别表示在k时刻和(k-1)时刻从编码器信息估计的机器人角度值;dθr(k)和dθl(k)分别表示右驱动轮编码器和左驱动轮编码器的角度增量,θe(k)可由下式计算:
其中ne(k)为编码器角度测量误差,由对编码器脉冲数计数误差引起,是一个零均值高斯白噪声;Rd为驱动轮半径;b为驱动轮之间沿轴线的距离;r为电机减速比;
2)从陀螺仪估计机器人方向角
陀螺仪是角速度传感器,通过对陀螺仪数据的积分,得到机器人相对于初始位置所转过的角度,用θg(k)及θg(k-1)分别表示k时刻和(k-1)时刻从陀螺仪数据积分得到的机器人方向角,表示陀螺仪的角速度,T为积分周期,则从θg(k-1)到θg(k)的一步更新公式为:
其中ng(k)为陀螺仪角度估计中的随机误差,由陀螺仪的随机漂移引起;
3)相对角度的确定
基于从编码器估计的机器人方向角θe(k)和从陀螺仪估计的机器人方向角θg(k),确定机器人相对机器人的当前起始点的相对方向角,假设零均值高斯白噪声过程ne(k)和ng(k)的协方差分别为σe和σg,则:
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在一实施例中,在步骤S4中,航位推测方法融合机器人的相对方向角和里程信息,从机器人的初始位置开始推算出机器人相对机器人的当前起始点的相对位置,对机器人定位系统做如下约定:
1)机器人在绝对坐标系的位置和方向表示为状态向量(x,y,θ);
2)机器人两驱动轮的轴线中心点代表机器人所在的位置;
3)机器人车头方向代表机器人的正方向;
为了得到机器人相对机器人的当前起始点的相对位置,且便于数据处理,使用微元累加的方式,将机器人的行动曲线视为多段微小的直线组成的,从机器人的初始位置不断累加;
机器人由一个向量表示(参照图3),显示了从在(k-1)时刻的点A(x(k-1),y(k-1))行走到k时刻的点A′(x(k),y(k)),点A(x(k-1),y(k-1))定义为机器人的当前起始点,角度从θ(k-1)增加到θ(k)的状态变化,Δx,Δy,Δθ分别表示在惯性导航的一个程序循环时间周期T内机器人的横、纵坐标和方向角的增加量;Δl为点A到A′的直线距离;Δs为机器人从点A到A′行走的实际距离,可以从驱动轮编码器的脉冲增量转换而来,由图3所知,Δx,Δy可由如下公式计算得到:
由于从点A到A′的时间间隔T很短,Δl与Δs可以近似相等,则:
这样,从机器人的初始位置的坐标(x(0),y(0))开始,机器人的惯性导航的每个程序循环时间周期T都在上一个周期的机器人坐标(x(k-1),y(k-1))的基础上,计算一次坐标更新(x(k),y(k)),(x(k),y(k))即为机器人相对机器人的当前起始点的相对位置,而(x(k-1),y(k-1))的计算需要从机器人的初始位置的坐标(x(0),y(0))开始,其中机器人的初始坐标(x(0),y(0))是指在机器人加电后开始工作的初始时刻的绝对坐标位置,程序循环时间周期T是指惯性导航每隔一个固定的时间T进行一次惯性导航计算,惯性导航计算的过程是一个等时间间隔的无限循环过程。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在步骤S5中,规定k为离散化时间变量,Xa(k)为k时刻子步骤S37获得的成像设备的绝对位置的坐标,Xd(k)为k时刻步骤S4确定的机器人相对机器人的当前起始点的相对位置的坐标,经过绝对位置和相对位置融合后得到的机器人坐标为X(k),采用卡尔曼滤波方法(参见http://baike.haosou.com/doc/3054305-3219642.html)进行数据融合,计算步骤如下:
2)计算误差增益K(k)
其中R(k)为二维码视觉测量噪声的对角协方差矩阵,在步骤S36中校验二维码的过程中,通过统计的方法来确定;
3)机器人的位置融合计算
其中Xa(k)为k时刻子步骤S37获得的成像设备的绝对位置的坐标,即Xa(k)=(xa(k),ya(k)),I为单位矩阵;
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在步骤S6中,对成像设备的绝对方向角和机器人的相对方向角进行估计以得到机器人的绝对方向角的计算步骤如下:
假设对应当前起始点的k时刻,机器人的绝对方向角用θ表示,在步骤S4中通过编码器和惯性导航系统得到机器人相对机器人的当前起始点的相对方向角为θr(k),在步骤S37中成像设备的绝对方向角为θa(k),θr(k)和θa(k)的误差模型分别为零均值高斯白噪声过程ne(k)和ng(k),ne(k)和ng(k)的协方差分别为σe和σg,则:
在本发明的二维码以及用于机器人的视觉-惯性组合导航系统及方法中,采用外围带有封闭的辅助边框的二维码,能有效加快二维码区域的筛选效率、成像设备的绝对位置和绝对方向角的计算效率;由于在地面上铺设多个外围带有封闭的辅助边框的二维码,在机器人行进过程中,通过设置在机器人上的成像设备拍摄机器人在其行进路线上经过的铺设在地面上的外围带有辅助边框的二维码的图像,之后经过计算得到机器人的绝对位置和绝对方向角,并利用得到机器人的该绝对位置和绝对方向角作为惯性导航系统确定机器人的下一起始点和下一起始方向角,从而可以在机器人行进过程中每拍摄到经过的外围带有辅助边框的二维码的图像,就进行如此处理,实时地修正惯性导航的漂移,以更可靠地以视觉/惯性组合的方式实现机器人的高精度实时导航。
Claims (14)
1.一种用于机器人的视觉-惯性组合导航方法,其特征在于,包括:
控制设置在机器人上的成像设备拍摄机器人在行进路线上经过铺设在地面上的外围带有辅助边框的二维码,以获得二维码的图像;
针对拍摄的二维码的图像进行边缘提取,以获得边缘图像;
针对边缘图像进行筛选,以获得封闭的轮廓曲线;
针对封闭的轮廓曲线进行多边形拟合,并将辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框;
基于辅助边框确定辅助边框内的区域为二维码区域;
基于确定的辅助边框和确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角;
利用二维码扫描程序对二维码的图像在二维码区域内进行扫描,以扫描二维码,并基于二维码编码规则对扫描后的二维码进行解码和校验,以获得二维码的绝对坐标;
基于计算出的成像设备的相对位置和相对方向角以及获得的二维码的绝对坐标,经坐标系转换,获得成像设备的绝对位置和绝对方向角,作为惯性导航中修正机器人位置的视觉导航数据;
获得机器人相对机器人的当前起始点的相对位置以及机器人相对机器人的当前起始方向角的相对方向角;机器人的相对位置和相对方向角是由设置在机器人上的编码器和惯性导航系统确定的;
对成像设备的绝对位置和机器人的相对位置进行计算,以得到机器人的绝对位置,并利用得到的机器人的绝对位置作为惯性导航中确定机器人的下一起始位置,以及,对成像设备的绝对方向角和机器人的相对方向角进行估计,以得到机器人的绝对方向角,并利用得到的机器人的绝对方向角作为惯性导航中确定机器人的下一起始方向角。
2.根据权利要求1所述的方法,其特征在于,所述基于确定的辅助边框和确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角,包括:
根据确定的辅助边框的内周或外周的顶点的图像坐标,计算出成像设备的光心相对于二维码区域的中心的相对位置和相对方向角,作为成像设备相对于二维码区域的相对位置和相对方向角。
3.根据权利要求2所述的方法,其特征在于,所述根据确定的辅助边框的内周或外周的顶点的图像坐标,计算出成像设备的光心相对于二维码区域的中心的相对位置和相对方向角,包括:
根据辅助边框的内周或外周的顶点的图像坐标,计算得到辅助边框中心的图像像素坐标,将图像像素坐标乘以比例因子即为成像设备的光心相对于二维码区域的中心的相对位置;其中,比例因子k=行长度/行像素个数;
由辅助边框中心点与二维码的图像中心点组成一条直线,计算直线与竖直方向的夹角,为成像设备的光心相对于二维码区域的中心的相对方位角。
4.根据权利要求1所述的方法,其特征在于,所述基于计算出的成像设备的相对位置和相对方向角以及获得的二维码的绝对坐标,经坐标系转换,获得成像设备的绝对位置和绝对方向角,包括:
设二维码的绝对坐标为(x1,y1),绝对方向角为θ,设成像设备的相对位置为(x1’,y1’),绝对方向角为θ’,则成像设备的绝对位置为(x1+x1’,y1+y1’),绝对方向角为θ+θ’。
5.根据权利要求1所述的方法,其特征在于,所述二维码为QR码,QR码包含有三个小正方形,所述三个小正方形为QR本身的位置探测图形。
6.根据权利要求5所述的方法,其特征在于,在基于辅助边框确定辅助边框内的区域为二维码区域后,还包括:
针对封闭的轮廓曲线,如果存在有三个封闭的轮廓曲线与三个小正方形的轮廓在尺寸和形状上均相同,二维码区域确定正确。
7.根据权利要求1所述的方法,其特征在于,在基于确定的辅助边框和确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角,且在利用二维码扫描程序对二维码的图像在二维码区域内进行扫描之前,还包括:
将包含二维码区域的辅助边框的顶点对应到一个正多边形区域得到单应性矩阵;
根据单应性矩阵进行透视变换得到正的二维码区域。
8.一种用于视觉-惯性组合导航的二维码区域筛选方法,所述视觉-惯性组合导航运用在机器人上,其特征在于,包括:
控制设置在机器人上的成像设备拍摄机器人在行进路线上经过铺设在地面上的外围带有辅助边框的二维码,以获得二维码的图像;
针对拍摄的二维码的图像进行边缘提取,以获得边缘图像;
针对边缘图像进行筛选,以获得封闭的轮廓曲线;
针对封闭的轮廓曲线进行多边形拟合,并将辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框;
基于辅助边框确定辅助边框内的区域为二维码区域。
9.根据权利要求8所述的方法,其特征在于,所述二维码为QR码,QR码包含有三个小正方形,所述三个小正方形为QR本身的位置探测图形。
10.根据权利要求9所述的方法,其特征在于,还包括:
针对封闭的轮廓曲线,如果存在有三个封闭的轮廓曲线与三个小正方形的轮廓在尺寸和形状上均相同,二维码区域确定正确。
11.根据权利要求8所述的方法,其特征在于,还包括:
基于确定的辅助边框和确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角;
利用二维码扫描程序对二维码的图像在二维码区域内进行扫描,以扫描二维码,并基于二维码编码规则对扫描后的二维码进行解码和校验,以获得二维码的绝对坐标;
基于计算出的成像设备的相对位置和相对方向角以及获得的二维码的绝对坐标,经坐标系转换,获得成像设备的绝对位置和绝对方向角,作为惯性导航中修正机器人位置的视觉导航数据。
12.一种机器人,其特征在于,包括存储器和处理器;其中,
所述存储器用于存储一条或多条计算机指令,所述一条或多条计算机被所述处理器执行如权利要求1-7中任一项所述的方法。
13.一种机器人,其特征在于,包括存储器和处理器;其中,
所述存储器用于存储一条或多条计算机指令,所述一条或多条计算机被所述处理器执行如权利要求8-11中任一项所述的方法。
14.一种用于机器人的视觉-惯性组合导航系统,其特征在于,包括二维码以及如权利要求12所述的机器人,或者包括二维码以及如权利要求13所述的机器人;多个所述二维码铺设在地面上,所述二维码的外围带有封闭的辅助边框,该辅助边框和所述二维码均用于视觉导航。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810229929.XA CN108489486B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510293436.9A CN104848858B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
CN201810229929.XA CN108489486B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Related Parent Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510293436.9A Division CN104848858B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108489486A CN108489486A (zh) | 2018-09-04 |
CN108489486B true CN108489486B (zh) | 2021-07-02 |
Family
ID=53848684
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510293436.9A Active CN104848858B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
CN201810229929.XA Active CN108489486B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510293436.9A Active CN104848858B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (2) | CN104848858B (zh) |
Families Citing this family (56)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
DE112016004079T5 (de) | 2015-09-09 | 2018-06-07 | Sony Corporation | Sensorvorrichtung, Sensorsystem und Informationsverarbeitungsvorrichtung |
CN105511466B (zh) * | 2015-12-03 | 2019-01-25 | 上海交通大学 | 基于二维码带的agv定位方法及系统 |
CN105549585B (zh) * | 2015-12-07 | 2018-03-23 | 江苏木盟智能科技有限公司 | 机器人导航方法及系统 |
CN105486311B (zh) * | 2015-12-24 | 2019-08-16 | 青岛海通机器人系统有限公司 | 室内机器人定位导航方法及装置 |
CN105928514A (zh) * | 2016-04-14 | 2016-09-07 | 广州智能装备研究院有限公司 | 基于图像与惯性技术的agv复合导引系统 |
CN105783915A (zh) * | 2016-04-15 | 2016-07-20 | 深圳马路创新科技有限公司 | 机器人基于图形标识和摄像头的全局空间定位方法 |
CN106017477B (zh) * | 2016-07-07 | 2023-06-23 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
CN106338991A (zh) * | 2016-08-26 | 2017-01-18 | 南京理工大学 | 一种基于惯性导航和二维码的机器人及定位导航方法 |
CN106123908B (zh) * | 2016-09-08 | 2019-12-03 | 北京京东尚科信息技术有限公司 | 车辆导航方法和系统 |
CN106441277A (zh) * | 2016-09-28 | 2017-02-22 | 深圳市普渡科技有限公司 | 一种基于编码器与惯性导航单元的机器人位姿估计方法 |
CN106647738A (zh) * | 2016-11-10 | 2017-05-10 | 杭州南江机器人股份有限公司 | 一种无人搬运车的对接路径确定方法及系统及无人搬运车 |
CN108073163B (zh) * | 2016-11-11 | 2020-11-03 | 中国科学院沈阳计算技术研究所有限公司 | 利用二维码反馈值补偿确定机器人精确位置的控制方法 |
CN106382934A (zh) * | 2016-11-16 | 2017-02-08 | 深圳普智联科机器人技术有限公司 | 一种高精度移动机器人定位系统和方法 |
CN108121332A (zh) * | 2016-11-28 | 2018-06-05 | 沈阳新松机器人自动化股份有限公司 | 基于二维码的室内移动机器人定位装置及方法 |
CN106708051B (zh) * | 2017-01-10 | 2023-04-18 | 北京极智嘉科技股份有限公司 | 基于二维码的导航系统和方法、导航标记物及导航控制器 |
CN106899609A (zh) * | 2017-03-22 | 2017-06-27 | 上海中商网络股份有限公司 | 一种码中码及其生成、验证方法及装置 |
CN106989746A (zh) * | 2017-03-27 | 2017-07-28 | 远形时空科技(北京)有限公司 | 导航方法及导航装置 |
CN106991909A (zh) * | 2017-05-25 | 2017-07-28 | 锥能机器人(上海)有限公司 | 一种用于空间定位的地面标识 |
CN107727104B (zh) * | 2017-08-16 | 2019-04-30 | 北京极智嘉科技有限公司 | 结合标识的同时定位和地图创建导航方法、装置及系统 |
CN107671863B (zh) * | 2017-08-22 | 2020-06-26 | 广东美的智能机器人有限公司 | 基于二维码的机器人控制方法、装置及机器人 |
CN107729958B (zh) * | 2017-09-06 | 2021-06-18 | 新华三技术有限公司 | 一种信息发送方法及装置 |
CN107976187B (zh) * | 2017-11-07 | 2020-08-04 | 北京工商大学 | 一种融合imu和视觉传感器的室内轨迹重建方法及系统 |
CN108151727B (zh) * | 2017-12-01 | 2019-07-26 | 合肥优控科技有限公司 | 移动机器人定位方法、系统与计算机可读存储介质 |
CN108305291B (zh) * | 2018-01-08 | 2022-02-01 | 武汉大学 | 利用包含定位二维码的墙体广告的单目视觉定位定姿方法 |
CN108088439B (zh) * | 2018-01-19 | 2020-11-24 | 浙江科钛机器人股份有限公司 | 一种融合电子地图、二维码和色带的agv复合导航系统及方法 |
CN110243360B (zh) * | 2018-03-08 | 2022-02-22 | 深圳市优必选科技有限公司 | 机器人在运动区域的地图构建及定位方法 |
CN108763996B (zh) * | 2018-03-23 | 2021-06-15 | 南京航空航天大学 | 一种基于二维码的平面定位坐标与方向角测量方法 |
CN110361003B (zh) * | 2018-04-09 | 2023-06-30 | 中南大学 | 信息融合方法、装置、计算机设备和计算机可读存储介质 |
CN108492678A (zh) * | 2018-06-14 | 2018-09-04 | 深圳欧沃机器人有限公司 | 利用卡片进行编程的装置及系统 |
CN108759853A (zh) * | 2018-06-15 | 2018-11-06 | 浙江国自机器人技术有限公司 | 一种机器人定位方法、系统、设备及计算机可读存储介质 |
CN108955668A (zh) * | 2018-08-02 | 2018-12-07 | 苏州中德睿博智能科技有限公司 | 一种融合二维码与色带的复合导航方法、装置及系统 |
CN108955667A (zh) * | 2018-08-02 | 2018-12-07 | 苏州中德睿博智能科技有限公司 | 一种融合激光雷达与二维码的复合导航方法、装置及系统 |
CN109060840B (zh) * | 2018-08-10 | 2022-04-05 | 北京极智嘉科技股份有限公司 | 二维码的质量监测方法、装置、机器人、服务器和介质 |
CN109346148A (zh) * | 2018-08-16 | 2019-02-15 | 常州市钱璟康复股份有限公司 | 上肢康复训练机器人的二维码位置识别方法及其系统 |
CN109009871A (zh) * | 2018-08-16 | 2018-12-18 | 常州市钱璟康复股份有限公司 | 一种上肢康复训练机器人 |
CN109100738B (zh) * | 2018-08-20 | 2023-01-03 | 武汉理工大学 | 一种基于多传感器信息融合的可靠定位系统及方法 |
CN109002046B (zh) * | 2018-09-21 | 2020-07-10 | 中国石油大学(北京) | 一种移动机器人导航系统及导航方法 |
CN109556596A (zh) | 2018-10-19 | 2019-04-02 | 北京极智嘉科技有限公司 | 基于地面纹理图像的导航方法、装置、设备及存储介质 |
CN109298715B (zh) * | 2018-11-09 | 2021-12-07 | 苏州瑞得恩光能科技有限公司 | 机器人行进控制系统及行进控制方法 |
CN109489667A (zh) * | 2018-11-16 | 2019-03-19 | 楚天智能机器人(长沙)有限公司 | 一种基于权值矩阵的改进蚁群路径规划方法 |
CN109571464B (zh) * | 2018-11-16 | 2021-12-28 | 楚天智能机器人(长沙)有限公司 | 一种基于惯性和二维码导航的机器人初始对准方法 |
CN109571408B (zh) * | 2018-12-26 | 2020-03-10 | 北京极智嘉科技有限公司 | 一种机器人、库存容器的角度校准方法及存储介质 |
CN109631887B (zh) * | 2018-12-29 | 2022-10-18 | 重庆邮电大学 | 基于双目、加速度与陀螺仪的惯性导航高精度定位方法 |
CN109827595B (zh) * | 2019-03-22 | 2020-12-01 | 京东方科技集团股份有限公司 | 室内惯性导航仪方向校准方法、室内导航装置及电子设备 |
CN113390420A (zh) * | 2019-05-27 | 2021-09-14 | 深圳市海柔创新科技有限公司 | 导航方法、移动载体及导航系统 |
CN110231030A (zh) * | 2019-06-28 | 2019-09-13 | 苏州瑞久智能科技有限公司 | 基于陀螺仪的扫地机器人角度最优估算方法 |
CN110515381B (zh) * | 2019-08-22 | 2022-11-25 | 浙江迈睿机器人有限公司 | 用于定位机器人的多传感器融合算法 |
CN112683266A (zh) * | 2019-10-17 | 2021-04-20 | 科沃斯机器人股份有限公司 | 机器人及其导航方法 |
CN111862208A (zh) * | 2020-06-18 | 2020-10-30 | 中国科学院深圳先进技术研究院 | 一种基于屏幕光通信的车辆定位方法、装置及服务器 |
CN112183682A (zh) * | 2020-09-01 | 2021-01-05 | 广东中鹏热能科技有限公司 | 一种利用伺服驱动和二维码及射频识别卡实现的定位方法 |
CN112256027B (zh) * | 2020-10-15 | 2024-04-05 | 珠海一微半导体股份有限公司 | 一种机器人基于视觉角度纠正惯性角度的导航方法 |
CN112686070B (zh) * | 2020-11-27 | 2023-04-07 | 浙江工业大学 | 一种基于改进二维码的agv定位及导航方法 |
CN113218403B (zh) * | 2021-05-14 | 2022-09-09 | 哈尔滨工程大学 | 惯性视觉组合式定位的agv系统 |
CN113642687A (zh) * | 2021-07-16 | 2021-11-12 | 国网上海市电力公司 | 一种融合二维码识别和惯性系统的变电站巡检室内位置推算方法 |
CN113935356A (zh) * | 2021-10-20 | 2022-01-14 | 广东新时空科技股份有限公司 | 一种基于二维码的三维定位和定姿系统及方法 |
CN116592876B (zh) * | 2023-07-17 | 2023-10-03 | 北京元客方舟科技有限公司 | 定位装置及定位装置的定位方法 |
Family Cites Families (15)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4141742B2 (ja) * | 2002-05-31 | 2008-08-27 | ベリテック インコーポレーテッド | □型識別コード紙 |
CN100390807C (zh) * | 2006-08-21 | 2008-05-28 | 北京中星微电子有限公司 | 一种易于全方位识别的三边形多维条码的识读方法 |
CN102034127A (zh) * | 2009-09-28 | 2011-04-27 | 上海易悠通信息科技有限公司 | 新型大容量二维条码与系统及其编解码方法和应用 |
CN102135429B (zh) * | 2010-12-29 | 2012-06-13 | 东南大学 | 一种基于视觉的机器人室内定位导航方法 |
CN102081747A (zh) * | 2011-01-24 | 2011-06-01 | 广州宽度信息技术有限公司 | 一种二维真知码 |
KR101293703B1 (ko) * | 2011-11-28 | 2013-08-06 | (주)이컴앤드시스템 | 스큐된 데이터 매트릭스 바코드 디코딩 장치와 이를 위한 방법 |
US9430206B2 (en) * | 2011-12-16 | 2016-08-30 | Hsiu-Ping Lin | Systems for downloading location-based application and methods using the same |
CN102735235B (zh) * | 2012-06-07 | 2014-12-24 | 无锡普智联科高新技术有限公司 | 基于二维码的室内移动机器人定位系统 |
CN104424491A (zh) * | 2013-08-26 | 2015-03-18 | 程抒一 | 二维码导航系统 |
CN104142683B (zh) * | 2013-11-15 | 2016-06-08 | 上海快仓智能科技有限公司 | 基于二维码定位的自动引导车导航方法 |
CN103714313B (zh) * | 2013-12-30 | 2016-07-06 | 优视科技有限公司 | 二维码识别方法和装置 |
CN103699869B (zh) * | 2013-12-30 | 2017-02-01 | 优视科技有限公司 | 一种二维码识别方法及装置 |
CN103699865B (zh) * | 2014-01-15 | 2019-01-25 | 吴东辉 | 一种边框图形码 |
CN103884335A (zh) * | 2014-04-09 | 2014-06-25 | 北京数联空间科技股份有限公司 | 基于二维码地理信息标志的遥感与摄影测量定位方法 |
CN104457734B (zh) * | 2014-09-02 | 2017-06-06 | 惠安县长智电子科技有限公司 | 一种停车场导航系统 |
-
2015
- 2015-06-01 CN CN201510293436.9A patent/CN104848858B/zh active Active
- 2015-06-01 CN CN201810229929.XA patent/CN108489486B/zh active Active
Also Published As
Publication number | Publication date |
---|---|
CN104848858A (zh) | 2015-08-19 |
CN104848858B (zh) | 2018-07-20 |
CN108489486A (zh) | 2018-09-04 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108489486B (zh) | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 | |
EP2917754B1 (en) | Image processing method, particularly used in a vision-based localization of a device | |
US9625912B2 (en) | Methods and systems for mobile-agent navigation | |
WO2019105044A1 (zh) | 一种镜头畸变矫正和特征提取的方法及系统 | |
WO2018196391A1 (zh) | 一种车载摄像机的外部参数标定方法及装置 | |
CN111210477B (zh) | 一种运动目标的定位方法及系统 | |
Su et al. | GR-LOAM: LiDAR-based sensor fusion SLAM for ground robots on complex terrain | |
JP5966747B2 (ja) | 車両走行制御装置及びその方法 | |
WO2013133129A1 (ja) | 移動物体位置姿勢推定装置及び移動物体位置姿勢推定方法 | |
WO2020000737A1 (zh) | 移动机器人定位方法、存储介质及计算机设备 | |
WO2012043045A1 (ja) | 画像処理装置及びそれを用いた撮像装置 | |
WO2020228694A1 (zh) | 一种相机姿态信息检测方法、装置以及相应的智能驾驶设备 | |
CN108733039A (zh) | 一种机器人室内导航定位的方法与装置 | |
CN109815831B (zh) | 一种车辆朝向获取方法及相关装置 | |
EP3032818A1 (en) | Image processing device and markers | |
CN112347205B (zh) | 一种车辆误差状态的更新方法和装置 | |
JP5310027B2 (ja) | 車線認識装置、及び車線認識方法 | |
CN113095184B (zh) | 定位方法、行驶控制方法、装置、计算机设备及存储介质 | |
CN113834492A (zh) | 地图匹配方法、系统、设备及可读存储介质 | |
CN112179373A (zh) | 一种视觉里程计的测量方法及视觉里程计 | |
Truong et al. | New lane detection algorithm for autonomous vehicles using computer vision | |
US20200193184A1 (en) | Image processing device and image processing method | |
KR102490521B1 (ko) | 라이다 좌표계와 카메라 좌표계의 벡터 정합을 통한 자동 캘리브레이션 방법 | |
JP2012159470A (ja) | 車両用画像認識装置 | |
CN116958452A (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 | ||
CB02 | Change of applicant information | ||
CB02 | Change of applicant information |
Address after: 100085 Room 101, block a, 9 Xinbei Road, Laiguangying Township, Chaoyang District, Beijing Applicant after: Beijing jizhijia Technology Co.,Ltd. Address before: 100085 Room 101, block a, 9 Xinbei Road, Laiguangying Township, Chaoyang District, Beijing Applicant before: Beijing Geekplus Technology Co.,Ltd. |
|
GR01 | Patent grant | ||
GR01 | Patent grant |