CN104848858A - 二维码以及用于机器人的视觉-惯性组合导航系统及方法 - Google Patents
二维码以及用于机器人的视觉-惯性组合导航系统及方法 Download PDFInfo
- Publication number
- CN104848858A CN104848858A CN201510293436.9A CN201510293436A CN104848858A CN 104848858 A CN104848858 A CN 104848858A CN 201510293436 A CN201510293436 A CN 201510293436A CN 104848858 A CN104848858 A CN 104848858A
- Authority
- CN
- China
- Prior art keywords
- robot
- theta
- quick response
- response code
- sub
- 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
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
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Manipulator (AREA)
Abstract
本发明提供了一种二维码以及用于机器人的视觉-惯性组合导航系统及方法。二维码的外围带有封闭的辅助边框,该辅助边框和二维码均用于视觉导航。用于机器人的视觉-惯性组合导航系统采用前述二维码。用于机器人的视觉-惯性组合导航方法包括:在地面上铺设多个外围带有封闭的辅助边框的二维码;在机器人行进过程中,成像设备拍摄图像;获取成像设备的绝对位置和绝对方向角,获得二维码的绝对坐标,成像设备的绝对位置和绝对方向角;确定机器人相对其当前起始点的相对位置和相对其当前起始方向角的相对方向角;得到机器人的绝对位置,利用该绝对位置作为下一起始点;得到机器人的绝对方向角,利用该绝对方向角作为下一起始方向角。
Description
技术领域
本发明涉及导航领域,具体而言涉及一种二维码以及用于机器人的视觉-惯性组合导航系统及方法。
背景技术
视觉-惯性组合导航凭借其良好的互补性和自主性逐渐成为导航领域的重要发展方向和极具发展前景的导航技术。惯性导航是一种不依赖外界信息的自主式导航系统,具有实时性好、抗干扰性强等优点,但其精度误差会造成累积漂移误差,在较长时间内难以达到定位的要求。因此,在视觉/惯性组合导航中,视觉导航用以辅助定位修正惯性导航的漂移,从而提供一种高精度的组合定位方式。从工程应用角度看,视觉导航的精确性、鲁棒性和实时性是影响视觉/惯性组合导航性能的重要因素。
发明内容
鉴于背景技术中存在的问题,本发明的目的在于提供一种二维码以及用于机器人的视觉-惯性组合导航系统及方法,其能有效加快二维码区域的筛选效率、成像设备的绝对位置和绝对方向角的计算效率,实时地修正惯性导航的漂移,以更可靠地以视觉/惯性组合的方式实现机器人的高精度实时导航。
为了实现上述目的,在第一方面,本发明提供了一种二维码,其中所述二维码的外围带有封闭的辅助边框,该辅助边框和所述二维码均用于视觉导航。
为了实现上述目的,在第二方面,本发明提供了一种用于机器人的视觉-惯性组合导航系统,其采用本发明第一方面所述的二维码,且在地面上铺设多个外围带有封闭的辅助边框的二维码。
为了实现上述目的,在第三方面,本发明提供了一种用于机器人的视觉-惯性组合导航方法,其包括步骤:步骤S1,在地面上铺设多个外围带有封闭的辅助边框的二维码;步骤S2,在机器人行进过程中,通过设置在机器人上的成像设备拍摄机器人在其行进路线上经过的铺设在地面上的外围带有辅助边框的二维码的图像;步骤S3,当拍摄到一个铺设在地面上的外围带有辅助边框的二维码的图像时,基于拍摄的该一个图像获取成像设备的绝对位置和绝对方向角;步骤S4,利用设置在机器人上的编码器和惯性导航系统确定机器人相对机器人的当前起始点的相对位置和机器人相对机器人的当前起始方向角的相对方向角;步骤S5,对成像设备的绝对位置和机器人的相对位置进行计算,以得到机器人的绝对位置,并利用得到机器人的该绝对位置作为惯性导航系统确定机器人的下一起始点;以及步骤S6,对成像设备的绝对方向角和机器人的相对方向角进行估计,以得到机器人的绝对方向角,并利用得到机器人的该绝对方向角作为惯性导航系统确定机器人的下一起始方向角。其中,步骤S3包括子步骤:子步骤S31,针对拍摄的图像进行边缘提取,以获得边缘图像;子步骤S32,针对边缘图像进行筛选,以获得封闭的轮廓曲线;子步骤S33,对封闭的轮廓曲线进行多边形拟合,并将与辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框;子步骤S34,基于辅助边框确定辅助边框内的区域为二维码区域;子步骤S35,基于确定的辅助边框以及确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角;子步骤S36,利用二维码扫描程序对拍摄的图像在二维码区域内进行扫描,以扫描二维码,并基于二维码编码规则对扫描后的二维码进行解码和校验,以获得二维码的绝对坐标;以及子步骤S37,基于子步骤S35计算出的成像设备的相对位置和相对方向角和子步骤S36获得的二维码的绝对坐标,经坐标系转换,获得成像设备的绝对位置和绝对方向角,作为修正机器人位置的视觉导航数据。
本发明的有益效果如下:
在本发明的二维码以及用于机器人的视觉-惯性组合导航系统及方法中,采用外围带有封闭的辅助边框的二维码,能有效加快二维码区域的筛选效率、成像设备的绝对位置和绝对方向角的计算效率;由于在地面上铺设多个外围带有封闭的辅助边框的二维码,在机器人行进过程中,通过设置在机器人上的成像设备拍摄机器人在其行进路线上经过的铺设在地面上的外围带有辅助边框的二维码的图像,之后经过计算得到机器人的绝对位置和绝对方向角,并利用得到机器人的该绝对位置和绝对方向角作为惯性导航系统确定机器人的下一起始点和下一起始方向角,从而可以在机器人行进过程中每拍摄到经过的外围带有辅助边框的二维码的图像,就进行如此处理,实时地修正惯性导航的漂移,以更可靠地以视觉/惯性组合的方式实现机器人的高精度实时导航。
附图说明
图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=UEQx23cOWV2HEMdSxRF8Ndzns98piUlmaw tPCVECgpm2VfcdNXipCdfg_3_UyMCtZGlm8g7cxcJES3e41erbRq),再根据规定的阈值对边缘灰度图进行二值化,从而得到二值化的边缘图像;在子步骤S32中,针对二值化的边缘图像,进行轮廓提取,得到封闭的轮廓,并将得到的封闭轮廓存储;在子步骤S33中,使用Ramer–Douglas–Peucker算法对轮廓曲线进行多边形拟合,以确定辅助边框;在子步骤S35中,辅助边框的内周或外周的顶点的图像坐标,计算出成像设备的光心相对于二维码区域的中心的相对位置和相对方位角,以作为成像设备的相对位置和相对方位角,计算过程为:根据辅助边框的内周或外周的顶点的图像坐标计算得到辅助边框中心的图像像素坐标,该图像像素坐标乘以比例因子即为成像设备的光心相对于二维码区域的中心的相对位置,其中比例因子为k=行长度/行像素个数;由辅助边框中心点与图像中心点组成一条直线,计算该直线与竖直方向的夹角,即为成像设备的光心相对于二维码区域的中心的相对方位角。
其中,轮廓提取参见文献参见:铃木智,基于边界跟踪的二值化图像的拓扑结构分析,《计算机视觉、图形与图像处理》,30(1),1985,32-46(Suzuki,Satoshi."Topological structural analysis of digitized binary images byborder following."Computer Vision,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)进行数据融合,计算步骤如下:
1)计算一步最优估计值其为通过航位推测得到的相对位置Xd(k),即:
一步最优估计值的协方差矩阵可以通过下面的递推公式计算:
其中为k-1时刻的最优估计的协方差矩阵,Q(k-1)为过程噪声的协方差矩阵,为一个对角矩阵;
2)计算误差增益K(k)
其中R(k)为二维码视觉测量噪声的对角协方差矩阵,在步骤S36中校验二维码的过程中,通过统计的方法来确定;
3)机器人的位置融合计算
更新误差增益矩阵
其中Xa(k)为k时刻子步骤S37获得的成像设备的绝对位置的坐标,即Xa(k)=(xa(k),ya(k)),I为单位矩阵;
令即得到经过绝对位置和相对位置融合后的机器人坐标,并使以消除步骤S4中机器人相对起始点的相对位置的累计误差。
在根据本发明第三方面的用于机器人的视觉-惯性组合导航方法中,在一实施例中,在步骤S6中,对成像设备的绝对方向角和机器人的相对方向角进行估计以得到机器人的绝对方向角的计算步骤如下:
假设对应当前起始点的k时刻,机器人的绝对方向角用θ表示,在步骤S4中通过编码器和惯性导航系统得到机器人相对机器人的当前起始点的相对方向角为θr(k),在步骤S37中成像设备的绝对方向角为θa(k),θr(k)和θa(k)的误差模型分别为零均值高斯白噪声过程ne(k)和ng(k),ne(k)和ng(k)的协方差分别为σe和σg,则:
在本发明的二维码以及用于机器人的视觉-惯性组合导航系统及方法中,采用外围带有封闭的辅助边框的二维码,能有效加快二维码区域的筛选效率、成像设备的绝对位置和绝对方向角的计算效率;由于在地面上铺设多个外围带有封闭的辅助边框的二维码,在机器人行进过程中,通过设置在机器人上的成像设备拍摄机器人在其行进路线上经过的铺设在地面上的外围带有辅助边框的二维码的图像,之后经过计算得到机器人的绝对位置和绝对方向角,并利用得到机器人的该绝对位置和绝对方向角作为惯性导航系统确定机器人的下一起始点和下一起始方向角,从而可以在机器人行进过程中每拍摄到经过的外围带有辅助边框的二维码的图像,就进行如此处理,实时地修正惯性导航的漂移,以更可靠地以视觉/惯性组合的方式实现机器人的高精度实时导航。
Claims (11)
1.一种二维码,其特征在于,所述二维码的外围带有封闭的辅助边框,该辅助边框和所述二维码均用于视觉导航。
2.根据权利要求1所述的二维码,其特征在于,辅助边框为方形。
3.根据权利要求1所述的二维码,其特征在于,二维码为QR码。
4.一种用于机器人的视觉-惯性组合导航系统,其特征在于,采用权利要求1-3中任一项所述的二维码,且在地面上铺设多个外围带有封闭的辅助边框的二维码。
5.一种用于机器人的视觉-惯性组合导航方法,其特征在于,包括步骤:
步骤S1,在地面上铺设多个外围带有封闭的辅助边框的二维码;
步骤S2,在机器人行进过程中,通过设置在机器人上的成像设备拍摄机器人在其行进路线上经过的铺设在地面上的外围带有辅助边框的二维码的图像;
步骤S3,当拍摄到一个铺设在地面上的外围带有辅助边框的二维码的图像时,基于拍摄的该一个图像获取成像设备的绝对位置和绝对方向角,包括子步骤:
子步骤S31,针对拍摄的图像进行边缘提取,以获得边缘图像;
子步骤S32,针对边缘图像进行筛选,以获得封闭的轮廓曲线;
子步骤S33,对封闭的轮廓曲线进行多边形拟合,并将与辅助边框的轮廓在尺寸和形状均相同的封闭的轮廓曲线确定为辅助边框;
子步骤S34,基于辅助边框确定辅助边框内的区域为二维码区域;
子步骤S35,基于确定的辅助边框以及确定的二维码区域,计算成像设备相对于二维码区域的相对位置和相对方向角;
子步骤S36,利用二维码扫描程序对拍摄的图像在二维码区域内进行扫描,以扫描二维码,并基于二维码编码规则对扫描后的二维码进行解码和校验,以获得二维码的绝对坐标;以及
子步骤S37,基于子步骤S35计算出的成像设备的相对位置和相对方向角和子步骤S36获得的二维码的绝对坐标,经坐标系转换,获得成像设备的绝对位置和绝对方向角,作为修正机器人位置的视觉导航数据;
步骤S4,利用设置在机器人上的编码器和惯性导航系统确定机器人相对机器人的当前起始点的相对位置和机器人相对机器人的当前起始方向角的相对方向角;
步骤S5,对成像设备的绝对位置和机器人的相对位置进行计算,以得到机器人的绝对位置,并利用得到机器人的该绝对位置作为惯性导航系统确定机器人的下一起始点;以及
步骤S6,对成像设备的绝对方向角和机器人的相对方向角进行估计,以得到机器人的绝对方向角,并利用得到机器人的该绝对方向角作为惯性导航系统确定机器人的下一起始方向角。
6.根据权利要求5所述的用于机器人的视觉-惯性组合导航方法,其特征在于,
在子步骤S31中,使用canny算子对图像进行卷积得到边缘灰度图,再根据规定的阈值对边缘灰度图进行二值化,从而得到二值化的边缘图像;
在子步骤S32中,针对二值化的边缘图像,进行轮廓提取,得到封闭的轮廓,并将得到的封闭轮廓存储;
在子步骤S33中,使用Ramer–Douglas–Peucker算法对轮廓曲线进行多边形拟合,以确定辅助边框。
在子步骤S35中,辅助边框的内周或外周的顶点的图像坐标,计算出成像设备的光心相对于二维码区域的中心的相对位置和相对方位角,以作为成像设备的相对位置和相对方位角,计算过程为:
根据辅助边框的内周或外周的顶点的图像坐标计算得到辅助边框中心的图像像素坐标,该图像像素坐标乘以比例因子即为成像设备的光心相对于二维码区域的中心的相对位置,其中比例因子为k=行长度/行像素个数;
由辅助边框中心点与图像中心点组成一条直线,计算该直线与竖直方向的夹角,即为成像设备的光心相对于二维码区域的中心的相对方位角在子步骤S37中,坐标系转换为:
设二维码的绝对位置为(x1,y1),绝对方向角为θ,设成像设备的相对位置数据(x1’,y1’),绝对方向角为θ’,则成像设备的绝对位置为(x1+x1’,y1+y1’),绝对方向角为θ+θ’。
7.根据权利要求5所述的用于机器人的视觉-惯性组合导航方法,其特征在于,
在步骤S1中,辅助边框为方形;
在步骤S1中,二维码为QR码,QR码包含有三个小正方形,所述三个小正方形为QR本身的位置探测图形;
在子步骤S34中,还利用二维码本身的位置探测图形进行二维码区域的校验:在子步骤S34中,基于辅助边框确定辅助边框内的区域为二维码区域后,再利用子步骤S33中获得封闭的轮廓曲线,当存在有三个封闭的轮廓曲线与三个小正方形的轮廓在尺寸和形状上均相同时,校验该二维码区域的确定正确。
8.根据权利要求5所述的用于机器人的视觉-惯性组合导航方法,其特征在于,
在子步骤S35和子步骤S36之间还包括子步骤:基于确定的二维码区域并通过透视变换获得正的二维码图像;
透视变换为:
将包含二维码区域的辅助边框的顶点对应到一个正多边形区域得到单应性矩阵,之后再根据这个单应性矩阵进行透视变换得到正的二维码图像,从而采用透视变换将二维码的图像转换成正的形状。
9.根据权利要求5所述的用于机器人的视觉-惯性组合导航方法,其特征在于,
在步骤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)机器人车头方向代表机器人的正方向;
为了得到机器人相对机器人的当前起始点的相对位置,且便于数据处理,使用微元累加的方式,将机器人的行动曲线视为多段微小的直线组成的,从机器人的初始位置不断累加;
机器人由一个向量表示,显示了从在(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′行走的实际距离,可以从驱动轮编码器的脉冲增量转换而来,Δ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进行一次惯性导航计算,惯性导航计算的过程是一个等时间间隔的无限循环过程。
10.根据权利要求5所述的用于机器人的视觉-惯性组合导航方法,其特征在于,在步骤S5中,
规定k为离散化时间变量,Xa(k)为k时刻子步骤S37获得的成像设备的绝对位置的坐标,Xd(k)为k时刻步骤S4确定的机器人相对机器人的当前起始点的相对位置的坐标,经过绝对位置和相对位置融合后得到的机器人坐标为X(k),
采用卡尔曼滤波方法进行数据融合,计算步骤如下:
1)计算一步最优估计值其为通过航位推测得到的相对位置Xd(k),即:
一步最优估计值的协方差矩阵可以通过下面的递推公式计算:
其中为k-1时刻的最优估计的协方差矩阵,Q(k-1)为过程噪声的协方差矩阵,为一个对角矩阵;
2)计算误差增益K(k)
其中R(k)为二维码视觉测量噪声的对角协方差矩阵,在步骤S36中校验二维码的过程中,通过统计的方法来确定;
3)机器人的位置融合计算
更新误差增益矩阵
其中Xa(k)为k时刻子步骤S37获得的成像设备的绝对位置的坐标,即Xa(k)=(xa(k),ya(k)),I为单位矩阵;
令即得到经过绝对位置和相对位置融合后的机器人坐标,并使以消除步骤S4中机器人相对起始点的相对位置的累计误差。
11.根据权利要求5所述的用于机器人的视觉-惯性组合导航方法,其特征在于,在步骤S6中,对成像设备的绝对方向角和机器人的相对方向角进行估计以得到机器人的绝对方向角的计算步骤如下:
假设对应当前起始点的k时刻,机器人的绝对方向角用θ表示,在步骤S4中通过编码器和惯性导航系统得到机器人相对机器人的当前起始点的相对方向角为θr(k),在步骤S37中成像设备的绝对方向角为θa(k),θr(k)和θa(k)的误差模型分别为零均值高斯白噪声过程ne(k)和ng(k),ne(k)和ng(k)的协方差分别为σe和σg,则:
Priority Applications (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 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510293436.9A CN104848858B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Related Child Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810229929.XA Division CN108489486B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104848858A true CN104848858A (zh) | 2015-08-19 |
CN104848858B CN104848858B (zh) | 2018-07-20 |
Family
ID=53848684
Family Applications (2)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810229929.XA Active CN108489486B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
CN201510293436.9A Active CN104848858B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Family Applications Before (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810229929.XA Active CN108489486B (zh) | 2015-06-01 | 2015-06-01 | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (2) | CN108489486B (zh) |
Cited By (54)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105486311A (zh) * | 2015-12-24 | 2016-04-13 | 青岛海通机器人系统有限公司 | 室内机器人定位导航方法及装置 |
CN105511466A (zh) * | 2015-12-03 | 2016-04-20 | 上海交通大学 | 基于二维码带的agv定位方法及系统 |
CN105549585A (zh) * | 2015-12-07 | 2016-05-04 | 江苏木盟智能科技有限公司 | 机器人导航方法及系统 |
CN105783915A (zh) * | 2016-04-15 | 2016-07-20 | 深圳马路创新科技有限公司 | 机器人基于图形标识和摄像头的全局空间定位方法 |
CN105928514A (zh) * | 2016-04-14 | 2016-09-07 | 广州智能装备研究院有限公司 | 基于图像与惯性技术的agv复合导引系统 |
CN106017477A (zh) * | 2016-07-07 | 2016-10-12 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
CN106123908A (zh) * | 2016-09-08 | 2016-11-16 | 北京京东尚科信息技术有限公司 | 车辆导航方法和系统 |
CN106338991A (zh) * | 2016-08-26 | 2017-01-18 | 南京理工大学 | 一种基于惯性导航和二维码的机器人及定位导航方法 |
CN106382934A (zh) * | 2016-11-16 | 2017-02-08 | 深圳普智联科机器人技术有限公司 | 一种高精度移动机器人定位系统和方法 |
CN106441277A (zh) * | 2016-09-28 | 2017-02-22 | 深圳市普渡科技有限公司 | 一种基于编码器与惯性导航单元的机器人位姿估计方法 |
CN106647738A (zh) * | 2016-11-10 | 2017-05-10 | 杭州南江机器人股份有限公司 | 一种无人搬运车的对接路径确定方法及系统及无人搬运车 |
CN106708051A (zh) * | 2017-01-10 | 2017-05-24 | 上海极络智能科技有限公司 | 基于二维码的导航系统和方法、导航标记物及导航控制器 |
CN106899609A (zh) * | 2017-03-22 | 2017-06-27 | 上海中商网络股份有限公司 | 一种码中码及其生成、验证方法及装置 |
CN106989746A (zh) * | 2017-03-27 | 2017-07-28 | 远形时空科技(北京)有限公司 | 导航方法及导航装置 |
CN106991909A (zh) * | 2017-05-25 | 2017-07-28 | 锥能机器人(上海)有限公司 | 一种用于空间定位的地面标识 |
CN107671863A (zh) * | 2017-08-22 | 2018-02-09 | 广东美的智能机器人有限公司 | 基于二维码的机器人控制方法、装置及机器人 |
CN107727104A (zh) * | 2017-08-16 | 2018-02-23 | 北京极智嘉科技有限公司 | 结合标识的同时定位和地图创建导航方法、装置及系统 |
CN107729958A (zh) * | 2017-09-06 | 2018-02-23 | 新华三技术有限公司 | 一种信息发送方法及装置 |
CN107923740A (zh) * | 2015-09-09 | 2018-04-17 | 索尼公司 | 传感器设备、传感器系统以及信息处理设备 |
CN107976187A (zh) * | 2017-11-07 | 2018-05-01 | 北京工商大学 | 一种融合imu和视觉传感器的室内高精度轨迹重建方法及系统 |
CN108073163A (zh) * | 2016-11-11 | 2018-05-25 | 中国科学院沈阳计算技术研究所有限公司 | 利用二维码反馈值补偿确定机器人精确位置的控制方法 |
CN108088439A (zh) * | 2018-01-19 | 2018-05-29 | 浙江科钛机器人股份有限公司 | 一种融合电子地图、二维码和色带的agv复合导航系统及方法 |
CN108121332A (zh) * | 2016-11-28 | 2018-06-05 | 沈阳新松机器人自动化股份有限公司 | 基于二维码的室内移动机器人定位装置及方法 |
CN108151727A (zh) * | 2017-12-01 | 2018-06-12 | 合肥优控科技有限公司 | 移动机器人定位方法、系统与计算机可读存储介质 |
CN108305291A (zh) * | 2018-01-08 | 2018-07-20 | 武汉大学 | 利用包含定位二维码的墙体广告的单目视觉定位定姿方法 |
CN108492678A (zh) * | 2018-06-14 | 2018-09-04 | 深圳欧沃机器人有限公司 | 利用卡片进行编程的装置及系统 |
CN108763996A (zh) * | 2018-03-23 | 2018-11-06 | 南京航空航天大学 | 一种基于二维码的平面定位坐标与方向角测量方法 |
CN108759853A (zh) * | 2018-06-15 | 2018-11-06 | 浙江国自机器人技术有限公司 | 一种机器人定位方法、系统、设备及计算机可读存储介质 |
CN108955667A (zh) * | 2018-08-02 | 2018-12-07 | 苏州中德睿博智能科技有限公司 | 一种融合激光雷达与二维码的复合导航方法、装置及系统 |
CN108955668A (zh) * | 2018-08-02 | 2018-12-07 | 苏州中德睿博智能科技有限公司 | 一种融合二维码与色带的复合导航方法、装置及系统 |
CN109002046A (zh) * | 2018-09-21 | 2018-12-14 | 中国石油大学(北京) | 一种移动机器人导航系统及导航方法 |
CN109009871A (zh) * | 2018-08-16 | 2018-12-18 | 常州市钱璟康复股份有限公司 | 一种上肢康复训练机器人 |
CN109060840A (zh) * | 2018-08-10 | 2018-12-21 | 北京极智嘉科技有限公司 | 二维码的质量监测方法、装置、机器人、服务器和介质 |
CN109100738A (zh) * | 2018-08-20 | 2018-12-28 | 武汉理工大学 | 一种基于多传感器信息融合的可靠定位系统及方法 |
CN109346148A (zh) * | 2018-08-16 | 2019-02-15 | 常州市钱璟康复股份有限公司 | 上肢康复训练机器人的二维码位置识别方法及其系统 |
CN109489667A (zh) * | 2018-11-16 | 2019-03-19 | 楚天智能机器人(长沙)有限公司 | 一种基于权值矩阵的改进蚁群路径规划方法 |
CN109556596A (zh) * | 2018-10-19 | 2019-04-02 | 北京极智嘉科技有限公司 | 基于地面纹理图像的导航方法、装置、设备及存储介质 |
CN109571464A (zh) * | 2018-11-16 | 2019-04-05 | 楚天智能机器人(长沙)有限公司 | 一种基于惯性和二维码导航的机器人初始对准方法 |
CN109571408A (zh) * | 2018-12-26 | 2019-04-05 | 北京极智嘉科技有限公司 | 一种机器人、库存容器的角度校准方法及存储介质 |
CN109631887A (zh) * | 2018-12-29 | 2019-04-16 | 重庆邮电大学 | 基于双目、加速度与陀螺仪的惯性导航高精度定位方法 |
CN109827595A (zh) * | 2019-03-22 | 2019-05-31 | 京东方科技集团股份有限公司 | 室内惯性导航仪方向校准方法、室内导航装置及电子设备 |
CN110186459A (zh) * | 2019-05-27 | 2019-08-30 | 深圳市海柔创新科技有限公司 | 导航方法、移动载体及导航系统 |
CN110231030A (zh) * | 2019-06-28 | 2019-09-13 | 苏州瑞久智能科技有限公司 | 基于陀螺仪的扫地机器人角度最优估算方法 |
CN110243360A (zh) * | 2018-03-08 | 2019-09-17 | 深圳市优必选科技有限公司 | 机器人在运动区域的地图构建及定位方法 |
CN110361003A (zh) * | 2018-04-09 | 2019-10-22 | 中南大学 | 信息融合方法、装置、计算机设备和计算机可读存储介质 |
CN110515381A (zh) * | 2019-08-22 | 2019-11-29 | 浙江迈睿机器人有限公司 | 用于定位机器人的多传感器融合算法 |
CN111862208A (zh) * | 2020-06-18 | 2020-10-30 | 中国科学院深圳先进技术研究院 | 一种基于屏幕光通信的车辆定位方法、装置及服务器 |
CN112183682A (zh) * | 2020-09-01 | 2021-01-05 | 广东中鹏热能科技有限公司 | 一种利用伺服驱动和二维码及射频识别卡实现的定位方法 |
CN112256027A (zh) * | 2020-10-15 | 2021-01-22 | 珠海市一微半导体有限公司 | 一种机器人基于视觉角度纠正惯性角度的导航方法 |
CN112686070A (zh) * | 2020-11-27 | 2021-04-20 | 浙江工业大学 | 一种基于改进二维码的agv定位及导航方法 |
CN112683266A (zh) * | 2019-10-17 | 2021-04-20 | 科沃斯机器人股份有限公司 | 机器人及其导航方法 |
CN113218403A (zh) * | 2021-05-14 | 2021-08-06 | 哈尔滨工程大学 | 惯性视觉组合式定位的agv系统 |
CN113935356A (zh) * | 2021-10-20 | 2022-01-14 | 广东新时空科技股份有限公司 | 一种基于二维码的三维定位和定姿系统及方法 |
CN116592876A (zh) * | 2023-07-17 | 2023-08-15 | 北京元客方舟科技有限公司 | 定位装置及定位装置的定位方法 |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109298715B (zh) * | 2018-11-09 | 2021-12-07 | 苏州瑞得恩光能科技有限公司 | 机器人行进控制系统及行进控制方法 |
CN113642687A (zh) * | 2021-07-16 | 2021-11-12 | 国网上海市电力公司 | 一种融合二维码识别和惯性系统的变电站巡检室内位置推算方法 |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1908955A (zh) * | 2006-08-21 | 2007-02-07 | 北京中星微电子有限公司 | 一种易于全方位识别的三边形多维条码及其识读方法 |
CN102034127A (zh) * | 2009-09-28 | 2011-04-27 | 上海易悠通信息科技有限公司 | 新型大容量二维条码与系统及其编解码方法和应用 |
CN102135429A (zh) * | 2010-12-29 | 2011-07-27 | 东南大学 | 一种基于视觉的机器人室内定位导航方法 |
CN102735235A (zh) * | 2012-06-07 | 2012-10-17 | 无锡普智联科高新技术有限公司 | 基于二维码的室内移动机器人定位系统和方法 |
US20130159996A1 (en) * | 2011-12-16 | 2013-06-20 | Hsiu-Ping Lin | Systems for downloading location-based application and methods using the same |
CN103699869A (zh) * | 2013-12-30 | 2014-04-02 | 优视科技有限公司 | 一种二维码识别方法及装置 |
CN103714313A (zh) * | 2013-12-30 | 2014-04-09 | 优视科技有限公司 | 二维码识别方法和装置 |
CN103884335A (zh) * | 2014-04-09 | 2014-06-25 | 北京数联空间科技股份有限公司 | 基于二维码地理信息标志的遥感与摄影测量定位方法 |
CN104142683A (zh) * | 2013-11-15 | 2014-11-12 | 上海快仓智能科技有限公司 | 基于二维码定位的自动引导车导航方法 |
CN104424491A (zh) * | 2013-08-26 | 2015-03-18 | 程抒一 | 二维码导航系统 |
CN104457734A (zh) * | 2014-09-02 | 2015-03-25 | 柳超 | 一种停车场导航系统 |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP4141742B2 (ja) * | 2002-05-31 | 2008-08-27 | ベリテック インコーポレーテッド | □型識別コード紙 |
CN102081747A (zh) * | 2011-01-24 | 2011-06-01 | 广州宽度信息技术有限公司 | 一种二维真知码 |
KR101293703B1 (ko) * | 2011-11-28 | 2013-08-06 | (주)이컴앤드시스템 | 스큐된 데이터 매트릭스 바코드 디코딩 장치와 이를 위한 방법 |
CN103699865B (zh) * | 2014-01-15 | 2019-01-25 | 吴东辉 | 一种边框图形码 |
-
2015
- 2015-06-01 CN CN201810229929.XA patent/CN108489486B/zh active Active
- 2015-06-01 CN CN201510293436.9A patent/CN104848858B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1908955A (zh) * | 2006-08-21 | 2007-02-07 | 北京中星微电子有限公司 | 一种易于全方位识别的三边形多维条码及其识读方法 |
CN102034127A (zh) * | 2009-09-28 | 2011-04-27 | 上海易悠通信息科技有限公司 | 新型大容量二维条码与系统及其编解码方法和应用 |
CN102135429A (zh) * | 2010-12-29 | 2011-07-27 | 东南大学 | 一种基于视觉的机器人室内定位导航方法 |
US20130159996A1 (en) * | 2011-12-16 | 2013-06-20 | Hsiu-Ping Lin | Systems for downloading location-based application and methods using the same |
CN102735235A (zh) * | 2012-06-07 | 2012-10-17 | 无锡普智联科高新技术有限公司 | 基于二维码的室内移动机器人定位系统和方法 |
CN104424491A (zh) * | 2013-08-26 | 2015-03-18 | 程抒一 | 二维码导航系统 |
CN104142683A (zh) * | 2013-11-15 | 2014-11-12 | 上海快仓智能科技有限公司 | 基于二维码定位的自动引导车导航方法 |
CN103699869A (zh) * | 2013-12-30 | 2014-04-02 | 优视科技有限公司 | 一种二维码识别方法及装置 |
CN103714313A (zh) * | 2013-12-30 | 2014-04-09 | 优视科技有限公司 | 二维码识别方法和装置 |
CN103884335A (zh) * | 2014-04-09 | 2014-06-25 | 北京数联空间科技股份有限公司 | 基于二维码地理信息标志的遥感与摄影测量定位方法 |
CN104457734A (zh) * | 2014-09-02 | 2015-03-25 | 柳超 | 一种停车场导航系统 |
Cited By (83)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107923740A (zh) * | 2015-09-09 | 2018-04-17 | 索尼公司 | 传感器设备、传感器系统以及信息处理设备 |
US10976343B2 (en) | 2015-09-09 | 2021-04-13 | Sony Corporation | Sensor device, sensor system, and information processing device |
JPWO2017043181A1 (ja) * | 2015-09-09 | 2018-06-21 | ソニー株式会社 | センサ装置、センサシステム及び情報処理装置 |
CN105511466B (zh) * | 2015-12-03 | 2019-01-25 | 上海交通大学 | 基于二维码带的agv定位方法及系统 |
CN105511466A (zh) * | 2015-12-03 | 2016-04-20 | 上海交通大学 | 基于二维码带的agv定位方法及系统 |
CN105549585A (zh) * | 2015-12-07 | 2016-05-04 | 江苏木盟智能科技有限公司 | 机器人导航方法及系统 |
CN105549585B (zh) * | 2015-12-07 | 2018-03-23 | 江苏木盟智能科技有限公司 | 机器人导航方法及系统 |
CN105486311A (zh) * | 2015-12-24 | 2016-04-13 | 青岛海通机器人系统有限公司 | 室内机器人定位导航方法及装置 |
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 | 深圳马路创新科技有限公司 | 机器人基于图形标识和摄像头的全局空间定位方法 |
CN106017477A (zh) * | 2016-07-07 | 2016-10-12 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
CN106017477B (zh) * | 2016-07-07 | 2023-06-23 | 西北农林科技大学 | 一种果园机器人的视觉导航系统 |
CN106338991A (zh) * | 2016-08-26 | 2017-01-18 | 南京理工大学 | 一种基于惯性导航和二维码的机器人及定位导航方法 |
CN106123908A (zh) * | 2016-09-08 | 2016-11-16 | 北京京东尚科信息技术有限公司 | 车辆导航方法和系统 |
CN106441277A (zh) * | 2016-09-28 | 2017-02-22 | 深圳市普渡科技有限公司 | 一种基于编码器与惯性导航单元的机器人位姿估计方法 |
CN106647738A (zh) * | 2016-11-10 | 2017-05-10 | 杭州南江机器人股份有限公司 | 一种无人搬运车的对接路径确定方法及系统及无人搬运车 |
CN108073163A (zh) * | 2016-11-11 | 2018-05-25 | 中国科学院沈阳计算技术研究所有限公司 | 利用二维码反馈值补偿确定机器人精确位置的控制方法 |
CN106382934A (zh) * | 2016-11-16 | 2017-02-08 | 深圳普智联科机器人技术有限公司 | 一种高精度移动机器人定位系统和方法 |
CN108121332A (zh) * | 2016-11-28 | 2018-06-05 | 沈阳新松机器人自动化股份有限公司 | 基于二维码的室内移动机器人定位装置及方法 |
CN106708051B (zh) * | 2017-01-10 | 2023-04-18 | 北京极智嘉科技股份有限公司 | 基于二维码的导航系统和方法、导航标记物及导航控制器 |
CN106708051A (zh) * | 2017-01-10 | 2017-05-24 | 上海极络智能科技有限公司 | 基于二维码的导航系统和方法、导航标记物及导航控制器 |
CN106899609A (zh) * | 2017-03-22 | 2017-06-27 | 上海中商网络股份有限公司 | 一种码中码及其生成、验证方法及装置 |
CN106989746A (zh) * | 2017-03-27 | 2017-07-28 | 远形时空科技(北京)有限公司 | 导航方法及导航装置 |
CN106991909A (zh) * | 2017-05-25 | 2017-07-28 | 锥能机器人(上海)有限公司 | 一种用于空间定位的地面标识 |
WO2018214941A1 (zh) * | 2017-05-25 | 2018-11-29 | 锥能机器人(上海)有限公司 | 一种用于空间定位的地面标识 |
CN107727104A (zh) * | 2017-08-16 | 2018-02-23 | 北京极智嘉科技有限公司 | 结合标识的同时定位和地图创建导航方法、装置及系统 |
EP3598072A4 (en) * | 2017-08-16 | 2020-05-06 | Beijing Geekplus Technology Co., Ltd. | LABEL WITH METHOD, DEVICE AND SYSTEM FOR SIMULTANEOUS LOCATION AND CARD NAVIGATION |
WO2019034115A1 (zh) * | 2017-08-16 | 2019-02-21 | 北京极智嘉科技有限公司 | 结合标识的同时定位和地图创建导航方法、装置及系统 |
JP2019537077A (ja) * | 2017-08-16 | 2019-12-19 | 北京極智嘉科技有限公司 | 指標を使用した同時位置決め地図作成ナビゲーション方法、装置及びシステム |
CN107727104B (zh) * | 2017-08-16 | 2019-04-30 | 北京极智嘉科技有限公司 | 结合标识的同时定位和地图创建导航方法、装置及系统 |
US11340628B2 (en) | 2017-08-16 | 2022-05-24 | Beijing Geekplus Technology Co., Ltd. | Marker-combined simultaneous localization and mapping navigation method, device and system |
CN107671863A (zh) * | 2017-08-22 | 2018-02-09 | 广东美的智能机器人有限公司 | 基于二维码的机器人控制方法、装置及机器人 |
CN107729958A (zh) * | 2017-09-06 | 2018-02-23 | 新华三技术有限公司 | 一种信息发送方法及装置 |
CN107729958B (zh) * | 2017-09-06 | 2021-06-18 | 新华三技术有限公司 | 一种信息发送方法及装置 |
CN107976187B (zh) * | 2017-11-07 | 2020-08-04 | 北京工商大学 | 一种融合imu和视觉传感器的室内轨迹重建方法及系统 |
CN107976187A (zh) * | 2017-11-07 | 2018-05-01 | 北京工商大学 | 一种融合imu和视觉传感器的室内高精度轨迹重建方法及系统 |
CN108151727B (zh) * | 2017-12-01 | 2019-07-26 | 合肥优控科技有限公司 | 移动机器人定位方法、系统与计算机可读存储介质 |
CN108151727A (zh) * | 2017-12-01 | 2018-06-12 | 合肥优控科技有限公司 | 移动机器人定位方法、系统与计算机可读存储介质 |
CN108305291B (zh) * | 2018-01-08 | 2022-02-01 | 武汉大学 | 利用包含定位二维码的墙体广告的单目视觉定位定姿方法 |
CN108305291A (zh) * | 2018-01-08 | 2018-07-20 | 武汉大学 | 利用包含定位二维码的墙体广告的单目视觉定位定姿方法 |
CN108088439A (zh) * | 2018-01-19 | 2018-05-29 | 浙江科钛机器人股份有限公司 | 一种融合电子地图、二维码和色带的agv复合导航系统及方法 |
CN108088439B (zh) * | 2018-01-19 | 2020-11-24 | 浙江科钛机器人股份有限公司 | 一种融合电子地图、二维码和色带的agv复合导航系统及方法 |
CN110243360A (zh) * | 2018-03-08 | 2019-09-17 | 深圳市优必选科技有限公司 | 机器人在运动区域的地图构建及定位方法 |
CN108763996A (zh) * | 2018-03-23 | 2018-11-06 | 南京航空航天大学 | 一种基于二维码的平面定位坐标与方向角测量方法 |
CN110361003B (zh) * | 2018-04-09 | 2023-06-30 | 中南大学 | 信息融合方法、装置、计算机设备和计算机可读存储介质 |
CN110361003A (zh) * | 2018-04-09 | 2019-10-22 | 中南大学 | 信息融合方法、装置、计算机设备和计算机可读存储介质 |
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 | 北京极智嘉科技股份有限公司 | 二维码的质量监测方法、装置、机器人、服务器和介质 |
CN109060840A (zh) * | 2018-08-10 | 2018-12-21 | 北京极智嘉科技有限公司 | 二维码的质量监测方法、装置、机器人、服务器和介质 |
CN109346148A (zh) * | 2018-08-16 | 2019-02-15 | 常州市钱璟康复股份有限公司 | 上肢康复训练机器人的二维码位置识别方法及其系统 |
CN109009871A (zh) * | 2018-08-16 | 2018-12-18 | 常州市钱璟康复股份有限公司 | 一种上肢康复训练机器人 |
CN109100738B (zh) * | 2018-08-20 | 2023-01-03 | 武汉理工大学 | 一种基于多传感器信息融合的可靠定位系统及方法 |
CN109100738A (zh) * | 2018-08-20 | 2018-12-28 | 武汉理工大学 | 一种基于多传感器信息融合的可靠定位系统及方法 |
CN109002046B (zh) * | 2018-09-21 | 2020-07-10 | 中国石油大学(北京) | 一种移动机器人导航系统及导航方法 |
CN109002046A (zh) * | 2018-09-21 | 2018-12-14 | 中国石油大学(北京) | 一种移动机器人导航系统及导航方法 |
CN109556596A (zh) * | 2018-10-19 | 2019-04-02 | 北京极智嘉科技有限公司 | 基于地面纹理图像的导航方法、装置、设备及存储介质 |
US11644338B2 (en) | 2018-10-19 | 2023-05-09 | Beijing Geekplus Technology Co., Ltd. | Ground texture image-based navigation method and device, and storage medium |
CN109489667A (zh) * | 2018-11-16 | 2019-03-19 | 楚天智能机器人(长沙)有限公司 | 一种基于权值矩阵的改进蚁群路径规划方法 |
CN109571464A (zh) * | 2018-11-16 | 2019-04-05 | 楚天智能机器人(长沙)有限公司 | 一种基于惯性和二维码导航的机器人初始对准方法 |
CN109571464B (zh) * | 2018-11-16 | 2021-12-28 | 楚天智能机器人(长沙)有限公司 | 一种基于惯性和二维码导航的机器人初始对准方法 |
CN109571408A (zh) * | 2018-12-26 | 2019-04-05 | 北京极智嘉科技有限公司 | 一种机器人、库存容器的角度校准方法及存储介质 |
CN109631887A (zh) * | 2018-12-29 | 2019-04-16 | 重庆邮电大学 | 基于双目、加速度与陀螺仪的惯性导航高精度定位方法 |
CN109827595B (zh) * | 2019-03-22 | 2020-12-01 | 京东方科技集团股份有限公司 | 室内惯性导航仪方向校准方法、室内导航装置及电子设备 |
CN109827595A (zh) * | 2019-03-22 | 2019-05-31 | 京东方科技集团股份有限公司 | 室内惯性导航仪方向校准方法、室内导航装置及电子设备 |
CN110186459A (zh) * | 2019-05-27 | 2019-08-30 | 深圳市海柔创新科技有限公司 | 导航方法、移动载体及导航系统 |
CN110186459B (zh) * | 2019-05-27 | 2021-06-29 | 深圳市海柔创新科技有限公司 | 导航方法、移动载体及导航系统 |
CN110231030A (zh) * | 2019-06-28 | 2019-09-13 | 苏州瑞久智能科技有限公司 | 基于陀螺仪的扫地机器人角度最优估算方法 |
CN110515381A (zh) * | 2019-08-22 | 2019-11-29 | 浙江迈睿机器人有限公司 | 用于定位机器人的多传感器融合算法 |
CN112683266A (zh) * | 2019-10-17 | 2021-04-20 | 科沃斯机器人股份有限公司 | 机器人及其导航方法 |
CN111862208A (zh) * | 2020-06-18 | 2020-10-30 | 中国科学院深圳先进技术研究院 | 一种基于屏幕光通信的车辆定位方法、装置及服务器 |
CN111862208B (zh) * | 2020-06-18 | 2024-05-07 | 中国科学院深圳先进技术研究院 | 一种基于屏幕光通信的车辆定位方法、装置及服务器 |
CN112183682A (zh) * | 2020-09-01 | 2021-01-05 | 广东中鹏热能科技有限公司 | 一种利用伺服驱动和二维码及射频识别卡实现的定位方法 |
CN112256027A (zh) * | 2020-10-15 | 2021-01-22 | 珠海市一微半导体有限公司 | 一种机器人基于视觉角度纠正惯性角度的导航方法 |
CN112256027B (zh) * | 2020-10-15 | 2024-04-05 | 珠海一微半导体股份有限公司 | 一种机器人基于视觉角度纠正惯性角度的导航方法 |
CN112686070A (zh) * | 2020-11-27 | 2021-04-20 | 浙江工业大学 | 一种基于改进二维码的agv定位及导航方法 |
CN113218403A (zh) * | 2021-05-14 | 2021-08-06 | 哈尔滨工程大学 | 惯性视觉组合式定位的agv系统 |
CN113935356A (zh) * | 2021-10-20 | 2022-01-14 | 广东新时空科技股份有限公司 | 一种基于二维码的三维定位和定姿系统及方法 |
CN116592876A (zh) * | 2023-07-17 | 2023-08-15 | 北京元客方舟科技有限公司 | 定位装置及定位装置的定位方法 |
CN116592876B (zh) * | 2023-07-17 | 2023-10-03 | 北京元客方舟科技有限公司 | 定位装置及定位装置的定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108489486A (zh) | 2018-09-04 |
CN104848858B (zh) | 2018-07-20 |
CN108489486B (zh) | 2021-07-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104848858A (zh) | 二维码以及用于机器人的视觉-惯性组合导航系统及方法 | |
US11385062B2 (en) | Map creation method for mobile robot and path planning method based on the map | |
CN103761737B (zh) | 基于稠密光流的机器人运动估计方法 | |
Zhang et al. | Localization and navigation using QR code for mobile robot in indoor environment | |
RU2727164C1 (ru) | Способ и устройство коррекции картографических данных | |
WO2018225446A1 (ja) | 地図変化点検出装置 | |
CN110146099B (zh) | 一种基于深度学习的同步定位与地图构建方法 | |
JP5804185B2 (ja) | 移動物体位置姿勢推定装置及び移動物体位置姿勢推定方法 | |
CN103412565B (zh) | 一种具有全局位置快速估计能力的机器人定位方法 | |
CN106871904A (zh) | 一种基于机器视觉的移动机器人码盘定位修正方法 | |
CN108733039A (zh) | 一种机器人室内导航定位的方法与装置 | |
CN111210477A (zh) | 一种运动目标的定位方法及系统 | |
CN112347205B (zh) | 一种车辆误差状态的更新方法和装置 | |
JP6822427B2 (ja) | 地図変化点検出装置 | |
CN112805766B (zh) | 用于更新详细地图的装置和方法 | |
CN106127787A (zh) | 一种基于逆投影变换的相机标定方法 | |
KR101853127B1 (ko) | 구동형 마킹 시스템, 구동형 마킹 장치의 제어방법 및 컴퓨터 판독 가능한 기록매체 | |
JP2012159469A (ja) | 車両用画像認識装置 | |
JP2006349607A (ja) | 距離計測装置 | |
CN105444766A (zh) | 基于深度学习的室内导航方法 | |
CN114993298A (zh) | 基于ekf的模板匹配vo与轮式里程计融合定位方法 | |
CN109949356A (zh) | 等距线单目视觉行人距离估计方法 | |
JP2012159470A (ja) | 車両用画像認識装置 | |
CN111862146B (zh) | 一种目标对象的定位方法及装置 | |
CN103791901A (zh) | 一种星敏感器数据处理系统 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CP03 | Change of name, title or address | ||
CP03 | Change of name, title or address |
Address after: 100012 Room 101, 1st floor, building 1, No.36 courtyard, Chuangyuan Road, Chaoyang District, Beijing Patentee after: Beijing jizhijia Technology Co.,Ltd. Address before: 101200 no.5-936, pingguyuan logistics base, Zhongguancun Science and Technology Park, Pinggu District, Beijing Patentee before: Beijing Geekplus Technology Co.,Ltd. |